i2c/cx25840/cx25840-audio.c

31 static int cx25840_set_audclk_freq(struct i2c_client *client, u32 freq)
33 	struct cx25840_state *state = to_state(i2c_get_clientdata(client));
42 			cx25840_write4(client, 0x108, 0x1006040f);
57 			cx25840_write4(client, 0x110, 0x01bb39ee);
63 			cx25840_write(client, 0x127, 0x50);
70 			cx25840_write4(client, 0x900, 0x0801f77f);
71 			cx25840_write4(client, 0x904, 0x0801f77f);
72 			cx25840_write4(client, 0x90c, 0x0801f77f);
80 			cx25840_write4(client, 0x108, 0x1009040f);
94 			cx25840_write4(client, 0x110, 0x00ec6bd6);
100 			cx25840_write(client, 0x127, 0x50);
107 			cx25840_write4(client, 0x900, 0x08016d59);
108 			cx25840_write4(client, 0x904, 0x08016d59);
109 			cx25840_write4(client, 0x90c, 0x08016d59);
117 			cx25840_write4(client, 0x108, 0x100a040f);
131 			cx25840_write4(client, 0x110, 0x0098d6e5);
137 			cx25840_write(client, 0x127, 0x50);
144 			cx25840_write4(client, 0x900, 0x08014faa);
145 			cx25840_write4(client, 0x904, 0x08014faa);
146 			cx25840_write4(client, 0x90c, 0x08014faa);
156 			cx25840_write4(client, 0x108, 0x1e08040f);
170 			cx25840_write4(client, 0x110, 0x012a0869);
176 			cx25840_write(client, 0x127, 0x54);
183 			cx25840_write4(client, 0x8f8, 0x08010000);
187 			cx25840_write4(client, 0x900, 0x08020000);
188 			cx25840_write4(client, 0x904, 0x08020000);
189 			cx25840_write4(client, 0x90c, 0x08020000);
197 			cx25840_write4(client, 0x108, 0x1809040f);
211 			cx25840_write4(client, 0x110, 0x00ec6bd6);
217 			cx25840_write(client, 0x127, 0x50);
224 			cx25840_write4(client, 0x8f8, 0x080160cd);
228 			cx25840_write4(client, 0x900, 0x08017385);
229 			cx25840_write4(client, 0x904, 0x08017385);
230 			cx25840_write4(client, 0x90c, 0x08017385);
238 			cx25840_write4(client, 0x108, 0x180a040f);
252 			cx25840_write4(client, 0x110, 0x0098d6e5);
258 			cx25840_write(client, 0x127, 0x50);
265 			cx25840_write4(client, 0x8f8, 0x08018000);
269 			cx25840_write4(client, 0x900, 0x08015555);
270 			cx25840_write4(client, 0x904, 0x08015555);
271 			cx25840_write4(client, 0x90c, 0x08015555);
281 static inline int cx25836_set_audclk_freq(struct i2c_client *client, u32 freq)
283 	return cx25840_set_audclk_freq(client, freq);
286 static int cx23885_set_audclk_freq(struct i2c_client *client, u32 freq)
288 	struct cx25840_state *state = to_state(i2c_get_clientdata(client));
312 			cx25840_write4(client, 0x8f8, 0x0801867c);
316 			cx25840_write4(client, 0x900, 0x08014faa);
317 			cx25840_write4(client, 0x904, 0x08014faa);
318 			cx25840_write4(client, 0x90c, 0x08014faa);
328 static int cx231xx_set_audclk_freq(struct i2c_client *client, u32 freq)
330 	struct cx25840_state *state = to_state(i2c_get_clientdata(client));
337 			cx25840_write4(client, 0x900, 0x0801f77f);
338 			cx25840_write4(client, 0x904, 0x0801f77f);
339 			cx25840_write4(client, 0x90c, 0x0801f77f);
345 			cx25840_write4(client, 0x900, 0x08016d59);
346 			cx25840_write4(client, 0x904, 0x08016d59);
347 			cx25840_write4(client, 0x90c, 0x08016d59);
353 			cx25840_write4(client, 0x900, 0x08014faa);
354 			cx25840_write4(client, 0x904, 0x08014faa);
355 			cx25840_write4(client, 0x90c, 0x08014faa);
364 			cx25840_write4(client, 0x8f8, 0x08010000);
368 			cx25840_write4(client, 0x900, 0x08020000);
369 			cx25840_write4(client, 0x904, 0x08020000);
370 			cx25840_write4(client, 0x90c, 0x08020000);
376 			cx25840_write4(client, 0x8f8, 0x080160cd);
380 			cx25840_write4(client, 0x900, 0x08017385);
381 			cx25840_write4(client, 0x904, 0x08017385);
382 			cx25840_write4(client, 0x90c, 0x08017385);
388 			cx25840_write4(client, 0x8f8, 0x0801867c);
392 			cx25840_write4(client, 0x900, 0x08014faa);
393 			cx25840_write4(client, 0x904, 0x08014faa);
394 			cx25840_write4(client, 0x90c, 0x08014faa);
404 static int set_audclk_freq(struct i2c_client *client, u32 freq)
406 	struct cx25840_state *state = to_state(i2c_get_clientdata(client));
412 		return cx231xx_set_audclk_freq(client, freq);
415 		return cx23885_set_audclk_freq(client, freq);
418 		return cx25836_set_audclk_freq(client, freq);
420 	return cx25840_set_audclk_freq(client, freq);
423 void cx25840_audio_set_path(struct i2c_client *client)
425 	struct cx25840_state *state = to_state(i2c_get_clientdata(client));
429 		cx25840_and_or(client, 0x810, ~0x1, 0x01);
432 		cx25840_and_or(client, 0x803, ~0x10, 0);
435 		cx25840_write(client, 0x8d3, 0x1f);
439 			cx25840_write4(client, 0x8d0, 0x01011012);
446 			cx25840_write4(client, 0x8d0, 0x1f063870);
450 	set_audclk_freq(client, state->audclk_freq);
456 			cx25840_and_or(client, 0x803, ~0x10, 0x10);
460 		cx25840_and_or(client, 0x810, ~0x1, 0x00);
464 			cx25840_and_or(client, 0x803, ~0x10, 0x10);
468 static void set_volume(struct i2c_client *client, int volume)
485 	cx25840_write(client, 0x8d4, 228 - (vol * 2));
488 static void set_balance(struct i2c_client *client, int balance)
493 		cx25840_and_or(client, 0x8d5, 0x7f, 0x80);
495 		cx25840_and_or(client, 0x8d5, ~0x7f, bal & 0x7f);
498 		cx25840_and_or(client, 0x8d5, 0x7f, 0x00);
500 		cx25840_and_or(client, 0x8d5, ~0x7f, 0x80 - bal);
506 	struct i2c_client *client = v4l2_get_subdevdata(sd);
511 		cx25840_and_or(client, 0x810, ~0x1, 1);
513 		cx25840_and_or(client, 0x803, ~0x10, 0);
514 		cx25840_write(client, 0x8d3, 0x1f);
516 	retval = set_audclk_freq(client, freq);
518 		cx25840_and_or(client, 0x803, ~0x10, 0x10);
520 		cx25840_and_or(client, 0x810, ~0x1, 0);
528 	struct i2c_client *client = v4l2_get_subdevdata(sd);
533 			set_volume(client, 0);
535 			set_volume(client, state->volume->val);
539 		cx25840_and_or(client, 0x8d9, ~0x3f,
544 		cx25840_and_or(client, 0x8db, ~0x3f,
548 		set_balance(client, ctrl->val);