2 * MFD driver for wl1273 FM radio and audio codec submodules.
4 * Copyright (C) 2011 Nokia Corporation
5 * Author: Matti Aaltonen <matti.j.aaltonen@nokia.com>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
23 #include <linux/mfd/wl1273-core.h>
24 #include <linux/slab.h>
25 #include <linux/module.h>
27 #define DRIVER_DESC "WL1273 FM Radio Core"
29 static const struct i2c_device_id wl1273_driver_id_table
[] = {
30 { WL1273_FM_DRIVER_NAME
, 0 },
33 MODULE_DEVICE_TABLE(i2c
, wl1273_driver_id_table
);
35 static int wl1273_fm_read_reg(struct wl1273_core
*core
, u8 reg
, u16
*value
)
37 struct i2c_client
*client
= core
->client
;
41 r
= i2c_smbus_read_i2c_block_data(client
, reg
, sizeof(b
), b
);
43 dev_err(&client
->dev
, "%s: Read: %d fails.\n", __func__
, reg
);
47 *value
= (u16
)b
[0] << 8 | b
[1];
52 static int wl1273_fm_write_cmd(struct wl1273_core
*core
, u8 cmd
, u16 param
)
54 struct i2c_client
*client
= core
->client
;
55 u8 buf
[] = { (param
>> 8) & 0xff, param
& 0xff };
58 r
= i2c_smbus_write_i2c_block_data(client
, cmd
, sizeof(buf
), buf
);
60 dev_err(&client
->dev
, "%s: Cmd: %d fails.\n", __func__
, cmd
);
67 static int wl1273_fm_write_data(struct wl1273_core
*core
, u8
*data
, u16 len
)
69 struct i2c_client
*client
= core
->client
;
73 msg
.addr
= client
->addr
;
78 r
= i2c_transfer(client
->adapter
, &msg
, 1);
80 dev_err(&client
->dev
, "%s: write error.\n", __func__
);
88 * wl1273_fm_set_audio() - Set audio mode.
89 * @core: A pointer to the device struct.
90 * @new_mode: The new audio mode.
92 * Audio modes are WL1273_AUDIO_DIGITAL and WL1273_AUDIO_ANALOG.
94 static int wl1273_fm_set_audio(struct wl1273_core
*core
, unsigned int new_mode
)
98 if (core
->mode
== WL1273_MODE_OFF
||
99 core
->mode
== WL1273_MODE_SUSPENDED
)
102 if (core
->mode
== WL1273_MODE_RX
&& new_mode
== WL1273_AUDIO_DIGITAL
) {
103 r
= wl1273_fm_write_cmd(core
, WL1273_PCM_MODE_SET
,
104 WL1273_PCM_DEF_MODE
);
108 r
= wl1273_fm_write_cmd(core
, WL1273_I2S_MODE_CONFIG_SET
,
113 r
= wl1273_fm_write_cmd(core
, WL1273_AUDIO_ENABLE
,
114 WL1273_AUDIO_ENABLE_I2S
);
118 } else if (core
->mode
== WL1273_MODE_RX
&&
119 new_mode
== WL1273_AUDIO_ANALOG
) {
120 r
= wl1273_fm_write_cmd(core
, WL1273_AUDIO_ENABLE
,
121 WL1273_AUDIO_ENABLE_ANALOG
);
125 } else if (core
->mode
== WL1273_MODE_TX
&&
126 new_mode
== WL1273_AUDIO_DIGITAL
) {
127 r
= wl1273_fm_write_cmd(core
, WL1273_I2S_MODE_CONFIG_SET
,
132 r
= wl1273_fm_write_cmd(core
, WL1273_AUDIO_IO_SET
,
133 WL1273_AUDIO_IO_SET_I2S
);
137 } else if (core
->mode
== WL1273_MODE_TX
&&
138 new_mode
== WL1273_AUDIO_ANALOG
) {
139 r
= wl1273_fm_write_cmd(core
, WL1273_AUDIO_IO_SET
,
140 WL1273_AUDIO_IO_SET_ANALOG
);
145 core
->audio_mode
= new_mode
;
151 * wl1273_fm_set_volume() - Set volume.
152 * @core: A pointer to the device struct.
153 * @volume: The new volume value.
155 static int wl1273_fm_set_volume(struct wl1273_core
*core
, unsigned int volume
)
159 if (volume
> WL1273_MAX_VOLUME
)
162 if (core
->volume
== volume
)
165 r
= wl1273_fm_write_cmd(core
, WL1273_VOLUME_SET
, volume
);
169 core
->volume
= volume
;
173 static int wl1273_core_remove(struct i2c_client
*client
)
175 struct wl1273_core
*core
= i2c_get_clientdata(client
);
177 dev_dbg(&client
->dev
, "%s\n", __func__
);
179 mfd_remove_devices(&client
->dev
);
185 static int __devinit
wl1273_core_probe(struct i2c_client
*client
,
186 const struct i2c_device_id
*id
)
188 struct wl1273_fm_platform_data
*pdata
= client
->dev
.platform_data
;
189 struct wl1273_core
*core
;
190 struct mfd_cell
*cell
;
194 dev_dbg(&client
->dev
, "%s\n", __func__
);
197 dev_err(&client
->dev
, "No platform data.\n");
201 if (!(pdata
->children
& WL1273_RADIO_CHILD
)) {
202 dev_err(&client
->dev
, "Cannot function without radio child.\n");
206 core
= kzalloc(sizeof(*core
), GFP_KERNEL
);
211 core
->client
= client
;
212 mutex_init(&core
->lock
);
214 i2c_set_clientdata(client
, core
);
216 dev_dbg(&client
->dev
, "%s: Have V4L2.\n", __func__
);
218 cell
= &core
->cells
[children
];
219 cell
->name
= "wl1273_fm_radio";
220 cell
->platform_data
= &core
;
221 cell
->pdata_size
= sizeof(core
);
224 core
->read
= wl1273_fm_read_reg
;
225 core
->write
= wl1273_fm_write_cmd
;
226 core
->write_data
= wl1273_fm_write_data
;
227 core
->set_audio
= wl1273_fm_set_audio
;
228 core
->set_volume
= wl1273_fm_set_volume
;
230 if (pdata
->children
& WL1273_CODEC_CHILD
) {
231 cell
= &core
->cells
[children
];
233 dev_dbg(&client
->dev
, "%s: Have codec.\n", __func__
);
234 cell
->name
= "wl1273-codec";
235 cell
->platform_data
= &core
;
236 cell
->pdata_size
= sizeof(core
);
240 dev_dbg(&client
->dev
, "%s: number of children: %d.\n",
243 r
= mfd_add_devices(&client
->dev
, -1, core
->cells
,
251 pdata
->free_resources();
254 dev_dbg(&client
->dev
, "%s\n", __func__
);
259 static struct i2c_driver wl1273_core_driver
= {
261 .name
= WL1273_FM_DRIVER_NAME
,
263 .probe
= wl1273_core_probe
,
264 .id_table
= wl1273_driver_id_table
,
265 .remove
= __devexit_p(wl1273_core_remove
),
268 static int __init
wl1273_core_init(void)
272 r
= i2c_add_driver(&wl1273_core_driver
);
274 pr_err(WL1273_FM_DRIVER_NAME
275 ": driver registration failed\n");
282 static void __exit
wl1273_core_exit(void)
284 i2c_del_driver(&wl1273_core_driver
);
286 late_initcall(wl1273_core_init
);
287 module_exit(wl1273_core_exit
);
289 MODULE_AUTHOR("Matti Aaltonen <matti.j.aaltonen@nokia.com>");
290 MODULE_DESCRIPTION(DRIVER_DESC
);
291 MODULE_LICENSE("GPL");