xref: /openbmc/u-boot/drivers/sound/sound-uclass.c (revision c507d306)
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright 2018 Google LLC
4  * Written by Simon Glass <sjg@chromium.org>
5  */
6 
7 #include <common.h>
8 #include <dm.h>
9 #include <i2s.h>
10 #include <sound.h>
11 
12 #define SOUND_BITS_IN_BYTE 8
13 
sound_setup(struct udevice * dev)14 int sound_setup(struct udevice *dev)
15 {
16 	struct sound_ops *ops = sound_get_ops(dev);
17 
18 	if (!ops->setup)
19 		return 0;
20 
21 	return ops->setup(dev);
22 }
23 
sound_play(struct udevice * dev,void * data,uint data_size)24 int sound_play(struct udevice *dev, void *data, uint data_size)
25 {
26 	struct sound_ops *ops = sound_get_ops(dev);
27 
28 	if (!ops->play)
29 		return -ENOSYS;
30 
31 	return ops->play(dev, data, data_size);
32 }
33 
sound_start_beep(struct udevice * dev,int frequency_hz)34 int sound_start_beep(struct udevice *dev, int frequency_hz)
35 {
36 	struct sound_ops *ops = sound_get_ops(dev);
37 
38 	if (!ops->start_beep)
39 		return -ENOSYS;
40 
41 	return ops->start_beep(dev, frequency_hz);
42 }
43 
sound_stop_beep(struct udevice * dev)44 int sound_stop_beep(struct udevice *dev)
45 {
46 	struct sound_ops *ops = sound_get_ops(dev);
47 
48 	if (!ops->stop_beep)
49 		return -ENOSYS;
50 
51 	return ops->stop_beep(dev);
52 }
53 
sound_beep(struct udevice * dev,int msecs,int frequency_hz)54 int sound_beep(struct udevice *dev, int msecs, int frequency_hz)
55 {
56 	struct sound_uc_priv *uc_priv = dev_get_uclass_priv(dev);
57 	struct i2s_uc_priv *i2s_uc_priv;
58 	unsigned short *data;
59 	uint data_size;
60 	int ret;
61 
62 	ret = sound_setup(dev);
63 	if (ret && ret != -EALREADY)
64 		return ret;
65 
66 	/* Try using the beep interface if available */
67 	ret = sound_start_beep(dev, frequency_hz);
68 	if (ret != -ENOSYS) {
69 		if (ret)
70 			return ret;
71 		mdelay(msecs);
72 		ret = sound_stop_beep(dev);
73 
74 		return ret;
75 	}
76 
77 	/* Buffer length computation */
78 	i2s_uc_priv = dev_get_uclass_priv(uc_priv->i2s);
79 	data_size = i2s_uc_priv->samplingrate * i2s_uc_priv->channels;
80 	data_size *= (i2s_uc_priv->bitspersample / SOUND_BITS_IN_BYTE);
81 	data = malloc(data_size);
82 	if (!data) {
83 		debug("%s: malloc failed\n", __func__);
84 		return -ENOMEM;
85 	}
86 
87 	sound_create_square_wave(i2s_uc_priv->samplingrate, data, data_size,
88 				 frequency_hz, i2s_uc_priv->channels);
89 
90 	while (msecs >= 1000) {
91 		ret = sound_play(dev, data, data_size);
92 		msecs -= 1000;
93 	}
94 	if (msecs) {
95 		unsigned long size =
96 			(data_size * msecs) / (sizeof(int) * 1000);
97 
98 		ret = sound_play(dev, data, size);
99 	}
100 
101 	free(data);
102 
103 	return ret;
104 }
105 
sound_find_codec_i2s(struct udevice * dev)106 int sound_find_codec_i2s(struct udevice *dev)
107 {
108 	struct sound_uc_priv *uc_priv = dev_get_uclass_priv(dev);
109 	struct ofnode_phandle_args args;
110 	ofnode node;
111 	int ret;
112 
113 	/* First the codec */
114 	node = ofnode_find_subnode(dev_ofnode(dev), "codec");
115 	if (!ofnode_valid(node)) {
116 		debug("Failed to find /cpu subnode\n");
117 		return -EINVAL;
118 	}
119 	ret = ofnode_parse_phandle_with_args(node, "sound-dai",
120 					     "#sound-dai-cells", 0, 0, &args);
121 	if (ret) {
122 		debug("Cannot find phandle: %d\n", ret);
123 		return ret;
124 	}
125 	ret = uclass_get_device_by_ofnode(UCLASS_AUDIO_CODEC, args.node,
126 					  &uc_priv->codec);
127 	if (ret) {
128 		debug("Cannot find codec: %d\n", ret);
129 		return ret;
130 	}
131 
132 	/* Now the i2s */
133 	node = ofnode_find_subnode(dev_ofnode(dev), "cpu");
134 	if (!ofnode_valid(node)) {
135 		debug("Failed to find /cpu subnode\n");
136 		return -EINVAL;
137 	}
138 	ret = ofnode_parse_phandle_with_args(node, "sound-dai",
139 					     "#sound-dai-cells", 0, 0, &args);
140 	if (ret) {
141 		debug("Cannot find phandle: %d\n", ret);
142 		return ret;
143 	}
144 	ret = uclass_get_device_by_ofnode(UCLASS_I2S, args.node, &uc_priv->i2s);
145 	if (ret) {
146 		debug("Cannot find i2s: %d\n", ret);
147 		return ret;
148 	}
149 	debug("Probed sound '%s' with codec '%s' and i2s '%s'\n", dev->name,
150 	      uc_priv->codec->name, uc_priv->i2s->name);
151 
152 	return 0;
153 }
154 
155 UCLASS_DRIVER(sound) = {
156 	.id		= UCLASS_SOUND,
157 	.name		= "sound",
158 	.per_device_auto_alloc_size	= sizeof(struct sound_uc_priv),
159 };
160