em28xx-i2c.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759
  1. /*
  2. em28xx-i2c.c - driver for Empia EM2800/EM2820/2840 USB video capture devices
  3. Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it>
  4. Markus Rechberger <mrechberger@gmail.com>
  5. Mauro Carvalho Chehab <mchehab@infradead.org>
  6. Sascha Sommer <saschasommer@freenet.de>
  7. This program is free software; you can redistribute it and/or modify
  8. it under the terms of the GNU General Public License as published by
  9. the Free Software Foundation; either version 2 of the License, or
  10. (at your option) any later version.
  11. This program is distributed in the hope that it will be useful,
  12. but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. GNU General Public License for more details.
  15. You should have received a copy of the GNU General Public License
  16. along with this program; if not, write to the Free Software
  17. Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18. */
  19. #include <linux/module.h>
  20. #include <linux/kernel.h>
  21. #include <linux/usb.h>
  22. #include <linux/i2c.h>
  23. #include "em28xx.h"
  24. #include "tuner-xc2028.h"
  25. #include <media/v4l2-common.h>
  26. #include <media/tuner.h>
  27. /* ----------------------------------------------------------- */
  28. static unsigned int i2c_scan;
  29. module_param(i2c_scan, int, 0444);
  30. MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
  31. static unsigned int i2c_debug;
  32. module_param(i2c_debug, int, 0644);
  33. MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
  34. /*
  35. * em2800_i2c_send_bytes()
  36. * send up to 4 bytes to the em2800 i2c device
  37. */
  38. static int em2800_i2c_send_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len)
  39. {
  40. int ret;
  41. int write_timeout;
  42. u8 b2[6];
  43. if (len < 1 || len > 4)
  44. return -EOPNOTSUPP;
  45. BUG_ON(len < 1 || len > 4);
  46. b2[5] = 0x80 + len - 1;
  47. b2[4] = addr;
  48. b2[3] = buf[0];
  49. if (len > 1)
  50. b2[2] = buf[1];
  51. if (len > 2)
  52. b2[1] = buf[2];
  53. if (len > 3)
  54. b2[0] = buf[3];
  55. /* trigger write */
  56. ret = dev->em28xx_write_regs(dev, 4 - len, &b2[4 - len], 2 + len);
  57. if (ret != 2 + len) {
  58. em28xx_warn("failed to trigger write to i2c address 0x%x "
  59. "(error=%i)\n", addr, ret);
  60. return (ret < 0) ? ret : -EIO;
  61. }
  62. /* wait for completion */
  63. for (write_timeout = EM2800_I2C_XFER_TIMEOUT; write_timeout > 0;
  64. write_timeout -= 5) {
  65. ret = dev->em28xx_read_reg(dev, 0x05);
  66. if (ret == 0x80 + len - 1) {
  67. return len;
  68. } else if (ret == 0x94 + len - 1) {
  69. return -ENODEV;
  70. } else if (ret < 0) {
  71. em28xx_warn("failed to get i2c transfer status from "
  72. "bridge register (error=%i)\n", ret);
  73. return ret;
  74. }
  75. msleep(5);
  76. }
  77. em28xx_warn("write to i2c device at 0x%x timed out\n", addr);
  78. return -EIO;
  79. }
  80. /*
  81. * em2800_i2c_recv_bytes()
  82. * read up to 4 bytes from the em2800 i2c device
  83. */
  84. static int em2800_i2c_recv_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len)
  85. {
  86. u8 buf2[4];
  87. int ret;
  88. int read_timeout;
  89. int i;
  90. if (len < 1 || len > 4)
  91. return -EOPNOTSUPP;
  92. /* trigger read */
  93. buf2[1] = 0x84 + len - 1;
  94. buf2[0] = addr;
  95. ret = dev->em28xx_write_regs(dev, 0x04, buf2, 2);
  96. if (ret != 2) {
  97. em28xx_warn("failed to trigger read from i2c address 0x%x "
  98. "(error=%i)\n", addr, ret);
  99. return (ret < 0) ? ret : -EIO;
  100. }
  101. /* wait for completion */
  102. for (read_timeout = EM2800_I2C_XFER_TIMEOUT; read_timeout > 0;
  103. read_timeout -= 5) {
  104. ret = dev->em28xx_read_reg(dev, 0x05);
  105. if (ret == 0x84 + len - 1) {
  106. break;
  107. } else if (ret == 0x94 + len - 1) {
  108. return -ENODEV;
  109. } else if (ret < 0) {
  110. em28xx_warn("failed to get i2c transfer status from "
  111. "bridge register (error=%i)\n", ret);
  112. return ret;
  113. }
  114. msleep(5);
  115. }
  116. if (ret != 0x84 + len - 1)
  117. em28xx_warn("read from i2c device at 0x%x timed out\n", addr);
  118. /* get the received message */
  119. ret = dev->em28xx_read_reg_req_len(dev, 0x00, 4-len, buf2, len);
  120. if (ret != len) {
  121. em28xx_warn("reading from i2c device at 0x%x failed: "
  122. "couldn't get the received message from the bridge "
  123. "(error=%i)\n", addr, ret);
  124. return (ret < 0) ? ret : -EIO;
  125. }
  126. for (i = 0; i < len; i++)
  127. buf[i] = buf2[len - 1 - i];
  128. return ret;
  129. }
  130. /*
  131. * em2800_i2c_check_for_device()
  132. * check if there is an i2c device at the supplied address
  133. */
  134. static int em2800_i2c_check_for_device(struct em28xx *dev, u8 addr)
  135. {
  136. u8 buf;
  137. int ret;
  138. ret = em2800_i2c_recv_bytes(dev, addr, &buf, 1);
  139. if (ret == 1)
  140. return 0;
  141. return (ret < 0) ? ret : -EIO;
  142. }
  143. /*
  144. * em28xx_i2c_send_bytes()
  145. */
  146. static int em28xx_i2c_send_bytes(struct em28xx *dev, u16 addr, u8 *buf,
  147. u16 len, int stop)
  148. {
  149. int write_timeout, ret;
  150. if (len < 1 || len > 64)
  151. return -EOPNOTSUPP;
  152. /* NOTE: limited by the USB ctrl message constraints
  153. * Zero length reads always succeed, even if no device is connected */
  154. /* Write to i2c device */
  155. ret = dev->em28xx_write_regs_req(dev, stop ? 2 : 3, addr, buf, len);
  156. if (ret != len) {
  157. if (ret < 0) {
  158. em28xx_warn("writing to i2c device at 0x%x failed "
  159. "(error=%i)\n", addr, ret);
  160. return ret;
  161. } else {
  162. em28xx_warn("%i bytes write to i2c device at 0x%x "
  163. "requested, but %i bytes written\n",
  164. len, addr, ret);
  165. return -EIO;
  166. }
  167. }
  168. /* Check success of the i2c operation */
  169. for (write_timeout = EM2800_I2C_XFER_TIMEOUT; write_timeout > 0;
  170. write_timeout -= 5) {
  171. ret = dev->em28xx_read_reg(dev, 0x05);
  172. if (ret == 0) { /* success */
  173. return len;
  174. } else if (ret == 0x10) {
  175. return -ENODEV;
  176. } else if (ret < 0) {
  177. em28xx_warn("failed to read i2c transfer status from "
  178. "bridge (error=%i)\n", ret);
  179. return ret;
  180. }
  181. msleep(5);
  182. /* NOTE: do we really have to wait for success ?
  183. Never seen anything else than 0x00 or 0x10
  184. (even with high payload) ... */
  185. }
  186. em28xx_warn("write to i2c device at 0x%x timed out\n", addr);
  187. return -EIO;
  188. }
  189. /*
  190. * em28xx_i2c_recv_bytes()
  191. * read a byte from the i2c device
  192. */
  193. static int em28xx_i2c_recv_bytes(struct em28xx *dev, u16 addr, u8 *buf, u16 len)
  194. {
  195. int ret;
  196. if (len < 1 || len > 64)
  197. return -EOPNOTSUPP;
  198. /* NOTE: limited by the USB ctrl message constraints
  199. * Zero length reads always succeed, even if no device is connected */
  200. /* Read data from i2c device */
  201. ret = dev->em28xx_read_reg_req_len(dev, 2, addr, buf, len);
  202. if (ret < 0) {
  203. em28xx_warn("reading from i2c device at 0x%x failed (error=%i)\n",
  204. addr, ret);
  205. return ret;
  206. }
  207. /* NOTE: some devices with two i2c busses have the bad habit to return 0
  208. * bytes if we are on bus B AND there was no write attempt to the
  209. * specified slave address before AND no device is present at the
  210. * requested slave address.
  211. * Anyway, the next check will fail with -ENODEV in this case, so avoid
  212. * spamming the system log on device probing and do nothing here.
  213. */
  214. /* Check success of the i2c operation */
  215. ret = dev->em28xx_read_reg(dev, 0x05);
  216. if (ret < 0) {
  217. em28xx_warn("failed to read i2c transfer status from "
  218. "bridge (error=%i)\n", ret);
  219. return ret;
  220. }
  221. if (ret > 0) {
  222. if (ret == 0x10) {
  223. return -ENODEV;
  224. } else {
  225. em28xx_warn("unknown i2c error (status=%i)\n", ret);
  226. return -EIO;
  227. }
  228. }
  229. return len;
  230. }
  231. /*
  232. * em28xx_i2c_check_for_device()
  233. * check if there is a i2c_device at the supplied address
  234. */
  235. static int em28xx_i2c_check_for_device(struct em28xx *dev, u16 addr)
  236. {
  237. int ret;
  238. u8 buf;
  239. ret = em28xx_i2c_recv_bytes(dev, addr, &buf, 1);
  240. if (ret == 1)
  241. return 0;
  242. return (ret < 0) ? ret : -EIO;
  243. }
  244. /*
  245. * em28xx_i2c_xfer()
  246. * the main i2c transfer function
  247. */
  248. static int em28xx_i2c_xfer(struct i2c_adapter *i2c_adap,
  249. struct i2c_msg msgs[], int num)
  250. {
  251. struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data;
  252. struct em28xx *dev = i2c_bus->dev;
  253. unsigned bus = i2c_bus->bus;
  254. int addr, rc, i, byte;
  255. rc = rt_mutex_trylock(&dev->i2c_bus_lock);
  256. if (rc < 0)
  257. return rc;
  258. /* Switch I2C bus if needed */
  259. if (bus != dev->cur_i2c_bus) {
  260. if (bus == 1)
  261. dev->cur_i2c_bus |= EM2874_I2C_SECONDARY_BUS_SELECT;
  262. else
  263. dev->cur_i2c_bus &= ~EM2874_I2C_SECONDARY_BUS_SELECT;
  264. em28xx_write_reg(dev, EM28XX_R06_I2C_CLK, dev->cur_i2c_bus);
  265. dev->cur_i2c_bus = bus;
  266. }
  267. if (num <= 0) {
  268. rt_mutex_unlock(&dev->i2c_bus_lock);
  269. return 0;
  270. }
  271. for (i = 0; i < num; i++) {
  272. addr = msgs[i].addr << 1;
  273. if (i2c_debug)
  274. printk(KERN_DEBUG "%s at %s: %s %s addr=%02x len=%d:",
  275. dev->name, __func__ ,
  276. (msgs[i].flags & I2C_M_RD) ? "read" : "write",
  277. i == num - 1 ? "stop" : "nonstop",
  278. addr, msgs[i].len);
  279. if (!msgs[i].len) { /* no len: check only for device presence */
  280. if (dev->board.is_em2800)
  281. rc = em2800_i2c_check_for_device(dev, addr);
  282. else
  283. rc = em28xx_i2c_check_for_device(dev, addr);
  284. if (rc == -ENODEV) {
  285. if (i2c_debug)
  286. printk(" no device\n");
  287. rt_mutex_unlock(&dev->i2c_bus_lock);
  288. return rc;
  289. }
  290. } else if (msgs[i].flags & I2C_M_RD) {
  291. /* read bytes */
  292. if (dev->board.is_em2800)
  293. rc = em2800_i2c_recv_bytes(dev, addr,
  294. msgs[i].buf,
  295. msgs[i].len);
  296. else
  297. rc = em28xx_i2c_recv_bytes(dev, addr,
  298. msgs[i].buf,
  299. msgs[i].len);
  300. if (i2c_debug) {
  301. for (byte = 0; byte < msgs[i].len; byte++)
  302. printk(" %02x", msgs[i].buf[byte]);
  303. }
  304. } else {
  305. /* write bytes */
  306. if (i2c_debug) {
  307. for (byte = 0; byte < msgs[i].len; byte++)
  308. printk(" %02x", msgs[i].buf[byte]);
  309. }
  310. if (dev->board.is_em2800)
  311. rc = em2800_i2c_send_bytes(dev, addr,
  312. msgs[i].buf,
  313. msgs[i].len);
  314. else
  315. rc = em28xx_i2c_send_bytes(dev, addr,
  316. msgs[i].buf,
  317. msgs[i].len,
  318. i == num - 1);
  319. }
  320. if (rc < 0) {
  321. if (i2c_debug)
  322. printk(" ERROR: %i\n", rc);
  323. rt_mutex_unlock(&dev->i2c_bus_lock);
  324. return rc;
  325. }
  326. if (i2c_debug)
  327. printk("\n");
  328. }
  329. rt_mutex_unlock(&dev->i2c_bus_lock);
  330. return num;
  331. }
  332. /* based on linux/sunrpc/svcauth.h and linux/hash.h
  333. * The original hash function returns a different value, if arch is x86_64
  334. * or i386.
  335. */
  336. static inline unsigned long em28xx_hash_mem(char *buf, int length, int bits)
  337. {
  338. unsigned long hash = 0;
  339. unsigned long l = 0;
  340. int len = 0;
  341. unsigned char c;
  342. do {
  343. if (len == length) {
  344. c = (char)len;
  345. len = -1;
  346. } else
  347. c = *buf++;
  348. l = (l << 8) | c;
  349. len++;
  350. if ((len & (32 / 8 - 1)) == 0)
  351. hash = ((hash^l) * 0x9e370001UL);
  352. } while (len);
  353. return (hash >> (32 - bits)) & 0xffffffffUL;
  354. }
  355. /* Helper function to read data blocks from i2c clients with 8 or 16 bit
  356. * address width, 8 bit register width and auto incrementation been activated */
  357. static int em28xx_i2c_read_block(struct em28xx *dev, unsigned bus, u16 addr,
  358. bool addr_w16, u16 len, u8 *data)
  359. {
  360. int remain = len, rsize, rsize_max, ret;
  361. u8 buf[2];
  362. /* Sanity check */
  363. if (addr + remain > (addr_w16 * 0xff00 + 0xff + 1))
  364. return -EINVAL;
  365. /* Select address */
  366. buf[0] = addr >> 8;
  367. buf[1] = addr & 0xff;
  368. ret = i2c_master_send(&dev->i2c_client[bus], buf + !addr_w16, 1 + addr_w16);
  369. if (ret < 0)
  370. return ret;
  371. /* Read data */
  372. if (dev->board.is_em2800)
  373. rsize_max = 4;
  374. else
  375. rsize_max = 64;
  376. while (remain > 0) {
  377. if (remain > rsize_max)
  378. rsize = rsize_max;
  379. else
  380. rsize = remain;
  381. ret = i2c_master_recv(&dev->i2c_client[bus], data, rsize);
  382. if (ret < 0)
  383. return ret;
  384. remain -= rsize;
  385. data += rsize;
  386. }
  387. return len;
  388. }
  389. static int em28xx_i2c_eeprom(struct em28xx *dev, unsigned bus,
  390. u8 **eedata, u16 *eedata_len)
  391. {
  392. const u16 len = 256;
  393. /* FIXME common length/size for bytes to read, to display, hash
  394. * calculation and returned device dataset. Simplifies the code a lot,
  395. * but we might have to deal with multiple sizes in the future ! */
  396. int i, err;
  397. struct em28xx_eeprom *dev_config;
  398. u8 buf, *data;
  399. *eedata = NULL;
  400. *eedata_len = 0;
  401. /* EEPROM is always on i2c bus 0 on all known devices. */
  402. dev->i2c_client[bus].addr = 0xa0 >> 1;
  403. /* Check if board has eeprom */
  404. err = i2c_master_recv(&dev->i2c_client[bus], &buf, 0);
  405. if (err < 0) {
  406. em28xx_info("board has no eeprom\n");
  407. return -ENODEV;
  408. }
  409. data = kzalloc(len, GFP_KERNEL);
  410. if (data == NULL)
  411. return -ENOMEM;
  412. /* Read EEPROM content */
  413. err = em28xx_i2c_read_block(dev, bus, 0x0000,
  414. dev->eeprom_addrwidth_16bit,
  415. len, data);
  416. if (err != len) {
  417. em28xx_errdev("failed to read eeprom (err=%d)\n", err);
  418. goto error;
  419. }
  420. /* Display eeprom content */
  421. for (i = 0; i < len; i++) {
  422. if (0 == (i % 16)) {
  423. if (dev->eeprom_addrwidth_16bit)
  424. em28xx_info("i2c eeprom %04x:", i);
  425. else
  426. em28xx_info("i2c eeprom %02x:", i);
  427. }
  428. printk(" %02x", data[i]);
  429. if (15 == (i % 16))
  430. printk("\n");
  431. }
  432. if (dev->eeprom_addrwidth_16bit)
  433. em28xx_info("i2c eeprom %04x: ... (skipped)\n", i);
  434. if (dev->eeprom_addrwidth_16bit &&
  435. data[0] == 0x26 && data[3] == 0x00) {
  436. /* new eeprom format; size 4-64kb */
  437. u16 mc_start;
  438. u16 hwconf_offset;
  439. dev->hash = em28xx_hash_mem(data, len, 32);
  440. mc_start = (data[1] << 8) + 4; /* usually 0x0004 */
  441. em28xx_info("EEPROM ID = %02x %02x %02x %02x, "
  442. "EEPROM hash = 0x%08lx\n",
  443. data[0], data[1], data[2], data[3], dev->hash);
  444. em28xx_info("EEPROM info:\n");
  445. em28xx_info("\tmicrocode start address = 0x%04x, "
  446. "boot configuration = 0x%02x\n",
  447. mc_start, data[2]);
  448. /* boot configuration (address 0x0002):
  449. * [0] microcode download speed: 1 = 400 kHz; 0 = 100 kHz
  450. * [1] always selects 12 kb RAM
  451. * [2] USB device speed: 1 = force Full Speed; 0 = auto detect
  452. * [4] 1 = force fast mode and no suspend for device testing
  453. * [5:7] USB PHY tuning registers; determined by device
  454. * characterization
  455. */
  456. /* Read hardware config dataset offset from address
  457. * (microcode start + 46) */
  458. err = em28xx_i2c_read_block(dev, bus, mc_start + 46, 1, 2,
  459. data);
  460. if (err != 2) {
  461. em28xx_errdev("failed to read hardware configuration data from eeprom (err=%d)\n",
  462. err);
  463. goto error;
  464. }
  465. /* Calculate hardware config dataset start address */
  466. hwconf_offset = mc_start + data[0] + (data[1] << 8);
  467. /* Read hardware config dataset */
  468. /* NOTE: the microcode copy can be multiple pages long, but
  469. * we assume the hardware config dataset is the same as in
  470. * the old eeprom and not longer than 256 bytes.
  471. * tveeprom is currently also limited to 256 bytes.
  472. */
  473. err = em28xx_i2c_read_block(dev, bus, hwconf_offset, 1, len,
  474. data);
  475. if (err != len) {
  476. em28xx_errdev("failed to read hardware configuration data from eeprom (err=%d)\n",
  477. err);
  478. goto error;
  479. }
  480. /* Verify hardware config dataset */
  481. /* NOTE: not all devices provide this type of dataset */
  482. if (data[0] != 0x1a || data[1] != 0xeb ||
  483. data[2] != 0x67 || data[3] != 0x95) {
  484. em28xx_info("\tno hardware configuration dataset found in eeprom\n");
  485. kfree(data);
  486. return 0;
  487. }
  488. /* TODO: decrypt eeprom data for camera bridges (em25xx, em276x+) */
  489. } else if (!dev->eeprom_addrwidth_16bit &&
  490. data[0] == 0x1a && data[1] == 0xeb &&
  491. data[2] == 0x67 && data[3] == 0x95) {
  492. dev->hash = em28xx_hash_mem(data, len, 32);
  493. em28xx_info("EEPROM ID = %02x %02x %02x %02x, "
  494. "EEPROM hash = 0x%08lx\n",
  495. data[0], data[1], data[2], data[3], dev->hash);
  496. em28xx_info("EEPROM info:\n");
  497. } else {
  498. em28xx_info("unknown eeprom format or eeprom corrupted !\n");
  499. err = -ENODEV;
  500. goto error;
  501. }
  502. *eedata = data;
  503. *eedata_len = len;
  504. dev_config = (void *)eedata;
  505. switch (le16_to_cpu(dev_config->chip_conf) >> 4 & 0x3) {
  506. case 0:
  507. em28xx_info("\tNo audio on board.\n");
  508. break;
  509. case 1:
  510. em28xx_info("\tAC97 audio (5 sample rates)\n");
  511. break;
  512. case 2:
  513. em28xx_info("\tI2S audio, sample rate=32k\n");
  514. break;
  515. case 3:
  516. em28xx_info("\tI2S audio, 3 sample rates\n");
  517. break;
  518. }
  519. if (le16_to_cpu(dev_config->chip_conf) & 1 << 3)
  520. em28xx_info("\tUSB Remote wakeup capable\n");
  521. if (le16_to_cpu(dev_config->chip_conf) & 1 << 2)
  522. em28xx_info("\tUSB Self power capable\n");
  523. switch (le16_to_cpu(dev_config->chip_conf) & 0x3) {
  524. case 0:
  525. em28xx_info("\t500mA max power\n");
  526. break;
  527. case 1:
  528. em28xx_info("\t400mA max power\n");
  529. break;
  530. case 2:
  531. em28xx_info("\t300mA max power\n");
  532. break;
  533. case 3:
  534. em28xx_info("\t200mA max power\n");
  535. break;
  536. }
  537. em28xx_info("\tTable at offset 0x%02x, strings=0x%04x, 0x%04x, 0x%04x\n",
  538. dev_config->string_idx_table,
  539. le16_to_cpu(dev_config->string1),
  540. le16_to_cpu(dev_config->string2),
  541. le16_to_cpu(dev_config->string3));
  542. return 0;
  543. error:
  544. kfree(data);
  545. return err;
  546. }
  547. /* ----------------------------------------------------------- */
  548. /*
  549. * functionality()
  550. */
  551. static u32 functionality(struct i2c_adapter *i2c_adap)
  552. {
  553. struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data;
  554. struct em28xx *dev = i2c_bus->dev;
  555. u32 func_flags = I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
  556. if (dev->board.is_em2800)
  557. func_flags &= ~I2C_FUNC_SMBUS_WRITE_BLOCK_DATA;
  558. return func_flags;
  559. }
  560. static struct i2c_algorithm em28xx_algo = {
  561. .master_xfer = em28xx_i2c_xfer,
  562. .functionality = functionality,
  563. };
  564. static struct i2c_adapter em28xx_adap_template = {
  565. .owner = THIS_MODULE,
  566. .name = "em28xx",
  567. .algo = &em28xx_algo,
  568. };
  569. static struct i2c_client em28xx_client_template = {
  570. .name = "em28xx internal",
  571. };
  572. /* ----------------------------------------------------------- */
  573. /*
  574. * i2c_devs
  575. * incomplete list of known devices
  576. */
  577. static char *i2c_devs[128] = {
  578. [0x3e >> 1] = "remote IR sensor",
  579. [0x4a >> 1] = "saa7113h",
  580. [0x52 >> 1] = "drxk",
  581. [0x60 >> 1] = "remote IR sensor",
  582. [0x8e >> 1] = "remote IR sensor",
  583. [0x86 >> 1] = "tda9887",
  584. [0x80 >> 1] = "msp34xx",
  585. [0x88 >> 1] = "msp34xx",
  586. [0xa0 >> 1] = "eeprom",
  587. [0xb0 >> 1] = "tda9874",
  588. [0xb8 >> 1] = "tvp5150a",
  589. [0xba >> 1] = "webcam sensor or tvp5150a",
  590. [0xc0 >> 1] = "tuner (analog)",
  591. [0xc2 >> 1] = "tuner (analog)",
  592. [0xc4 >> 1] = "tuner (analog)",
  593. [0xc6 >> 1] = "tuner (analog)",
  594. };
  595. /*
  596. * do_i2c_scan()
  597. * check i2c address range for devices
  598. */
  599. void em28xx_do_i2c_scan(struct em28xx *dev, unsigned bus)
  600. {
  601. u8 i2c_devicelist[128];
  602. unsigned char buf;
  603. int i, rc;
  604. memset(i2c_devicelist, 0, ARRAY_SIZE(i2c_devicelist));
  605. for (i = 0; i < ARRAY_SIZE(i2c_devs); i++) {
  606. dev->i2c_client[bus].addr = i;
  607. rc = i2c_master_recv(&dev->i2c_client[bus], &buf, 0);
  608. if (rc < 0)
  609. continue;
  610. i2c_devicelist[i] = i;
  611. em28xx_info("found i2c device @ 0x%x on bus %d [%s]\n",
  612. i << 1, bus, i2c_devs[i] ? i2c_devs[i] : "???");
  613. }
  614. if (bus == dev->def_i2c_bus)
  615. dev->i2c_hash = em28xx_hash_mem(i2c_devicelist,
  616. ARRAY_SIZE(i2c_devicelist), 32);
  617. }
  618. /*
  619. * em28xx_i2c_register()
  620. * register i2c bus
  621. */
  622. int em28xx_i2c_register(struct em28xx *dev, unsigned bus)
  623. {
  624. int retval;
  625. BUG_ON(!dev->em28xx_write_regs || !dev->em28xx_read_reg);
  626. BUG_ON(!dev->em28xx_write_regs_req || !dev->em28xx_read_reg_req);
  627. if (bus >= NUM_I2C_BUSES)
  628. return -ENODEV;
  629. dev->i2c_adap[bus] = em28xx_adap_template;
  630. dev->i2c_adap[bus].dev.parent = &dev->udev->dev;
  631. strcpy(dev->i2c_adap[bus].name, dev->name);
  632. dev->i2c_bus[bus].bus = bus;
  633. dev->i2c_bus[bus].dev = dev;
  634. dev->i2c_adap[bus].algo_data = &dev->i2c_bus[bus];
  635. i2c_set_adapdata(&dev->i2c_adap[bus], &dev->v4l2_dev);
  636. retval = i2c_add_adapter(&dev->i2c_adap[bus]);
  637. if (retval < 0) {
  638. em28xx_errdev("%s: i2c_add_adapter failed! retval [%d]\n",
  639. __func__, retval);
  640. return retval;
  641. }
  642. dev->i2c_client[bus] = em28xx_client_template;
  643. dev->i2c_client[bus].adapter = &dev->i2c_adap[bus];
  644. /* Up to now, all eeproms are at bus 0 */
  645. if (!bus) {
  646. retval = em28xx_i2c_eeprom(dev, bus, &dev->eedata, &dev->eedata_len);
  647. if ((retval < 0) && (retval != -ENODEV)) {
  648. em28xx_errdev("%s: em28xx_i2_eeprom failed! retval [%d]\n",
  649. __func__, retval);
  650. return retval;
  651. }
  652. }
  653. if (i2c_scan)
  654. em28xx_do_i2c_scan(dev, bus);
  655. return 0;
  656. }
  657. /*
  658. * em28xx_i2c_unregister()
  659. * unregister i2c_bus
  660. */
  661. int em28xx_i2c_unregister(struct em28xx *dev, unsigned bus)
  662. {
  663. if (bus >= NUM_I2C_BUSES)
  664. return -ENODEV;
  665. i2c_del_adapter(&dev->i2c_adap[bus]);
  666. return 0;
  667. }