V4L/DVB (3344a): Conversions from kmalloc+memset to k(z|c)alloc
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / media / video / wm8775.c
CommitLineData
0edeea4f
HV
1/*
2 * wm8775 - driver version 0.0.1
3 *
4 * Copyright (C) 2004 Ulf Eklund <ivtv at eklund.to>
5 *
6 * Based on saa7115 driver
7 *
1f4b3365
HV
8 * Copyright (C) 2005 Hans Verkuil <hverkuil@xs4all.nl>
9 * - Cleanup
10 * - V4L2 API update
11 * - sound fixes
12 *
0edeea4f
HV
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or
16 * (at your option) any later version.
17 *
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 */
27
0edeea4f
HV
28#include <linux/module.h>
29#include <linux/types.h>
30#include <linux/ioctl.h>
31#include <asm/uaccess.h>
32#include <linux/i2c.h>
e2998e10 33#include <linux/i2c-id.h>
0edeea4f 34#include <linux/videodev.h>
fac9e899 35#include <media/v4l2-common.h>
0edeea4f
HV
36
37MODULE_DESCRIPTION("wm8775 driver");
1f4b3365 38MODULE_AUTHOR("Ulf Eklund, Hans Verkuil");
0edeea4f
HV
39MODULE_LICENSE("GPL");
40
0edeea4f
HV
41static unsigned short normal_i2c[] = { 0x36 >> 1, I2C_CLIENT_END };
42
43
44I2C_CLIENT_INSMOD;
45
46/* ----------------------------------------------------------------------- */
47
48enum {
49 R7 = 7, R11 = 11,
50 R12, R13, R14, R15, R16, R17, R18, R19, R20, R21, R23 = 23,
51 TOT_REGS
52};
53
54struct wm8775_state {
55 u8 input; /* Last selected input (0-0xf) */
56 u8 muted;
57};
58
59static int wm8775_write(struct i2c_client *client, int reg, u16 val)
60{
61 int i;
62
63 if (reg < 0 || reg >= TOT_REGS) {
fac9e899 64 v4l_err(client, "Invalid register R%d\n", reg);
0edeea4f
HV
65 return -1;
66 }
67
68 for (i = 0; i < 3; i++) {
69 if (i2c_smbus_write_byte_data(client, (reg << 1) |
70 (val >> 8), val & 0xff) == 0) {
71 return 0;
72 }
73 }
fac9e899 74 v4l_err(client, "I2C: cannot write %03x to register R%d\n", val, reg);
0edeea4f
HV
75 return -1;
76}
77
78static int wm8775_command(struct i2c_client *client, unsigned int cmd,
79 void *arg)
80{
81 struct wm8775_state *state = i2c_get_clientdata(client);
fbc46e74
HV
82 struct v4l2_audio *input = arg;
83 struct v4l2_control *ctrl = arg;
0edeea4f
HV
84
85 switch (cmd) {
fbc46e74
HV
86 case VIDIOC_S_AUDIO:
87 /* There are 4 inputs and one output. Zero or more inputs
88 are multiplexed together to the output. Hence there are
89 16 combinations.
90 If only one input is active (the normal case) then the
91 input values 1, 2, 4 or 8 should be used. */
92 if (input->index > 15) {
fac9e899 93 v4l_err(client, "Invalid input %d.\n", input->index);
fbc46e74
HV
94 return -EINVAL;
95 }
96 state->input = input->index;
97 if (state->muted)
98 break;
0edeea4f
HV
99 wm8775_write(client, R21, 0x0c0);
100 wm8775_write(client, R14, 0x1d4);
101 wm8775_write(client, R15, 0x1d4);
fbc46e74
HV
102 wm8775_write(client, R21, 0x100 + state->input);
103 break;
0edeea4f 104
fbc46e74
HV
105 case VIDIOC_G_AUDIO:
106 memset(input, 0, sizeof(*input));
107 input->index = state->input;
108 break;
109
110 case VIDIOC_G_CTRL:
111 if (ctrl->id != V4L2_CID_AUDIO_MUTE)
112 return -EINVAL;
113 ctrl->value = state->muted;
114 break;
115
116 case VIDIOC_S_CTRL:
117 if (ctrl->id != V4L2_CID_AUDIO_MUTE)
118 return -EINVAL;
119 state->muted = ctrl->value;
120 wm8775_write(client, R21, 0x0c0);
121 wm8775_write(client, R14, 0x1d4);
122 wm8775_write(client, R15, 0x1d4);
123 if (!state->muted)
0edeea4f 124 wm8775_write(client, R21, 0x100 + state->input);
0edeea4f
HV
125 break;
126
bf7e26ee 127 case VIDIOC_LOG_STATUS:
fac9e899 128 v4l_info(client, "Input: %d%s\n", state->input,
bf7e26ee
HV
129 state->muted ? " (muted)" : "");
130 break;
0edeea4f 131
bf7e26ee 132 case VIDIOC_S_FREQUENCY:
0edeea4f
HV
133 /* If I remove this, then it can happen that I have no
134 sound the first time I tune from static to a valid channel.
135 It's difficult to reproduce and is almost certainly related
136 to the zero cross detect circuit. */
137 wm8775_write(client, R21, 0x0c0);
138 wm8775_write(client, R14, 0x1d4);
139 wm8775_write(client, R15, 0x1d4);
140 wm8775_write(client, R21, 0x100 + state->input);
141 break;
142
143 default:
144 return -EINVAL;
145 }
146 return 0;
147}
148
149/* ----------------------------------------------------------------------- */
150
151/* i2c implementation */
152
153/*
154 * Generic i2c probe
155 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
156 */
157
158static struct i2c_driver i2c_driver;
159
160static int wm8775_attach(struct i2c_adapter *adapter, int address, int kind)
161{
162 struct i2c_client *client;
163 struct wm8775_state *state;
164
165 /* Check if the adapter supports the needed features */
166 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
167 return 0;
168
7408187d 169 client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
0edeea4f
HV
170 if (client == 0)
171 return -ENOMEM;
172
0edeea4f
HV
173 client->addr = address;
174 client->adapter = adapter;
175 client->driver = &i2c_driver;
0edeea4f
HV
176 snprintf(client->name, sizeof(client->name) - 1, "wm8775");
177
fac9e899 178 v4l_info(client, "chip found @ 0x%x (%s)\n", address << 1, adapter->name);
0edeea4f
HV
179
180 state = kmalloc(sizeof(struct wm8775_state), GFP_KERNEL);
181 if (state == NULL) {
182 kfree(client);
183 return -ENOMEM;
184 }
185 state->input = 2;
186 state->muted = 0;
187 i2c_set_clientdata(client, state);
188
189 /* initialize wm8775 */
190 wm8775_write(client, R23, 0x000); /* RESET */
191 wm8775_write(client, R7, 0x000); /* Disable zero cross detect timeout */
192 wm8775_write(client, R11, 0x021); /* Left justified, 24-bit mode */
193 wm8775_write(client, R12, 0x102); /* Master mode, clock ratio 256fs */
194 wm8775_write(client, R13, 0x000); /* Powered up */
195 wm8775_write(client, R14, 0x1d4); /* ADC gain +2.5dB, enable zero cross */
196 wm8775_write(client, R15, 0x1d4); /* ADC gain +2.5dB, enable zero cross */
197 wm8775_write(client, R16, 0x1bf); /* ALC Stereo, ALC target level -1dB FS */
198 /* max gain +8dB */
199 wm8775_write(client, R17, 0x185); /* Enable gain control, use zero cross */
200 /* detection, ALC hold time 42.6 ms */
201 wm8775_write(client, R18, 0x0a2); /* ALC gain ramp up delay 34 s, */
202 /* ALC gain ramp down delay 33 ms */
203 wm8775_write(client, R19, 0x005); /* Enable noise gate, threshold -72dBfs */
204 wm8775_write(client, R20, 0x07a); /* Transient window 4ms, lower PGA gain */
205 /* limit -1dB */
206 wm8775_write(client, R21, 0x102); /* LRBOTH = 1, use input 2. */
207 i2c_attach_client(client);
208
209 return 0;
210}
211
212static int wm8775_probe(struct i2c_adapter *adapter)
213{
0edeea4f 214 if (adapter->class & I2C_CLASS_TV_ANALOG)
e2998e10 215 return i2c_probe(adapter, &addr_data, wm8775_attach);
0edeea4f
HV
216 return 0;
217}
218
219static int wm8775_detach(struct i2c_client *client)
220{
221 int err;
222
223 err = i2c_detach_client(client);
224 if (err) {
225 return err;
226 }
227 kfree(client);
228
229 return 0;
230}
231
232/* ----------------------------------------------------------------------- */
233
234/* i2c implementation */
235static struct i2c_driver i2c_driver = {
604f28e2 236 .driver = {
604f28e2
LR
237 .name = "wm8775",
238 },
cab462f7 239 .id = I2C_DRIVERID_WM8775,
0edeea4f 240 .attach_adapter = wm8775_probe,
cab462f7
MCC
241 .detach_client = wm8775_detach,
242 .command = wm8775_command,
0edeea4f
HV
243};
244
245
246static int __init wm8775_init_module(void)
247{
248 return i2c_add_driver(&i2c_driver);
249}
250
251static void __exit wm8775_cleanup_module(void)
252{
253 i2c_del_driver(&i2c_driver);
254}
255
256module_init(wm8775_init_module);
257module_exit(wm8775_cleanup_module);