Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | * |
| 3 | * device driver for philips saa7134 based TV cards |
| 4 | * i2c interface support |
| 5 | * |
| 6 | * (c) 2001,02 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs] |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; either version 2 of the License, or |
| 11 | * (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License |
| 19 | * along with this program; if not, write to the Free Software |
| 20 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 21 | */ |
| 22 | |
Mauro Carvalho Chehab | 9a12ccf | 2015-04-30 06:44:56 -0300 | [diff] [blame] | 23 | #include "saa7134.h" |
| 24 | #include "saa7134-reg.h" |
| 25 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | #include <linux/init.h> |
| 27 | #include <linux/list.h> |
| 28 | #include <linux/module.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | #include <linux/kernel.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | #include <linux/delay.h> |
| 31 | |
Michael Krufky | 5e453dc | 2006-01-09 15:32:31 -0200 | [diff] [blame] | 32 | #include <media/v4l2-common.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | |
| 34 | /* ----------------------------------------------------------- */ |
| 35 | |
Douglas Schilling Landgraf | ff699e6 | 2008-04-22 14:41:48 -0300 | [diff] [blame] | 36 | static unsigned int i2c_debug; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | module_param(i2c_debug, int, 0644); |
| 38 | MODULE_PARM_DESC(i2c_debug,"enable debug messages [i2c]"); |
| 39 | |
Douglas Schilling Landgraf | ff699e6 | 2008-04-22 14:41:48 -0300 | [diff] [blame] | 40 | static unsigned int i2c_scan; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | module_param(i2c_scan, int, 0444); |
| 42 | MODULE_PARM_DESC(i2c_scan,"scan i2c bus at insmod time"); |
| 43 | |
Mauro Carvalho Chehab | 45f38cb | 2015-05-13 14:09:25 -0300 | [diff] [blame] | 44 | #define i2c_dbg(level, fmt, arg...) do { \ |
| 45 | if (i2c_debug == level) \ |
| 46 | printk(KERN_DEBUG pr_fmt("i2c: " fmt), ## arg); \ |
| 47 | } while (0) |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 48 | |
Mauro Carvalho Chehab | 45f38cb | 2015-05-13 14:09:25 -0300 | [diff] [blame] | 49 | #define i2c_cont(level, fmt, arg...) do { \ |
| 50 | if (i2c_debug == level) \ |
| 51 | pr_cont(fmt, ## arg); \ |
| 52 | } while (0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | |
| 54 | #define I2C_WAIT_DELAY 32 |
| 55 | #define I2C_WAIT_RETRY 16 |
| 56 | |
| 57 | /* ----------------------------------------------------------- */ |
| 58 | |
| 59 | static char *str_i2c_status[] = { |
| 60 | "IDLE", "DONE_STOP", "BUSY", "TO_SCL", "TO_ARB", "DONE_WRITE", |
| 61 | "DONE_READ", "DONE_WRITE_TO", "DONE_READ_TO", "NO_DEVICE", |
| 62 | "NO_ACKN", "BUS_ERR", "ARB_LOST", "SEQ_ERR", "ST_ERR", "SW_ERR" |
| 63 | }; |
| 64 | |
| 65 | enum i2c_status { |
| 66 | IDLE = 0, // no I2C command pending |
| 67 | DONE_STOP = 1, // I2C command done and STOP executed |
| 68 | BUSY = 2, // executing I2C command |
| 69 | TO_SCL = 3, // executing I2C command, time out on clock stretching |
| 70 | TO_ARB = 4, // time out on arbitration trial, still trying |
| 71 | DONE_WRITE = 5, // I2C command done and awaiting next write command |
| 72 | DONE_READ = 6, // I2C command done and awaiting next read command |
| 73 | DONE_WRITE_TO = 7, // see 5, and time out on status echo |
| 74 | DONE_READ_TO = 8, // see 6, and time out on status echo |
| 75 | NO_DEVICE = 9, // no acknowledge on device slave address |
| 76 | NO_ACKN = 10, // no acknowledge after data byte transfer |
| 77 | BUS_ERR = 11, // bus error |
| 78 | ARB_LOST = 12, // arbitration lost during transfer |
| 79 | SEQ_ERR = 13, // erroneous programming sequence |
| 80 | ST_ERR = 14, // wrong status echoing |
| 81 | SW_ERR = 15 // software error |
| 82 | }; |
| 83 | |
| 84 | static char *str_i2c_attr[] = { |
| 85 | "NOP", "STOP", "CONTINUE", "START" |
| 86 | }; |
| 87 | |
| 88 | enum i2c_attr { |
| 89 | NOP = 0, // no operation on I2C bus |
| 90 | STOP = 1, // stop condition, no associated byte transfer |
| 91 | CONTINUE = 2, // continue with byte transfer |
| 92 | START = 3 // start condition with byte transfer |
| 93 | }; |
| 94 | |
| 95 | static inline enum i2c_status i2c_get_status(struct saa7134_dev *dev) |
| 96 | { |
| 97 | enum i2c_status status; |
| 98 | |
| 99 | status = saa_readb(SAA7134_I2C_ATTR_STATUS) & 0x0f; |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 100 | i2c_dbg(2, "i2c stat <= %s\n", str_i2c_status[status]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | return status; |
| 102 | } |
| 103 | |
| 104 | static inline void i2c_set_status(struct saa7134_dev *dev, |
| 105 | enum i2c_status status) |
| 106 | { |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 107 | i2c_dbg(2, "i2c stat => %s\n", str_i2c_status[status]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 108 | saa_andorb(SAA7134_I2C_ATTR_STATUS,0x0f,status); |
| 109 | } |
| 110 | |
| 111 | static inline void i2c_set_attr(struct saa7134_dev *dev, enum i2c_attr attr) |
| 112 | { |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 113 | i2c_dbg(2, "i2c attr => %s\n", str_i2c_attr[attr]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | saa_andorb(SAA7134_I2C_ATTR_STATUS,0xc0,attr << 6); |
| 115 | } |
| 116 | |
| 117 | static inline int i2c_is_error(enum i2c_status status) |
| 118 | { |
| 119 | switch (status) { |
| 120 | case NO_DEVICE: |
| 121 | case NO_ACKN: |
| 122 | case BUS_ERR: |
| 123 | case ARB_LOST: |
| 124 | case SEQ_ERR: |
| 125 | case ST_ERR: |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 126 | return true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | default: |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 128 | return false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | } |
| 130 | } |
| 131 | |
| 132 | static inline int i2c_is_idle(enum i2c_status status) |
| 133 | { |
| 134 | switch (status) { |
| 135 | case IDLE: |
| 136 | case DONE_STOP: |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 137 | return true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | default: |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 139 | return false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | } |
| 141 | } |
| 142 | |
| 143 | static inline int i2c_is_busy(enum i2c_status status) |
| 144 | { |
| 145 | switch (status) { |
| 146 | case BUSY: |
Dmitry Belimov | 8fb737b | 2008-04-23 14:07:09 -0300 | [diff] [blame] | 147 | case TO_SCL: |
| 148 | case TO_ARB: |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 149 | return true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | default: |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 151 | return false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 | } |
| 153 | } |
| 154 | |
| 155 | static int i2c_is_busy_wait(struct saa7134_dev *dev) |
| 156 | { |
| 157 | enum i2c_status status; |
| 158 | int count; |
| 159 | |
| 160 | for (count = 0; count < I2C_WAIT_RETRY; count++) { |
| 161 | status = i2c_get_status(dev); |
| 162 | if (!i2c_is_busy(status)) |
| 163 | break; |
| 164 | saa_wait(I2C_WAIT_DELAY); |
| 165 | } |
| 166 | if (I2C_WAIT_RETRY == count) |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 167 | return false; |
| 168 | return true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 169 | } |
| 170 | |
| 171 | static int i2c_reset(struct saa7134_dev *dev) |
| 172 | { |
| 173 | enum i2c_status status; |
| 174 | int count; |
| 175 | |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 176 | i2c_dbg(2, "i2c reset\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | status = i2c_get_status(dev); |
| 178 | if (!i2c_is_error(status)) |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 179 | return true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | i2c_set_status(dev,status); |
| 181 | |
| 182 | for (count = 0; count < I2C_WAIT_RETRY; count++) { |
| 183 | status = i2c_get_status(dev); |
| 184 | if (!i2c_is_error(status)) |
| 185 | break; |
| 186 | udelay(I2C_WAIT_DELAY); |
| 187 | } |
| 188 | if (I2C_WAIT_RETRY == count) |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 189 | return false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | |
| 191 | if (!i2c_is_idle(status)) |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 192 | return false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | |
| 194 | i2c_set_attr(dev,NOP); |
Richard Knutsson | e8be02a | 2007-02-06 21:52:04 -0300 | [diff] [blame] | 195 | return true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 196 | } |
| 197 | |
| 198 | static inline int i2c_send_byte(struct saa7134_dev *dev, |
| 199 | enum i2c_attr attr, |
| 200 | unsigned char data) |
| 201 | { |
| 202 | enum i2c_status status; |
| 203 | __u32 dword; |
| 204 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | /* have to write both attr + data in one 32bit word */ |
| 206 | dword = saa_readl(SAA7134_I2C_ATTR_STATUS >> 2); |
| 207 | dword &= 0x0f; |
| 208 | dword |= (attr << 6); |
| 209 | dword |= ((__u32)data << 8); |
| 210 | dword |= 0x00 << 16; /* 100 kHz */ |
| 211 | // dword |= 0x40 << 16; /* 400 kHz */ |
| 212 | dword |= 0xf0 << 24; |
| 213 | saa_writel(SAA7134_I2C_ATTR_STATUS >> 2, dword); |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 214 | i2c_dbg(2, "i2c data => 0x%x\n", data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | |
| 216 | if (!i2c_is_busy_wait(dev)) |
| 217 | return -EIO; |
| 218 | status = i2c_get_status(dev); |
| 219 | if (i2c_is_error(status)) |
| 220 | return -EIO; |
| 221 | return 0; |
| 222 | } |
| 223 | |
| 224 | static inline int i2c_recv_byte(struct saa7134_dev *dev) |
| 225 | { |
| 226 | enum i2c_status status; |
| 227 | unsigned char data; |
| 228 | |
| 229 | i2c_set_attr(dev,CONTINUE); |
| 230 | if (!i2c_is_busy_wait(dev)) |
| 231 | return -EIO; |
| 232 | status = i2c_get_status(dev); |
| 233 | if (i2c_is_error(status)) |
| 234 | return -EIO; |
| 235 | data = saa_readb(SAA7134_I2C_DATA); |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 236 | i2c_dbg(2, "i2c data <= 0x%x\n", data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | return data; |
| 238 | } |
| 239 | |
| 240 | static int saa7134_i2c_xfer(struct i2c_adapter *i2c_adap, |
| 241 | struct i2c_msg *msgs, int num) |
| 242 | { |
| 243 | struct saa7134_dev *dev = i2c_adap->algo_data; |
| 244 | enum i2c_status status; |
| 245 | unsigned char data; |
| 246 | int addr,rc,i,byte; |
| 247 | |
Mauro Carvalho Chehab | 4ac9791 | 2005-11-08 21:37:43 -0800 | [diff] [blame] | 248 | status = i2c_get_status(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 249 | if (!i2c_is_idle(status)) |
| 250 | if (!i2c_reset(dev)) |
| 251 | return -EIO; |
| 252 | |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 253 | i2c_dbg(2, "start xfer\n"); |
| 254 | i2c_dbg(1, "i2c xfer:"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 255 | for (i = 0; i < num; i++) { |
| 256 | if (!(msgs[i].flags & I2C_M_NOSTART) || 0 == i) { |
| 257 | /* send address */ |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 258 | i2c_dbg(2, "send address\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 | addr = msgs[i].addr << 1; |
| 260 | if (msgs[i].flags & I2C_M_RD) |
| 261 | addr |= 1; |
Kyle Strickland | 25fa207 | 2012-02-18 02:24:53 -0300 | [diff] [blame] | 262 | if (i > 0 && msgs[i].flags & |
| 263 | I2C_M_RD && msgs[i].addr != 0x40 && |
Ondrej Zary | 34fe278 | 2013-04-06 14:28:16 -0300 | [diff] [blame] | 264 | msgs[i].addr != 0x41 && |
Kyle Strickland | 25fa207 | 2012-02-18 02:24:53 -0300 | [diff] [blame] | 265 | msgs[i].addr != 0x19) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 266 | /* workaround for a saa7134 i2c bug |
| 267 | * needed to talk to the mt352 demux |
| 268 | * thanks to pinnacle for the hint */ |
Michael Krufky | b9dcdb6 | 2009-05-20 16:06:10 -0300 | [diff] [blame] | 269 | int quirk = 0xfe; |
Mauro Carvalho Chehab | 6139ebc | 2015-05-13 14:09:42 -0300 | [diff] [blame] | 270 | i2c_cont(1, " [%02x quirk]", quirk); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 271 | i2c_send_byte(dev,START,quirk); |
| 272 | i2c_recv_byte(dev); |
| 273 | } |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 274 | i2c_cont(1, " < %02x", addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 275 | rc = i2c_send_byte(dev,START,addr); |
| 276 | if (rc < 0) |
| 277 | goto err; |
| 278 | } |
| 279 | if (msgs[i].flags & I2C_M_RD) { |
| 280 | /* read bytes */ |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 281 | i2c_dbg(2, "read bytes\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 282 | for (byte = 0; byte < msgs[i].len; byte++) { |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 283 | i2c_cont(1, " ="); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 284 | rc = i2c_recv_byte(dev); |
| 285 | if (rc < 0) |
| 286 | goto err; |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 287 | i2c_cont(1, "%02x", rc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | msgs[i].buf[byte] = rc; |
| 289 | } |
Kyle Strickland | 25fa207 | 2012-02-18 02:24:53 -0300 | [diff] [blame] | 290 | /* discard mysterious extra byte when reading |
| 291 | from Samsung S5H1411. i2c bus gets error |
| 292 | if we do not. */ |
| 293 | if (0x19 == msgs[i].addr) { |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 294 | i2c_cont(1, " ?"); |
Kyle Strickland | 25fa207 | 2012-02-18 02:24:53 -0300 | [diff] [blame] | 295 | rc = i2c_recv_byte(dev); |
| 296 | if (rc < 0) |
| 297 | goto err; |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 298 | i2c_cont(1, "%02x", rc); |
Kyle Strickland | 25fa207 | 2012-02-18 02:24:53 -0300 | [diff] [blame] | 299 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | } else { |
| 301 | /* write bytes */ |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 302 | i2c_dbg(2, "write bytes\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 303 | for (byte = 0; byte < msgs[i].len; byte++) { |
| 304 | data = msgs[i].buf[byte]; |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 305 | i2c_cont(1, " %02x", data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 | rc = i2c_send_byte(dev,CONTINUE,data); |
| 307 | if (rc < 0) |
| 308 | goto err; |
| 309 | } |
| 310 | } |
| 311 | } |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 312 | i2c_dbg(2, "xfer done\n"); |
| 313 | i2c_cont(1, " >"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 314 | i2c_set_attr(dev,STOP); |
| 315 | rc = -EIO; |
| 316 | if (!i2c_is_busy_wait(dev)) |
| 317 | goto err; |
Mauro Carvalho Chehab | 4ac9791 | 2005-11-08 21:37:43 -0800 | [diff] [blame] | 318 | status = i2c_get_status(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 319 | if (i2c_is_error(status)) |
| 320 | goto err; |
Mauro Carvalho Chehab | fd3113e | 2005-07-31 22:34:43 -0700 | [diff] [blame] | 321 | /* ensure that the bus is idle for at least one bit slot */ |
| 322 | msleep(1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 323 | |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 324 | i2c_cont(1, "\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 325 | return num; |
| 326 | err: |
| 327 | if (1 == i2c_debug) { |
| 328 | status = i2c_get_status(dev); |
Mauro Carvalho Chehab | 30693f3 | 2015-04-30 08:21:14 -0300 | [diff] [blame] | 329 | i2c_cont(1, " ERROR: %s\n", str_i2c_status[status]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 | } |
| 331 | return rc; |
| 332 | } |
| 333 | |
| 334 | /* ----------------------------------------------------------- */ |
| 335 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 336 | static u32 functionality(struct i2c_adapter *adap) |
| 337 | { |
| 338 | return I2C_FUNC_SMBUS_EMUL; |
| 339 | } |
| 340 | |
Julia Lawall | 78f2c50 | 2016-08-29 10:12:01 -0300 | [diff] [blame] | 341 | static const struct i2c_algorithm saa7134_algo = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | .master_xfer = saa7134_i2c_xfer, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 343 | .functionality = functionality, |
| 344 | }; |
| 345 | |
| 346 | static struct i2c_adapter saa7134_adap_template = { |
| 347 | .owner = THIS_MODULE, |
Jean Delvare | fae91e7 | 2005-08-15 19:57:04 +0200 | [diff] [blame] | 348 | .name = "saa7134", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 349 | .algo = &saa7134_algo, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 350 | }; |
| 351 | |
| 352 | static struct i2c_client saa7134_client_template = { |
Jean Delvare | fae91e7 | 2005-08-15 19:57:04 +0200 | [diff] [blame] | 353 | .name = "saa7134 internal", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | }; |
| 355 | |
| 356 | /* ----------------------------------------------------------- */ |
| 357 | |
Maciej S. Szmigiero | fb2dc28 | 2016-07-02 20:27:46 -0300 | [diff] [blame] | 358 | /* On Medion 7134 reading EEPROM needs DVB-T demod i2c gate open */ |
| 359 | static void saa7134_i2c_eeprom_md7134_gate(struct saa7134_dev *dev) |
| 360 | { |
| 361 | u8 subaddr = 0x7, dmdregval; |
| 362 | u8 data[2]; |
| 363 | int ret; |
| 364 | struct i2c_msg i2cgatemsg_r[] = { {.addr = 0x08, .flags = 0, |
| 365 | .buf = &subaddr, .len = 1}, |
| 366 | {.addr = 0x08, |
| 367 | .flags = I2C_M_RD, |
| 368 | .buf = &dmdregval, .len = 1} |
| 369 | }; |
| 370 | struct i2c_msg i2cgatemsg_w[] = { {.addr = 0x08, .flags = 0, |
| 371 | .buf = data, .len = 2} }; |
| 372 | |
| 373 | ret = i2c_transfer(&dev->i2c_adap, i2cgatemsg_r, 2); |
| 374 | if ((ret == 2) && (dmdregval & 0x2)) { |
| 375 | pr_debug("%s: DVB-T demod i2c gate was left closed\n", |
| 376 | dev->name); |
| 377 | |
| 378 | data[0] = subaddr; |
| 379 | data[1] = (dmdregval & ~0x2); |
| 380 | if (i2c_transfer(&dev->i2c_adap, i2cgatemsg_w, 1) != 1) |
| 381 | pr_err("%s: EEPROM i2c gate open failure\n", |
| 382 | dev->name); |
| 383 | } |
| 384 | } |
| 385 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 386 | static int |
| 387 | saa7134_i2c_eeprom(struct saa7134_dev *dev, unsigned char *eedata, int len) |
| 388 | { |
| 389 | unsigned char buf; |
| 390 | int i,err; |
| 391 | |
Maciej S. Szmigiero | fb2dc28 | 2016-07-02 20:27:46 -0300 | [diff] [blame] | 392 | if (dev->board == SAA7134_BOARD_MD7134) |
| 393 | saa7134_i2c_eeprom_md7134_gate(dev); |
| 394 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | dev->i2c_client.addr = 0xa0 >> 1; |
| 396 | buf = 0; |
| 397 | if (1 != (err = i2c_master_send(&dev->i2c_client,&buf,1))) { |
Mauro Carvalho Chehab | 8358200 | 2015-04-30 06:46:34 -0300 | [diff] [blame] | 398 | pr_info("%s: Huh, no eeprom present (err=%d)?\n", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 399 | dev->name,err); |
| 400 | return -1; |
| 401 | } |
| 402 | if (len != (err = i2c_master_recv(&dev->i2c_client,eedata,len))) { |
Mauro Carvalho Chehab | 8358200 | 2015-04-30 06:46:34 -0300 | [diff] [blame] | 403 | pr_warn("%s: i2c eeprom read error (err=%d)\n", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | dev->name,err); |
| 405 | return -1; |
| 406 | } |
Mauro Carvalho Chehab | 3e0051c | 2015-04-30 09:15:08 -0300 | [diff] [blame] | 407 | |
Mauro Carvalho Chehab | 6139ebc | 2015-05-13 14:09:42 -0300 | [diff] [blame] | 408 | for (i = 0; i < len; i += 16) { |
Mauro Carvalho Chehab | 3e0051c | 2015-04-30 09:15:08 -0300 | [diff] [blame] | 409 | int size = (len - i) > 16 ? 16 : len - i; |
Mauro Carvalho Chehab | 6139ebc | 2015-05-13 14:09:42 -0300 | [diff] [blame] | 410 | |
Mauro Carvalho Chehab | 3e0051c | 2015-04-30 09:15:08 -0300 | [diff] [blame] | 411 | pr_info("i2c eeprom %02x: %*ph\n", i, size, &eedata[i]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 412 | } |
Mauro Carvalho Chehab | 3e0051c | 2015-04-30 09:15:08 -0300 | [diff] [blame] | 413 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | return 0; |
| 415 | } |
| 416 | |
| 417 | static char *i2c_devs[128] = { |
| 418 | [ 0x20 ] = "mpeg encoder (saa6752hs)", |
| 419 | [ 0xa0 >> 1 ] = "eeprom", |
| 420 | [ 0xc0 >> 1 ] = "tuner (analog)", |
| 421 | [ 0x86 >> 1 ] = "tda9887", |
Andrey J. Melnikoff (TEMHOTA) | e8018c9 | 2008-01-07 05:17:39 -0300 | [diff] [blame] | 422 | [ 0x5a >> 1 ] = "remote control", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 423 | }; |
| 424 | |
Mauro Carvalho Chehab | 2bb3e2e | 2015-04-30 09:17:34 -0300 | [diff] [blame] | 425 | static void do_i2c_scan(struct i2c_client *c) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 426 | { |
| 427 | unsigned char buf; |
| 428 | int i,rc; |
| 429 | |
Mauro Carvalho Chehab | 53c4e95 | 2007-03-29 08:42:30 -0300 | [diff] [blame] | 430 | for (i = 0; i < ARRAY_SIZE(i2c_devs); i++) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | c->addr = i; |
| 432 | rc = i2c_master_recv(c,&buf,0); |
| 433 | if (rc < 0) |
| 434 | continue; |
Mauro Carvalho Chehab | 2bb3e2e | 2015-04-30 09:17:34 -0300 | [diff] [blame] | 435 | pr_info("i2c scan: found device @ 0x%x [%s]\n", |
| 436 | i << 1, i2c_devs[i] ? i2c_devs[i] : "???"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 437 | } |
| 438 | } |
| 439 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 440 | int saa7134_i2c_register(struct saa7134_dev *dev) |
| 441 | { |
| 442 | dev->i2c_adap = saa7134_adap_template; |
| 443 | dev->i2c_adap.dev.parent = &dev->pci->dev; |
| 444 | strcpy(dev->i2c_adap.name,dev->name); |
| 445 | dev->i2c_adap.algo_data = dev; |
Hans Verkuil | fac6986 | 2009-01-17 12:17:14 -0300 | [diff] [blame] | 446 | i2c_set_adapdata(&dev->i2c_adap, &dev->v4l2_dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 447 | i2c_add_adapter(&dev->i2c_adap); |
| 448 | |
| 449 | dev->i2c_client = saa7134_client_template; |
| 450 | dev->i2c_client.adapter = &dev->i2c_adap; |
| 451 | |
| 452 | saa7134_i2c_eeprom(dev,dev->eedata,sizeof(dev->eedata)); |
| 453 | if (i2c_scan) |
Mauro Carvalho Chehab | 2bb3e2e | 2015-04-30 09:17:34 -0300 | [diff] [blame] | 454 | do_i2c_scan(&dev->i2c_client); |
Jean Delvare | c668f32 | 2009-05-13 16:48:50 -0300 | [diff] [blame] | 455 | |
| 456 | /* Instantiate the IR receiver device, if present */ |
| 457 | saa7134_probe_i2c_ir(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 458 | return 0; |
| 459 | } |
| 460 | |
| 461 | int saa7134_i2c_unregister(struct saa7134_dev *dev) |
| 462 | { |
| 463 | i2c_del_adapter(&dev->i2c_adap); |
| 464 | return 0; |
| 465 | } |