1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * MFD driver for wl1273 FM radio and audio codec submodules. |
4 | * |
5 | * Copyright (C) 2011 Nokia Corporation |
6 | * Author: Matti Aaltonen <matti.j.aaltonen@nokia.com> |
7 | */ |
8 | |
9 | #include <linux/mfd/wl1273-core.h> |
10 | #include <linux/slab.h> |
11 | #include <linux/module.h> |
12 | |
13 | #define DRIVER_DESC "WL1273 FM Radio Core" |
14 | |
15 | static const struct i2c_device_id wl1273_driver_id_table[] = { |
16 | { WL1273_FM_DRIVER_NAME, 0 }, |
17 | { } |
18 | }; |
19 | MODULE_DEVICE_TABLE(i2c, wl1273_driver_id_table); |
20 | |
21 | static int wl1273_fm_read_reg(struct wl1273_core *core, u8 reg, u16 *value) |
22 | { |
23 | struct i2c_client *client = core->client; |
24 | u8 b[2]; |
25 | int r; |
26 | |
27 | r = i2c_smbus_read_i2c_block_data(client, command: reg, length: sizeof(b), values: b); |
28 | if (r != 2) { |
29 | dev_err(&client->dev, "%s: Read: %d fails.\n" , __func__, reg); |
30 | return -EREMOTEIO; |
31 | } |
32 | |
33 | *value = (u16)b[0] << 8 | b[1]; |
34 | |
35 | return 0; |
36 | } |
37 | |
38 | static int wl1273_fm_write_cmd(struct wl1273_core *core, u8 cmd, u16 param) |
39 | { |
40 | struct i2c_client *client = core->client; |
41 | u8 buf[] = { (param >> 8) & 0xff, param & 0xff }; |
42 | int r; |
43 | |
44 | r = i2c_smbus_write_i2c_block_data(client, command: cmd, length: sizeof(buf), values: buf); |
45 | if (r) { |
46 | dev_err(&client->dev, "%s: Cmd: %d fails.\n" , __func__, cmd); |
47 | return r; |
48 | } |
49 | |
50 | return 0; |
51 | } |
52 | |
53 | static int wl1273_fm_write_data(struct wl1273_core *core, u8 *data, u16 len) |
54 | { |
55 | struct i2c_client *client = core->client; |
56 | struct i2c_msg msg; |
57 | int r; |
58 | |
59 | msg.addr = client->addr; |
60 | msg.flags = 0; |
61 | msg.buf = data; |
62 | msg.len = len; |
63 | |
64 | r = i2c_transfer(adap: client->adapter, msgs: &msg, num: 1); |
65 | if (r != 1) { |
66 | dev_err(&client->dev, "%s: write error.\n" , __func__); |
67 | return -EREMOTEIO; |
68 | } |
69 | |
70 | return 0; |
71 | } |
72 | |
73 | /** |
74 | * wl1273_fm_set_audio() - Set audio mode. |
75 | * @core: A pointer to the device struct. |
76 | * @new_mode: The new audio mode. |
77 | * |
78 | * Audio modes are WL1273_AUDIO_DIGITAL and WL1273_AUDIO_ANALOG. |
79 | */ |
80 | static int wl1273_fm_set_audio(struct wl1273_core *core, unsigned int new_mode) |
81 | { |
82 | int r = 0; |
83 | |
84 | if (core->mode == WL1273_MODE_OFF || |
85 | core->mode == WL1273_MODE_SUSPENDED) |
86 | return -EPERM; |
87 | |
88 | if (core->mode == WL1273_MODE_RX && new_mode == WL1273_AUDIO_DIGITAL) { |
89 | r = wl1273_fm_write_cmd(core, WL1273_PCM_MODE_SET, |
90 | WL1273_PCM_DEF_MODE); |
91 | if (r) |
92 | goto out; |
93 | |
94 | r = wl1273_fm_write_cmd(core, WL1273_I2S_MODE_CONFIG_SET, |
95 | param: core->i2s_mode); |
96 | if (r) |
97 | goto out; |
98 | |
99 | r = wl1273_fm_write_cmd(core, WL1273_AUDIO_ENABLE, |
100 | WL1273_AUDIO_ENABLE_I2S); |
101 | if (r) |
102 | goto out; |
103 | |
104 | } else if (core->mode == WL1273_MODE_RX && |
105 | new_mode == WL1273_AUDIO_ANALOG) { |
106 | r = wl1273_fm_write_cmd(core, WL1273_AUDIO_ENABLE, |
107 | WL1273_AUDIO_ENABLE_ANALOG); |
108 | if (r) |
109 | goto out; |
110 | |
111 | } else if (core->mode == WL1273_MODE_TX && |
112 | new_mode == WL1273_AUDIO_DIGITAL) { |
113 | r = wl1273_fm_write_cmd(core, WL1273_I2S_MODE_CONFIG_SET, |
114 | param: core->i2s_mode); |
115 | if (r) |
116 | goto out; |
117 | |
118 | r = wl1273_fm_write_cmd(core, WL1273_AUDIO_IO_SET, |
119 | WL1273_AUDIO_IO_SET_I2S); |
120 | if (r) |
121 | goto out; |
122 | |
123 | } else if (core->mode == WL1273_MODE_TX && |
124 | new_mode == WL1273_AUDIO_ANALOG) { |
125 | r = wl1273_fm_write_cmd(core, WL1273_AUDIO_IO_SET, |
126 | WL1273_AUDIO_IO_SET_ANALOG); |
127 | if (r) |
128 | goto out; |
129 | } |
130 | |
131 | core->audio_mode = new_mode; |
132 | out: |
133 | return r; |
134 | } |
135 | |
136 | /** |
137 | * wl1273_fm_set_volume() - Set volume. |
138 | * @core: A pointer to the device struct. |
139 | * @volume: The new volume value. |
140 | */ |
141 | static int wl1273_fm_set_volume(struct wl1273_core *core, unsigned int volume) |
142 | { |
143 | int r; |
144 | |
145 | if (volume > WL1273_MAX_VOLUME) |
146 | return -EINVAL; |
147 | |
148 | if (core->volume == volume) |
149 | return 0; |
150 | |
151 | r = wl1273_fm_write_cmd(core, WL1273_VOLUME_SET, param: volume); |
152 | if (r) |
153 | return r; |
154 | |
155 | core->volume = volume; |
156 | return 0; |
157 | } |
158 | |
159 | static int wl1273_core_probe(struct i2c_client *client) |
160 | { |
161 | struct wl1273_fm_platform_data *pdata = dev_get_platdata(dev: &client->dev); |
162 | struct wl1273_core *core; |
163 | struct mfd_cell *cell; |
164 | int children = 0; |
165 | int r = 0; |
166 | |
167 | dev_dbg(&client->dev, "%s\n" , __func__); |
168 | |
169 | if (!pdata) { |
170 | dev_err(&client->dev, "No platform data.\n" ); |
171 | return -EINVAL; |
172 | } |
173 | |
174 | if (!(pdata->children & WL1273_RADIO_CHILD)) { |
175 | dev_err(&client->dev, "Cannot function without radio child.\n" ); |
176 | return -EINVAL; |
177 | } |
178 | |
179 | core = devm_kzalloc(dev: &client->dev, size: sizeof(*core), GFP_KERNEL); |
180 | if (!core) |
181 | return -ENOMEM; |
182 | |
183 | core->pdata = pdata; |
184 | core->client = client; |
185 | mutex_init(&core->lock); |
186 | |
187 | i2c_set_clientdata(client, data: core); |
188 | |
189 | dev_dbg(&client->dev, "%s: Have V4L2.\n" , __func__); |
190 | |
191 | cell = &core->cells[children]; |
192 | cell->name = "wl1273_fm_radio" ; |
193 | cell->platform_data = &core; |
194 | cell->pdata_size = sizeof(core); |
195 | children++; |
196 | |
197 | core->read = wl1273_fm_read_reg; |
198 | core->write = wl1273_fm_write_cmd; |
199 | core->write_data = wl1273_fm_write_data; |
200 | core->set_audio = wl1273_fm_set_audio; |
201 | core->set_volume = wl1273_fm_set_volume; |
202 | |
203 | if (pdata->children & WL1273_CODEC_CHILD) { |
204 | cell = &core->cells[children]; |
205 | |
206 | dev_dbg(&client->dev, "%s: Have codec.\n" , __func__); |
207 | cell->name = "wl1273-codec" ; |
208 | cell->platform_data = &core; |
209 | cell->pdata_size = sizeof(core); |
210 | children++; |
211 | } |
212 | |
213 | dev_dbg(&client->dev, "%s: number of children: %d.\n" , |
214 | __func__, children); |
215 | |
216 | r = devm_mfd_add_devices(dev: &client->dev, id: -1, cells: core->cells, |
217 | n_devs: children, NULL, irq_base: 0, NULL); |
218 | if (r) |
219 | goto err; |
220 | |
221 | return 0; |
222 | |
223 | err: |
224 | pdata->free_resources(); |
225 | |
226 | dev_dbg(&client->dev, "%s\n" , __func__); |
227 | |
228 | return r; |
229 | } |
230 | |
231 | static struct i2c_driver wl1273_core_driver = { |
232 | .driver = { |
233 | .name = WL1273_FM_DRIVER_NAME, |
234 | }, |
235 | .probe = wl1273_core_probe, |
236 | .id_table = wl1273_driver_id_table, |
237 | }; |
238 | |
239 | static int __init wl1273_core_init(void) |
240 | { |
241 | int r; |
242 | |
243 | r = i2c_add_driver(&wl1273_core_driver); |
244 | if (r) { |
245 | pr_err(WL1273_FM_DRIVER_NAME |
246 | ": driver registration failed\n" ); |
247 | return r; |
248 | } |
249 | |
250 | return r; |
251 | } |
252 | |
253 | static void __exit wl1273_core_exit(void) |
254 | { |
255 | i2c_del_driver(driver: &wl1273_core_driver); |
256 | } |
257 | late_initcall(wl1273_core_init); |
258 | module_exit(wl1273_core_exit); |
259 | |
260 | MODULE_AUTHOR("Matti Aaltonen <matti.j.aaltonen@nokia.com>" ); |
261 | MODULE_DESCRIPTION(DRIVER_DESC); |
262 | MODULE_LICENSE("GPL" ); |
263 | |