^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2005-2006 Micronas USA Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/videodev2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <media/tuner.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <media/v4l2-common.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <media/v4l2-ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) MODULE_DESCRIPTION("sony-btf-mpx driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) static int debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) module_param(debug, int, 0644);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) MODULE_PARM_DESC(debug, "debug level 0=off(default) 1=on");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) /* #define MPX_DEBUG */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * Note:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * AS(IF/MPX) pin: LOW HIGH/OPEN
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * IF/MPX address: 0x42/0x40 0x43/0x44
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) static int force_mpx_mode = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) module_param(force_mpx_mode, int, 0644);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct sony_btf_mpx {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct v4l2_subdev sd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int mpxmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) u32 audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) static inline struct sony_btf_mpx *to_state(struct v4l2_subdev *sd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) return container_of(sd, struct sony_btf_mpx, sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static int mpx_write(struct i2c_client *client, int dev, int addr, int val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) u8 buffer[5];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) struct i2c_msg msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) buffer[0] = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) buffer[1] = addr >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) buffer[2] = addr & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) buffer[3] = val >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) buffer[4] = val & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) msg.addr = client->addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) msg.flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) msg.len = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) msg.buf = buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) i2c_transfer(client->adapter, &msg, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) * MPX register values for the BTF-PG472Z:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) * FM_ NICAM_ SCART_
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) * MODUS SOURCE ACB PRESCAL PRESCAL PRESCAL SYSTEM VOLUME
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) * 10/0030 12/0008 12/0013 12/000E 12/0010 12/0000 10/0020 12/0000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) * ---------------------------------------------------------------
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) * Auto 1003 0020 0100 2603 5000 XXXX 0001 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) * B/G
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) * Mono 1003 0020 0100 2603 5000 XXXX 0003 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) * A2 1003 0020 0100 2601 5000 XXXX 0003 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) * NICAM 1003 0120 0100 2603 5000 XXXX 0008 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * I
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) * Mono 1003 0020 0100 2603 7900 XXXX 000A 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) * NICAM 1003 0120 0100 2603 7900 XXXX 000A 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) * D/K
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) * Mono 1003 0020 0100 2603 5000 XXXX 0004 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) * A2-1 1003 0020 0100 2601 5000 XXXX 0004 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) * A2-2 1003 0020 0100 2601 5000 XXXX 0005 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) * A2-3 1003 0020 0100 2601 5000 XXXX 0007 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) * NICAM 1003 0120 0100 2603 5000 XXXX 000B 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) * L/L'
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) * Mono 0003 0200 0100 7C03 5000 2200 0009 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) * NICAM 0003 0120 0100 7C03 5000 XXXX 0009 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) * M
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) * Mono 1003 0200 0100 2B03 5000 2B00 0002 7500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) * For Asia, replace the 0x26XX in FM_PRESCALE with 0x14XX.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) * Bilingual selection in A2/NICAM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) * High byte of SOURCE Left chan Right chan
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) * 0x01 MAIN SUB
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) * 0x03 MAIN MAIN
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) * 0x04 SUB SUB
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) * Force mono in NICAM by setting the high byte of SOURCE to 0x02 (L/L') or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) * 0x00 (all other bands). Force mono in A2 with FMONO_A2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) * FMONO_A2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) * 10/0022
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) * --------
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) * Forced mono ON 07F0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) * Forced mono OFF 0190
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static const struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) enum { AUD_MONO, AUD_A2, AUD_NICAM, AUD_NICAM_L } audio_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) u16 modus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) u16 source;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) u16 acb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) u16 fm_prescale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) u16 nicam_prescale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) u16 scart_prescale;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) u16 system;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) u16 volume;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) } mpx_audio_modes[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) /* Auto */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 0x5000, 0x0000, 0x0001, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) /* B/G Mono */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 0x5000, 0x0000, 0x0003, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) /* B/G A2 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 0x5000, 0x0000, 0x0003, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) /* B/G NICAM */ { AUD_NICAM, 0x1003, 0x0120, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 0x5000, 0x0000, 0x0008, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) /* I Mono */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 0x7900, 0x0000, 0x000A, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) /* I NICAM */ { AUD_NICAM, 0x1003, 0x0120, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 0x7900, 0x0000, 0x000A, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) /* D/K Mono */ { AUD_MONO, 0x1003, 0x0020, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 0x5000, 0x0000, 0x0004, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) /* D/K A2-1 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 0x5000, 0x0000, 0x0004, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) /* D/K A2-2 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 0x5000, 0x0000, 0x0005, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) /* D/K A2-3 */ { AUD_A2, 0x1003, 0x0020, 0x0100, 0x2601,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 0x5000, 0x0000, 0x0007, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) /* D/K NICAM */ { AUD_NICAM, 0x1003, 0x0120, 0x0100, 0x2603,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 0x5000, 0x0000, 0x000B, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) /* L/L' Mono */ { AUD_MONO, 0x0003, 0x0200, 0x0100, 0x7C03,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 0x5000, 0x2200, 0x0009, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) /* L/L' NICAM */{ AUD_NICAM_L, 0x0003, 0x0120, 0x0100, 0x7C03,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 0x5000, 0x0000, 0x0009, 0x7500 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) #define MPX_NUM_MODES ARRAY_SIZE(mpx_audio_modes)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) static int mpx_setup(struct sony_btf_mpx *t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) struct i2c_client *client = v4l2_get_subdevdata(&t->sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) u16 source = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) u8 buffer[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) struct i2c_msg msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) int mode = t->mpxmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* reset MPX */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) buffer[0] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) buffer[1] = 0x80;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) buffer[2] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) msg.addr = client->addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) msg.flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) msg.len = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) msg.buf = buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) i2c_transfer(client->adapter, &msg, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) buffer[1] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) i2c_transfer(client->adapter, &msg, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) if (t->audmode != V4L2_TUNER_MODE_MONO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) mode++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) if (mpx_audio_modes[mode].audio_mode != AUD_MONO) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) switch (t->audmode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) case V4L2_TUNER_MODE_MONO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) switch (mpx_audio_modes[mode].audio_mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) case AUD_A2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) source = mpx_audio_modes[mode].source;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) case AUD_NICAM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) source = 0x0000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) case AUD_NICAM_L:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) source = 0x0200;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) case V4L2_TUNER_MODE_STEREO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) source = mpx_audio_modes[mode].source;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) case V4L2_TUNER_MODE_LANG1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) source = 0x0300;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) case V4L2_TUNER_MODE_LANG2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) source = 0x0400;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) source |= mpx_audio_modes[mode].source & 0x00ff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) source = mpx_audio_modes[mode].source;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) mpx_write(client, 0x10, 0x0030, mpx_audio_modes[mode].modus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) mpx_write(client, 0x12, 0x0008, source);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) mpx_write(client, 0x12, 0x0013, mpx_audio_modes[mode].acb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) mpx_write(client, 0x12, 0x000e,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) mpx_audio_modes[mode].fm_prescale);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) mpx_write(client, 0x12, 0x0010,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) mpx_audio_modes[mode].nicam_prescale);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) mpx_write(client, 0x12, 0x000d,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) mpx_audio_modes[mode].scart_prescale);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) mpx_write(client, 0x10, 0x0020, mpx_audio_modes[mode].system);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) mpx_write(client, 0x12, 0x0000, mpx_audio_modes[mode].volume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if (mpx_audio_modes[mode].audio_mode == AUD_A2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) mpx_write(client, 0x10, 0x0022,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) t->audmode == V4L2_TUNER_MODE_MONO ? 0x07f0 : 0x0190);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) #ifdef MPX_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) u8 buf1[3], buf2[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct i2c_msg msgs[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) v4l2_info(client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) "MPX registers: %04x %04x %04x %04x %04x %04x %04x %04x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) mpx_audio_modes[mode].modus,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) source,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) mpx_audio_modes[mode].acb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) mpx_audio_modes[mode].fm_prescale,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) mpx_audio_modes[mode].nicam_prescale,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) mpx_audio_modes[mode].scart_prescale,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) mpx_audio_modes[mode].system,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) mpx_audio_modes[mode].volume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) buf1[0] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) buf1[1] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) buf1[2] = 0x7e;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) msgs[0].addr = client->addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) msgs[0].flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) msgs[0].len = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) msgs[0].buf = buf1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) msgs[1].addr = client->addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) msgs[1].flags = I2C_M_RD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) msgs[1].len = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) msgs[1].buf = buf2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) i2c_transfer(client->adapter, msgs, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) v4l2_info(client, "MPX system: %02x%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) buf2[0], buf2[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) buf1[0] = 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) buf1[1] = 0x02;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) buf1[2] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) i2c_transfer(client->adapter, msgs, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) v4l2_info(client, "MPX status: %02x%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) buf2[0], buf2[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) static int sony_btf_mpx_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) struct sony_btf_mpx *t = to_state(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) int default_mpx_mode = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) if (std & V4L2_STD_PAL_BG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) default_mpx_mode = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) else if (std & V4L2_STD_PAL_I)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) default_mpx_mode = 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) else if (std & V4L2_STD_PAL_DK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) default_mpx_mode = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) else if (std & V4L2_STD_SECAM_L)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) default_mpx_mode = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) if (default_mpx_mode != t->mpxmode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) t->mpxmode = default_mpx_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) mpx_setup(t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) static int sony_btf_mpx_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) struct sony_btf_mpx *t = to_state(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) vt->capability = V4L2_TUNER_CAP_NORM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LANG1 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) V4L2_TUNER_CAP_LANG2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) vt->rxsubchans = V4L2_TUNER_SUB_MONO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) V4L2_TUNER_SUB_STEREO | V4L2_TUNER_SUB_LANG1 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) V4L2_TUNER_SUB_LANG2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) vt->audmode = t->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) static int sony_btf_mpx_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) struct sony_btf_mpx *t = to_state(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) if (vt->type != V4L2_TUNER_ANALOG_TV)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) if (vt->audmode != t->audmode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) t->audmode = vt->audmode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) mpx_setup(t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) /* --------------------------------------------------------------------------*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) static const struct v4l2_subdev_tuner_ops sony_btf_mpx_tuner_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) .s_tuner = sony_btf_mpx_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) .g_tuner = sony_btf_mpx_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) static const struct v4l2_subdev_video_ops sony_btf_mpx_video_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) .s_std = sony_btf_mpx_s_std,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) static const struct v4l2_subdev_ops sony_btf_mpx_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) .tuner = &sony_btf_mpx_tuner_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) .video = &sony_btf_mpx_video_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) /* --------------------------------------------------------------------------*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) static int sony_btf_mpx_probe(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) const struct i2c_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) struct sony_btf_mpx *t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) struct v4l2_subdev *sd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) v4l_info(client, "chip found @ 0x%x (%s)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) client->addr << 1, client->adapter->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) t = devm_kzalloc(&client->dev, sizeof(*t), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) if (t == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) sd = &t->sd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) v4l2_i2c_subdev_init(sd, client, &sony_btf_mpx_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) /* Initialize sony_btf_mpx */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) t->mpxmode = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) t->audmode = V4L2_TUNER_MODE_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) static int sony_btf_mpx_remove(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) struct v4l2_subdev *sd = i2c_get_clientdata(client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) v4l2_device_unregister_subdev(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) /* ----------------------------------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) static const struct i2c_device_id sony_btf_mpx_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) { "sony-btf-mpx", 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) MODULE_DEVICE_TABLE(i2c, sony_btf_mpx_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) static struct i2c_driver sony_btf_mpx_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) .name = "sony-btf-mpx",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) .probe = sony_btf_mpx_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) .remove = sony_btf_mpx_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) .id_table = sony_btf_mpx_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) module_i2c_driver(sony_btf_mpx_driver);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags