Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 1 | /* |
| 2 | * For Philips TEA5767 FM Chip used on some TV Cards like Prolink Pixelview |
| 3 | * I2C address is allways 0xC0. |
| 4 | * |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 5 | * |
Mauro Carvalho Chehab | 2e7c6dc | 2006-04-03 07:53:40 -0300 | [diff] [blame] | 6 | * Copyright (c) 2005 Mauro Carvalho Chehab (mchehab@infradead.org) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 7 | * This code is placed under the terms of the GNU General Public License |
| 8 | * |
| 9 | * tea5767 autodetection thanks to Torsten Seeboth and Atsushi Nakagawa |
| 10 | * from their contributions on DScaler. |
| 11 | */ |
| 12 | |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 13 | #include <linux/i2c.h> |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 14 | #include <linux/delay.h> |
Michael Krufky | ffbb807 | 2007-08-21 01:14:12 -0300 | [diff] [blame] | 15 | #include <linux/videodev.h> |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 16 | #include "tuner-i2c.h" |
| 17 | #include "tea5767.h" |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 18 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 19 | static int debug = 0; |
| 20 | module_param(debug, int, 0644); |
| 21 | MODULE_PARM_DESC(debug, "enable verbose debug messages"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 22 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 23 | #define PREFIX "tea5767 " |
Hans Verkuil | fac9e89 | 2006-01-09 15:32:40 -0200 | [diff] [blame] | 24 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 25 | /*****************************************************************************/ |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 26 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 27 | struct tea5767_priv { |
| 28 | struct tuner_i2c_props i2c_props; |
| 29 | u32 frequency; |
| 30 | struct tea5767_ctrl ctrl; |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 31 | }; |
| 32 | |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 33 | /*****************************************************************************/ |
| 34 | |
| 35 | /****************************** |
| 36 | * Write mode register values * |
| 37 | ******************************/ |
| 38 | |
| 39 | /* First register */ |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 40 | #define TEA5767_MUTE 0x80 /* Mutes output */ |
| 41 | #define TEA5767_SEARCH 0x40 /* Activates station search */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 42 | /* Bits 0-5 for divider MSB */ |
| 43 | |
| 44 | /* Second register */ |
| 45 | /* Bits 0-7 for divider LSB */ |
| 46 | |
| 47 | /* Third register */ |
| 48 | |
| 49 | /* Station search from botton to up */ |
| 50 | #define TEA5767_SEARCH_UP 0x80 |
| 51 | |
| 52 | /* Searches with ADC output = 10 */ |
| 53 | #define TEA5767_SRCH_HIGH_LVL 0x60 |
| 54 | |
| 55 | /* Searches with ADC output = 10 */ |
| 56 | #define TEA5767_SRCH_MID_LVL 0x40 |
| 57 | |
| 58 | /* Searches with ADC output = 5 */ |
| 59 | #define TEA5767_SRCH_LOW_LVL 0x20 |
| 60 | |
| 61 | /* if on, div=4*(Frf+Fif)/Fref otherwise, div=4*(Frf-Fif)/Freq) */ |
| 62 | #define TEA5767_HIGH_LO_INJECT 0x10 |
| 63 | |
| 64 | /* Disable stereo */ |
| 65 | #define TEA5767_MONO 0x08 |
| 66 | |
| 67 | /* Disable right channel and turns to mono */ |
| 68 | #define TEA5767_MUTE_RIGHT 0x04 |
| 69 | |
| 70 | /* Disable left channel and turns to mono */ |
| 71 | #define TEA5767_MUTE_LEFT 0x02 |
| 72 | |
| 73 | #define TEA5767_PORT1_HIGH 0x01 |
| 74 | |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 75 | /* Fourth register */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 76 | #define TEA5767_PORT2_HIGH 0x80 |
| 77 | /* Chips stops working. Only I2C bus remains on */ |
| 78 | #define TEA5767_STDBY 0x40 |
| 79 | |
| 80 | /* Japan freq (76-108 MHz. If disabled, 87.5-108 MHz */ |
| 81 | #define TEA5767_JAPAN_BAND 0x20 |
| 82 | |
| 83 | /* Unselected means 32.768 KHz freq as reference. Otherwise Xtal at 13 MHz */ |
| 84 | #define TEA5767_XTAL_32768 0x10 |
| 85 | |
| 86 | /* Cuts weak signals */ |
| 87 | #define TEA5767_SOFT_MUTE 0x08 |
| 88 | |
| 89 | /* Activates high cut control */ |
| 90 | #define TEA5767_HIGH_CUT_CTRL 0x04 |
| 91 | |
| 92 | /* Activates stereo noise control */ |
| 93 | #define TEA5767_ST_NOISE_CTL 0x02 |
| 94 | |
| 95 | /* If activate PORT 1 indicates SEARCH or else it is used as PORT1 */ |
| 96 | #define TEA5767_SRCH_IND 0x01 |
| 97 | |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 98 | /* Fifth register */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 99 | |
| 100 | /* By activating, it will use Xtal at 13 MHz as reference for divider */ |
| 101 | #define TEA5767_PLLREF_ENABLE 0x80 |
| 102 | |
| 103 | /* By activating, deemphasis=50, or else, deemphasis of 50us */ |
| 104 | #define TEA5767_DEEMPH_75 0X40 |
| 105 | |
| 106 | /***************************** |
| 107 | * Read mode register values * |
| 108 | *****************************/ |
| 109 | |
| 110 | /* First register */ |
| 111 | #define TEA5767_READY_FLAG_MASK 0x80 |
| 112 | #define TEA5767_BAND_LIMIT_MASK 0X40 |
| 113 | /* Bits 0-5 for divider MSB after search or preset */ |
| 114 | |
| 115 | /* Second register */ |
| 116 | /* Bits 0-7 for divider LSB after search or preset */ |
| 117 | |
| 118 | /* Third register */ |
| 119 | #define TEA5767_STEREO_MASK 0x80 |
| 120 | #define TEA5767_IF_CNTR_MASK 0x7f |
| 121 | |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 122 | /* Fourth register */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 123 | #define TEA5767_ADC_LEVEL_MASK 0xf0 |
| 124 | |
| 125 | /* should be 0 */ |
| 126 | #define TEA5767_CHIP_ID_MASK 0x0f |
| 127 | |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 128 | /* Fifth register */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 129 | /* Reserved for future extensions */ |
| 130 | #define TEA5767_RESERVED_MASK 0xff |
| 131 | |
| 132 | /*****************************************************************************/ |
| 133 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 134 | static void tea5767_status_dump(struct tea5767_priv *priv, |
| 135 | unsigned char *buffer) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 136 | { |
| 137 | unsigned int div, frq; |
| 138 | |
| 139 | if (TEA5767_READY_FLAG_MASK & buffer[0]) |
| 140 | printk(PREFIX "Ready Flag ON\n"); |
| 141 | else |
| 142 | printk(PREFIX "Ready Flag OFF\n"); |
| 143 | |
| 144 | if (TEA5767_BAND_LIMIT_MASK & buffer[0]) |
| 145 | printk(PREFIX "Tuner at band limit\n"); |
| 146 | else |
| 147 | printk(PREFIX "Tuner not at band limit\n"); |
| 148 | |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 149 | div = ((buffer[0] & 0x3f) << 8) | buffer[1]; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 150 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 151 | switch (priv->ctrl.xtal_freq) { |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 152 | case TEA5767_HIGH_LO_13MHz: |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 153 | frq = (div * 50000 - 700000 - 225000) / 4; /* Freq in KHz */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 154 | break; |
| 155 | case TEA5767_LOW_LO_13MHz: |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 156 | frq = (div * 50000 + 700000 + 225000) / 4; /* Freq in KHz */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 157 | break; |
| 158 | case TEA5767_LOW_LO_32768: |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 159 | frq = (div * 32768 + 700000 + 225000) / 4; /* Freq in KHz */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 160 | break; |
| 161 | case TEA5767_HIGH_LO_32768: |
| 162 | default: |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 163 | frq = (div * 32768 - 700000 - 225000) / 4; /* Freq in KHz */ |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 164 | break; |
| 165 | } |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 166 | buffer[0] = (div >> 8) & 0x3f; |
| 167 | buffer[1] = div & 0xff; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 168 | |
| 169 | printk(PREFIX "Frequency %d.%03d KHz (divider = 0x%04x)\n", |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 170 | frq / 1000, frq % 1000, div); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 171 | |
| 172 | if (TEA5767_STEREO_MASK & buffer[2]) |
| 173 | printk(PREFIX "Stereo\n"); |
| 174 | else |
| 175 | printk(PREFIX "Mono\n"); |
| 176 | |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 177 | printk(PREFIX "IF Counter = %d\n", buffer[2] & TEA5767_IF_CNTR_MASK); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 178 | |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 179 | printk(PREFIX "ADC Level = %d\n", |
| 180 | (buffer[3] & TEA5767_ADC_LEVEL_MASK) >> 4); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 181 | |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 182 | printk(PREFIX "Chip ID = %d\n", (buffer[3] & TEA5767_CHIP_ID_MASK)); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 183 | |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 184 | printk(PREFIX "Reserved = 0x%02x\n", |
| 185 | (buffer[4] & TEA5767_RESERVED_MASK)); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 186 | } |
| 187 | |
| 188 | /* Freq should be specifyed at 62.5 Hz */ |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 189 | static int set_radio_freq(struct dvb_frontend *fe, |
| 190 | struct analog_parameters *params) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 191 | { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 192 | struct tea5767_priv *priv = fe->tuner_priv; |
| 193 | unsigned int frq = params->frequency; |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 194 | unsigned char buffer[5]; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 195 | unsigned div; |
| 196 | int rc; |
| 197 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 198 | tuner_dbg("radio freq = %d.%03d MHz\n", frq/16000,(frq/16)%1000); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 199 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 200 | buffer[2] = 0; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 201 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 202 | if (priv->ctrl.port1) |
| 203 | buffer[2] |= TEA5767_PORT1_HIGH; |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 204 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 205 | if (params->audmode == V4L2_TUNER_MODE_MONO) { |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 206 | tuner_dbg("TEA5767 set to mono\n"); |
| 207 | buffer[2] |= TEA5767_MONO; |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 208 | } else { |
| 209 | tuner_dbg("TEA5767 set to stereo\n"); |
| 210 | } |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 211 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 212 | |
| 213 | buffer[3] = 0; |
| 214 | |
| 215 | if (priv->ctrl.port2) |
| 216 | buffer[3] |= TEA5767_PORT2_HIGH; |
| 217 | |
| 218 | if (priv->ctrl.high_cut) |
| 219 | buffer[3] |= TEA5767_HIGH_CUT_CTRL; |
| 220 | |
| 221 | if (priv->ctrl.st_noise) |
| 222 | buffer[3] |= TEA5767_ST_NOISE_CTL; |
| 223 | |
| 224 | if (priv->ctrl.soft_mute) |
| 225 | buffer[3] |= TEA5767_SOFT_MUTE; |
| 226 | |
| 227 | if (priv->ctrl.japan_band) |
| 228 | buffer[3] |= TEA5767_JAPAN_BAND; |
| 229 | |
| 230 | buffer[4] = 0; |
| 231 | |
| 232 | if (priv->ctrl.deemph_75) |
| 233 | buffer[4] |= TEA5767_DEEMPH_75; |
| 234 | |
| 235 | if (priv->ctrl.pllref) |
| 236 | buffer[4] |= TEA5767_PLLREF_ENABLE; |
| 237 | |
| 238 | |
| 239 | /* Rounds freq to next decimal value - for 62.5 KHz step */ |
| 240 | /* frq = 20*(frq/16)+radio_frq[frq%16]; */ |
| 241 | |
| 242 | switch (priv->ctrl.xtal_freq) { |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 243 | case TEA5767_HIGH_LO_13MHz: |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 244 | tuner_dbg("radio HIGH LO inject xtal @ 13 MHz\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 245 | buffer[2] |= TEA5767_HIGH_LO_INJECT; |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 246 | div = (frq * (4000 / 16) + 700000 + 225000 + 25000) / 50000; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 247 | break; |
| 248 | case TEA5767_LOW_LO_13MHz: |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 249 | tuner_dbg("radio LOW LO inject xtal @ 13 MHz\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 250 | |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 251 | div = (frq * (4000 / 16) - 700000 - 225000 + 25000) / 50000; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 252 | break; |
| 253 | case TEA5767_LOW_LO_32768: |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 254 | tuner_dbg("radio LOW LO inject xtal @ 32,768 MHz\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 255 | buffer[3] |= TEA5767_XTAL_32768; |
| 256 | /* const 700=4000*175 Khz - to adjust freq to right value */ |
Hans Verkuil | 27487d4 | 2006-01-15 15:04:52 -0200 | [diff] [blame] | 257 | div = ((frq * (4000 / 16) - 700000 - 225000) + 16384) >> 15; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 258 | break; |
| 259 | case TEA5767_HIGH_LO_32768: |
| 260 | default: |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 261 | tuner_dbg("radio HIGH LO inject xtal @ 32,768 MHz\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 262 | |
| 263 | buffer[2] |= TEA5767_HIGH_LO_INJECT; |
| 264 | buffer[3] |= TEA5767_XTAL_32768; |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 265 | div = ((frq * (4000 / 16) + 700000 + 225000) + 16384) >> 15; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 266 | break; |
| 267 | } |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 268 | buffer[0] = (div >> 8) & 0x3f; |
| 269 | buffer[1] = div & 0xff; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 270 | |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 271 | if (5 != (rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 5))) |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 272 | tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc); |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 273 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 274 | if (debug) { |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 275 | if (5 != (rc = tuner_i2c_xfer_recv(&priv->i2c_props, buffer, 5))) |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 276 | tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc); |
| 277 | else |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 278 | tea5767_status_dump(priv, buffer); |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 279 | } |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 280 | |
| 281 | priv->frequency = frq * 125 / 2; |
| 282 | |
| 283 | return 0; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 284 | } |
| 285 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 286 | static int tea5767_read_status(struct dvb_frontend *fe, char *buffer) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 287 | { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 288 | struct tea5767_priv *priv = fe->tuner_priv; |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 289 | int rc; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 290 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 291 | memset(buffer, 0, 5); |
| 292 | if (5 != (rc = tuner_i2c_xfer_recv(&priv->i2c_props, buffer, 5))) { |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 293 | tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc); |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 294 | return -EREMOTEIO; |
| 295 | } |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 296 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 297 | return 0; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 298 | } |
| 299 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 300 | static inline int tea5767_signal(struct dvb_frontend *fe, const char *buffer) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 301 | { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 302 | struct tea5767_priv *priv = fe->tuner_priv; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 303 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 304 | int signal = ((buffer[3] & TEA5767_ADC_LEVEL_MASK) << 8); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 305 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 306 | tuner_dbg("Signal strength: %d\n", signal); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 307 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 308 | return signal; |
| 309 | } |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 310 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 311 | static inline int tea5767_stereo(struct dvb_frontend *fe, const char *buffer) |
| 312 | { |
| 313 | struct tea5767_priv *priv = fe->tuner_priv; |
| 314 | |
| 315 | int stereo = buffer[2] & TEA5767_STEREO_MASK; |
| 316 | |
| 317 | tuner_dbg("Radio ST GET = %02x\n", stereo); |
| 318 | |
| 319 | return (stereo ? V4L2_TUNER_SUB_STEREO : 0); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 320 | } |
| 321 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 322 | static int tea5767_get_status(struct dvb_frontend *fe, u32 *status) |
| 323 | { |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 324 | unsigned char buffer[5]; |
| 325 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 326 | *status = 0; |
| 327 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 328 | if (0 == tea5767_read_status(fe, buffer)) { |
| 329 | if (tea5767_signal(fe, buffer)) |
| 330 | *status = TUNER_STATUS_LOCKED; |
| 331 | if (tea5767_stereo(fe, buffer)) |
| 332 | *status |= TUNER_STATUS_STEREO; |
| 333 | } |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 334 | |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 335 | return 0; |
| 336 | } |
| 337 | |
| 338 | static int tea5767_get_rf_strength(struct dvb_frontend *fe, u16 *strength) |
| 339 | { |
| 340 | unsigned char buffer[5]; |
| 341 | |
| 342 | *strength = 0; |
| 343 | |
| 344 | if (0 == tea5767_read_status(fe, buffer)) |
| 345 | *strength = tea5767_signal(fe, buffer); |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 346 | |
| 347 | return 0; |
| 348 | } |
| 349 | |
| 350 | static int tea5767_standby(struct dvb_frontend *fe) |
Mauro Carvalho Chehab | 793cf9e | 2005-09-09 13:03:37 -0700 | [diff] [blame] | 351 | { |
| 352 | unsigned char buffer[5]; |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 353 | struct tea5767_priv *priv = fe->tuner_priv; |
Mauro Carvalho Chehab | 793cf9e | 2005-09-09 13:03:37 -0700 | [diff] [blame] | 354 | unsigned div, rc; |
| 355 | |
| 356 | div = (87500 * 4 + 700 + 225 + 25) / 50; /* Set frequency to 87.5 MHz */ |
| 357 | buffer[0] = (div >> 8) & 0x3f; |
| 358 | buffer[1] = div & 0xff; |
| 359 | buffer[2] = TEA5767_PORT1_HIGH; |
| 360 | buffer[3] = TEA5767_PORT2_HIGH | TEA5767_HIGH_CUT_CTRL | |
| 361 | TEA5767_ST_NOISE_CTL | TEA5767_JAPAN_BAND | TEA5767_STDBY; |
| 362 | buffer[4] = 0; |
| 363 | |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 364 | if (5 != (rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 5))) |
Mauro Carvalho Chehab | 793cf9e | 2005-09-09 13:03:37 -0700 | [diff] [blame] | 365 | tuner_warn("i2c i/o error: rc == %d (should be 5)\n", rc); |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 366 | |
| 367 | return 0; |
Mauro Carvalho Chehab | 793cf9e | 2005-09-09 13:03:37 -0700 | [diff] [blame] | 368 | } |
| 369 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 370 | int tea5767_autodetection(struct i2c_adapter* i2c_adap, u8 i2c_addr) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 371 | { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 372 | struct tuner_i2c_props i2c = { .adap = i2c_adap, .addr = i2c_addr }; |
Mauro Carvalho Chehab | fd3113e | 2005-07-31 22:34:43 -0700 | [diff] [blame] | 373 | unsigned char buffer[7] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 374 | int rc; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 375 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 376 | if ((rc = tuner_i2c_xfer_recv(&i2c, buffer, 7))< 5) { |
| 377 | printk(KERN_WARNING "It is not a TEA5767. Received %i bytes.\n", rc); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 378 | return EINVAL; |
| 379 | } |
| 380 | |
Mauro Carvalho Chehab | fd3113e | 2005-07-31 22:34:43 -0700 | [diff] [blame] | 381 | /* If all bytes are the same then it's a TV tuner and not a tea5767 */ |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 382 | if (buffer[0] == buffer[1] && buffer[0] == buffer[2] && |
| 383 | buffer[0] == buffer[3] && buffer[0] == buffer[4]) { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 384 | printk(KERN_WARNING "All bytes are equal. It is not a TEA5767\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 385 | return EINVAL; |
| 386 | } |
| 387 | |
| 388 | /* Status bytes: |
| 389 | * Byte 4: bit 3:1 : CI (Chip Identification) == 0 |
Mauro Carvalho Chehab | f7ce3cc | 2005-07-12 13:58:55 -0700 | [diff] [blame] | 390 | * bit 0 : internally set to 0 |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 391 | * Byte 5: bit 7:0 : == 0 |
| 392 | */ |
Mauro Carvalho Chehab | 793cf9e | 2005-09-09 13:03:37 -0700 | [diff] [blame] | 393 | if (((buffer[3] & 0x0f) != 0x00) || (buffer[4] != 0x00)) { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 394 | printk(KERN_WARNING "Chip ID is not zero. It is not a TEA5767\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 395 | return EINVAL; |
| 396 | } |
Mauro Carvalho Chehab | c5287ba | 2005-07-15 03:56:28 -0700 | [diff] [blame] | 397 | |
Mauro Carvalho Chehab | 001abc9 | 2005-08-01 21:11:38 -0700 | [diff] [blame] | 398 | /* It seems that tea5767 returns 0xff after the 5th byte */ |
| 399 | if ((buffer[5] != 0xff) || (buffer[6] != 0xff)) { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 400 | printk(KERN_WARNING "Returned more than 5 bytes. It is not a TEA5767\n"); |
Mauro Carvalho Chehab | 001abc9 | 2005-08-01 21:11:38 -0700 | [diff] [blame] | 401 | return EINVAL; |
| 402 | } |
| 403 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 404 | printk(KERN_WARNING "TEA5767 detected.\n"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 405 | return 0; |
| 406 | } |
| 407 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 408 | static int tea5767_release(struct dvb_frontend *fe) |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 409 | { |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 410 | kfree(fe->tuner_priv); |
| 411 | fe->tuner_priv = NULL; |
| 412 | |
| 413 | return 0; |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 414 | } |
| 415 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 416 | static int tea5767_get_frequency(struct dvb_frontend *fe, u32 *frequency) |
| 417 | { |
| 418 | struct tea5767_priv *priv = fe->tuner_priv; |
| 419 | *frequency = priv->frequency; |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 420 | |
| 421 | return 0; |
| 422 | } |
| 423 | |
| 424 | static int tea5767_set_config (struct dvb_frontend *fe, void *priv_cfg) |
| 425 | { |
| 426 | struct tea5767_priv *priv = fe->tuner_priv; |
| 427 | |
| 428 | memcpy(&priv->ctrl, priv_cfg, sizeof(priv->ctrl)); |
| 429 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 430 | return 0; |
| 431 | } |
| 432 | |
| 433 | static struct dvb_tuner_ops tea5767_tuner_ops = { |
| 434 | .info = { |
| 435 | .name = "tea5767", // Philips TEA5767HN FM Radio |
| 436 | }, |
| 437 | |
| 438 | .set_analog_params = set_radio_freq, |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 439 | .set_config = tea5767_set_config, |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 440 | .sleep = tea5767_standby, |
| 441 | .release = tea5767_release, |
| 442 | .get_frequency = tea5767_get_frequency, |
| 443 | .get_status = tea5767_get_status, |
Michael Krufky | 6b897f2 | 2007-08-31 16:40:14 -0300 | [diff] [blame] | 444 | .get_rf_strength = tea5767_get_rf_strength, |
Michael Krufky | 0f838f8 | 2007-06-06 16:17:17 -0300 | [diff] [blame] | 445 | }; |
| 446 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 447 | struct dvb_frontend *tea5767_attach(struct dvb_frontend *fe, |
| 448 | struct i2c_adapter* i2c_adap, |
| 449 | u8 i2c_addr) |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 450 | { |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 451 | struct tea5767_priv *priv = NULL; |
| 452 | |
| 453 | priv = kzalloc(sizeof(struct tea5767_priv), GFP_KERNEL); |
| 454 | if (priv == NULL) |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 455 | return NULL; |
| 456 | fe->tuner_priv = priv; |
Michael Krufky | db8a695 | 2007-08-21 01:24:42 -0300 | [diff] [blame] | 457 | |
Mauro Carvalho Chehab | 0e1165e | 2007-10-18 20:10:07 -0300 | [diff] [blame] | 458 | priv->i2c_props.addr = i2c_addr; |
| 459 | priv->i2c_props.adap = i2c_adap; |
| 460 | priv->ctrl.xtal_freq = TEA5767_HIGH_LO_32768; |
| 461 | priv->ctrl.port1 = 1; |
| 462 | priv->ctrl.port2 = 1; |
| 463 | priv->ctrl.high_cut = 1; |
| 464 | priv->ctrl.st_noise = 1; |
| 465 | priv->ctrl.japan_band = 1; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 466 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 467 | memcpy(&fe->ops.tuner_ops, &tea5767_tuner_ops, |
| 468 | sizeof(struct dvb_tuner_ops)); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 469 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 470 | tuner_info("type set to %s\n", "Philips TEA5767HN FM Radio"); |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 471 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 472 | return fe; |
Mauro Carvalho Chehab | 586b0ca | 2005-06-28 20:45:21 -0700 | [diff] [blame] | 473 | } |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 474 | |
Michael Krufky | 8d0936e | 2007-08-27 21:24:27 -0300 | [diff] [blame] | 475 | EXPORT_SYMBOL_GPL(tea5767_attach); |
| 476 | EXPORT_SYMBOL_GPL(tea5767_autodetection); |
| 477 | |
| 478 | MODULE_DESCRIPTION("Philips TEA5767 FM tuner driver"); |
| 479 | MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>"); |
| 480 | MODULE_LICENSE("GPL"); |