1 // SPDX-License-Identifier: GPL-2.0-only
9 #include <linux/mfd/wl1273-core.h>
21 static int wl1273_fm_read_reg(struct wl1273_core *core, u8 reg, u16 *value)  in wl1273_fm_read_reg()  argument
23 	struct i2c_client *client = core->client;  in wl1273_fm_read_reg()
29 		dev_err(&client->dev, "%s: Read: %d fails.\n", __func__, reg);  in wl1273_fm_read_reg()
30 		return -EREMOTEIO;  in wl1273_fm_read_reg()
33 	*value = (u16)b[0] << 8 | b[1];  in wl1273_fm_read_reg()
40 	struct i2c_client *client = core->client;  in wl1273_fm_write_cmd()
46 		dev_err(&client->dev, "%s: Cmd: %d fails.\n", __func__, cmd);  in wl1273_fm_write_cmd()
55 	struct i2c_client *client = core->client;  in wl1273_fm_write_data()
59 	msg.addr = client->addr;  in wl1273_fm_write_data()
64 	r = i2c_transfer(client->adapter, &msg, 1);  in wl1273_fm_write_data()
66 		dev_err(&client->dev, "%s: write error.\n", __func__);  in wl1273_fm_write_data()
67 		return -EREMOTEIO;  in wl1273_fm_write_data()
74  * wl1273_fm_set_audio() -	Set audio mode.
84 	if (core->mode == WL1273_MODE_OFF ||  in wl1273_fm_set_audio()
85 	    core->mode == WL1273_MODE_SUSPENDED)  in wl1273_fm_set_audio()
86 		return -EPERM;  in wl1273_fm_set_audio()
88 	if (core->mode == WL1273_MODE_RX && new_mode == WL1273_AUDIO_DIGITAL) {  in wl1273_fm_set_audio()
95 					core->i2s_mode);  in wl1273_fm_set_audio()
104 	} else if (core->mode == WL1273_MODE_RX &&  in wl1273_fm_set_audio()
111 	} else if (core->mode == WL1273_MODE_TX &&  in wl1273_fm_set_audio()
114 					core->i2s_mode);  in wl1273_fm_set_audio()
123 	} else if (core->mode == WL1273_MODE_TX &&  in wl1273_fm_set_audio()
131 	core->audio_mode = new_mode;  in wl1273_fm_set_audio()
137  * wl1273_fm_set_volume() -	Set volume.
139  * @volume:			The new volume value.
146 		return -EINVAL;  in wl1273_fm_set_volume()
148 	if (core->volume == volume)  in wl1273_fm_set_volume()
155 	core->volume = volume;  in wl1273_fm_set_volume()
161 	struct wl1273_fm_platform_data *pdata = dev_get_platdata(&client->dev);  in wl1273_core_probe()
163 	struct mfd_cell *cell;  in wl1273_core_probe()  local
167 	dev_dbg(&client->dev, "%s\n", __func__);  in wl1273_core_probe()
170 		dev_err(&client->dev, "No platform data.\n");  in wl1273_core_probe()
171 		return -EINVAL;  in wl1273_core_probe()
174 	if (!(pdata->children & WL1273_RADIO_CHILD)) {  in wl1273_core_probe()
175 		dev_err(&client->dev, "Cannot function without radio child.\n");  in wl1273_core_probe()
176 		return -EINVAL;  in wl1273_core_probe()
179 	core = devm_kzalloc(&client->dev, sizeof(*core), GFP_KERNEL);  in wl1273_core_probe()
181 		return -ENOMEM;  in wl1273_core_probe()
183 	core->pdata = pdata;  in wl1273_core_probe()
184 	core->client = client;  in wl1273_core_probe()
185 	mutex_init(&core->lock);  in wl1273_core_probe()
189 	dev_dbg(&client->dev, "%s: Have V4L2.\n", __func__);  in wl1273_core_probe()
191 	cell = &core->cells[children];  in wl1273_core_probe()
192 	cell->name = "wl1273_fm_radio";  in wl1273_core_probe()
193 	cell->platform_data = &core;  in wl1273_core_probe()
194 	cell->pdata_size = sizeof(core);  in wl1273_core_probe()
197 	core->read = wl1273_fm_read_reg;  in wl1273_core_probe()
198 	core->write = wl1273_fm_write_cmd;  in wl1273_core_probe()
199 	core->write_data = wl1273_fm_write_data;  in wl1273_core_probe()
200 	core->set_audio = wl1273_fm_set_audio;  in wl1273_core_probe()
201 	core->set_volume = wl1273_fm_set_volume;  in wl1273_core_probe()
203 	if (pdata->children & WL1273_CODEC_CHILD) {  in wl1273_core_probe()
204 		cell = &core->cells[children];  in wl1273_core_probe()
206 		dev_dbg(&client->dev, "%s: Have codec.\n", __func__);  in wl1273_core_probe()
207 		cell->name = "wl1273-codec";  in wl1273_core_probe()
208 		cell->platform_data = &core;  in wl1273_core_probe()
209 		cell->pdata_size = sizeof(core);  in wl1273_core_probe()
213 	dev_dbg(&client->dev, "%s: number of children: %d.\n",  in wl1273_core_probe()
216 	r = devm_mfd_add_devices(&client->dev, -1, core->cells,  in wl1273_core_probe()
224 	pdata->free_resources();  in wl1273_core_probe()
226 	dev_dbg(&client->dev, "%s\n", __func__);  in wl1273_core_probe()