PageRenderTime 46ms CodeModel.GetById 31ms app.highlight 11ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/media/video/wm8775.c

https://bitbucket.org/abioy/linux
C | 268 lines | 168 code | 41 blank | 59 comment | 15 complexity | 70ea0b1aab330efbdd96b6df5f233fe3 MD5 | raw file
Possible License(s): CC-BY-SA-3.0, GPL-2.0, LGPL-2.0, AGPL-1.0
  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 *
  8 * Copyright (C) 2005 Hans Verkuil <hverkuil@xs4all.nl>
  9 * - Cleanup
 10 * - V4L2 API update
 11 * - sound fixes
 12 *
 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
 28#include <linux/module.h>
 29#include <linux/types.h>
 30#include <linux/slab.h>
 31#include <linux/ioctl.h>
 32#include <asm/uaccess.h>
 33#include <linux/i2c.h>
 34#include <linux/i2c-id.h>
 35#include <linux/videodev2.h>
 36#include <media/v4l2-device.h>
 37#include <media/v4l2-chip-ident.h>
 38#include <media/v4l2-i2c-drv.h>
 39
 40MODULE_DESCRIPTION("wm8775 driver");
 41MODULE_AUTHOR("Ulf Eklund, Hans Verkuil");
 42MODULE_LICENSE("GPL");
 43
 44
 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	struct v4l2_subdev sd;
 56	u8 input;		/* Last selected input (0-0xf) */
 57	u8 muted;
 58};
 59
 60static inline struct wm8775_state *to_state(struct v4l2_subdev *sd)
 61{
 62	return container_of(sd, struct wm8775_state, sd);
 63}
 64
 65static int wm8775_write(struct v4l2_subdev *sd, int reg, u16 val)
 66{
 67	struct i2c_client *client = v4l2_get_subdevdata(sd);
 68	int i;
 69
 70	if (reg < 0 || reg >= TOT_REGS) {
 71		v4l2_err(sd, "Invalid register R%d\n", reg);
 72		return -1;
 73	}
 74
 75	for (i = 0; i < 3; i++)
 76		if (i2c_smbus_write_byte_data(client,
 77				(reg << 1) | (val >> 8), val & 0xff) == 0)
 78			return 0;
 79	v4l2_err(sd, "I2C: cannot write %03x to register R%d\n", val, reg);
 80	return -1;
 81}
 82
 83static int wm8775_s_routing(struct v4l2_subdev *sd,
 84			    u32 input, u32 output, u32 config)
 85{
 86	struct wm8775_state *state = to_state(sd);
 87
 88	/* There are 4 inputs and one output. Zero or more inputs
 89	   are multiplexed together to the output. Hence there are
 90	   16 combinations.
 91	   If only one input is active (the normal case) then the
 92	   input values 1, 2, 4 or 8 should be used. */
 93	if (input > 15) {
 94		v4l2_err(sd, "Invalid input %d.\n", input);
 95		return -EINVAL;
 96	}
 97	state->input = input;
 98	if (state->muted)
 99		return 0;
100	wm8775_write(sd, R21, 0x0c0);
101	wm8775_write(sd, R14, 0x1d4);
102	wm8775_write(sd, R15, 0x1d4);
103	wm8775_write(sd, R21, 0x100 + state->input);
104	return 0;
105}
106
107static int wm8775_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
108{
109	struct wm8775_state *state = to_state(sd);
110
111	if (ctrl->id != V4L2_CID_AUDIO_MUTE)
112		return -EINVAL;
113	ctrl->value = state->muted;
114	return 0;
115}
116
117static int wm8775_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
118{
119	struct wm8775_state *state = to_state(sd);
120
121	if (ctrl->id != V4L2_CID_AUDIO_MUTE)
122		return -EINVAL;
123	state->muted = ctrl->value;
124	wm8775_write(sd, R21, 0x0c0);
125	wm8775_write(sd, R14, 0x1d4);
126	wm8775_write(sd, R15, 0x1d4);
127	if (!state->muted)
128		wm8775_write(sd, R21, 0x100 + state->input);
129	return 0;
130}
131
132static int wm8775_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
133{
134	struct i2c_client *client = v4l2_get_subdevdata(sd);
135
136	return v4l2_chip_ident_i2c_client(client, chip, V4L2_IDENT_WM8775, 0);
137}
138
139static int wm8775_log_status(struct v4l2_subdev *sd)
140{
141	struct wm8775_state *state = to_state(sd);
142
143	v4l2_info(sd, "Input: %d%s\n", state->input,
144			state->muted ? " (muted)" : "");
145	return 0;
146}
147
148static int wm8775_s_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *freq)
149{
150	struct wm8775_state *state = to_state(sd);
151
152	/* If I remove this, then it can happen that I have no
153	   sound the first time I tune from static to a valid channel.
154	   It's difficult to reproduce and is almost certainly related
155	   to the zero cross detect circuit. */
156	wm8775_write(sd, R21, 0x0c0);
157	wm8775_write(sd, R14, 0x1d4);
158	wm8775_write(sd, R15, 0x1d4);
159	wm8775_write(sd, R21, 0x100 + state->input);
160	return 0;
161}
162
163/* ----------------------------------------------------------------------- */
164
165static const struct v4l2_subdev_core_ops wm8775_core_ops = {
166	.log_status = wm8775_log_status,
167	.g_chip_ident = wm8775_g_chip_ident,
168	.g_ctrl = wm8775_g_ctrl,
169	.s_ctrl = wm8775_s_ctrl,
170};
171
172static const struct v4l2_subdev_tuner_ops wm8775_tuner_ops = {
173	.s_frequency = wm8775_s_frequency,
174};
175
176static const struct v4l2_subdev_audio_ops wm8775_audio_ops = {
177	.s_routing = wm8775_s_routing,
178};
179
180static const struct v4l2_subdev_ops wm8775_ops = {
181	.core = &wm8775_core_ops,
182	.tuner = &wm8775_tuner_ops,
183	.audio = &wm8775_audio_ops,
184};
185
186/* ----------------------------------------------------------------------- */
187
188/* i2c implementation */
189
190/*
191 * Generic i2c probe
192 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
193 */
194
195static int wm8775_probe(struct i2c_client *client,
196			const struct i2c_device_id *id)
197{
198	struct wm8775_state *state;
199	struct v4l2_subdev *sd;
200
201	/* Check if the adapter supports the needed features */
202	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
203		return -EIO;
204
205	v4l_info(client, "chip found @ 0x%02x (%s)\n",
206			client->addr << 1, client->adapter->name);
207
208	state = kmalloc(sizeof(struct wm8775_state), GFP_KERNEL);
209	if (state == NULL)
210		return -ENOMEM;
211	sd = &state->sd;
212	v4l2_i2c_subdev_init(sd, client, &wm8775_ops);
213	state->input = 2;
214	state->muted = 0;
215
216	/* Initialize wm8775 */
217
218	/* RESET */
219	wm8775_write(sd, R23, 0x000);
220	/* Disable zero cross detect timeout */
221	wm8775_write(sd, R7, 0x000);
222	/* Left justified, 24-bit mode */
223	wm8775_write(sd, R11, 0x021);
224	/* Master mode, clock ratio 256fs */
225	wm8775_write(sd, R12, 0x102);
226	/* Powered up */
227	wm8775_write(sd, R13, 0x000);
228	/* ADC gain +2.5dB, enable zero cross */
229	wm8775_write(sd, R14, 0x1d4);
230	/* ADC gain +2.5dB, enable zero cross */
231	wm8775_write(sd, R15, 0x1d4);
232	/* ALC Stereo, ALC target level -1dB FS max gain +8dB */
233	wm8775_write(sd, R16, 0x1bf);
234	/* Enable gain control, use zero cross detection,
235	   ALC hold time 42.6 ms */
236	wm8775_write(sd, R17, 0x185);
237	/* ALC gain ramp up delay 34 s, ALC gain ramp down delay 33 ms */
238	wm8775_write(sd, R18, 0x0a2);
239	/* Enable noise gate, threshold -72dBfs */
240	wm8775_write(sd, R19, 0x005);
241	/* Transient window 4ms, lower PGA gain limit -1dB */
242	wm8775_write(sd, R20, 0x07a);
243	/* LRBOTH = 1, use input 2. */
244	wm8775_write(sd, R21, 0x102);
245	return 0;
246}
247
248static int wm8775_remove(struct i2c_client *client)
249{
250	struct v4l2_subdev *sd = i2c_get_clientdata(client);
251
252	v4l2_device_unregister_subdev(sd);
253	kfree(to_state(sd));
254	return 0;
255}
256
257static const struct i2c_device_id wm8775_id[] = {
258	{ "wm8775", 0 },
259	{ }
260};
261MODULE_DEVICE_TABLE(i2c, wm8775_id);
262
263static struct v4l2_i2c_driver_data v4l2_i2c_data = {
264	.name = "wm8775",
265	.probe = wm8775_probe,
266	.remove = wm8775_remove,
267	.id_table = wm8775_id,
268};