i2c-mv64xxx.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603
  1. /*
  2. * Driver for the i2c controller on the Marvell line of host bridges for MIPS
  3. * and PPC (e.g, gt642[46]0, mv643[46]0, mv644[46]0).
  4. *
  5. * Author: Mark A. Greer <mgreer@mvista.com>
  6. *
  7. * 2005 (c) MontaVista, Software, Inc. This file is licensed under
  8. * the terms of the GNU General Public License version 2. This program
  9. * is licensed "as is" without any warranty of any kind, whether express
  10. * or implied.
  11. */
  12. #include <linux/kernel.h>
  13. #include <linux/module.h>
  14. #include <linux/spinlock.h>
  15. #include <linux/i2c.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/mv643xx.h>
  18. #include <linux/platform_device.h>
  19. #include <asm/io.h>
  20. /* Register defines */
  21. #define MV64XXX_I2C_REG_SLAVE_ADDR 0x00
  22. #define MV64XXX_I2C_REG_DATA 0x04
  23. #define MV64XXX_I2C_REG_CONTROL 0x08
  24. #define MV64XXX_I2C_REG_STATUS 0x0c
  25. #define MV64XXX_I2C_REG_BAUD 0x0c
  26. #define MV64XXX_I2C_REG_EXT_SLAVE_ADDR 0x10
  27. #define MV64XXX_I2C_REG_SOFT_RESET 0x1c
  28. #define MV64XXX_I2C_REG_CONTROL_ACK 0x00000004
  29. #define MV64XXX_I2C_REG_CONTROL_IFLG 0x00000008
  30. #define MV64XXX_I2C_REG_CONTROL_STOP 0x00000010
  31. #define MV64XXX_I2C_REG_CONTROL_START 0x00000020
  32. #define MV64XXX_I2C_REG_CONTROL_TWSIEN 0x00000040
  33. #define MV64XXX_I2C_REG_CONTROL_INTEN 0x00000080
  34. /* Ctlr status values */
  35. #define MV64XXX_I2C_STATUS_BUS_ERR 0x00
  36. #define MV64XXX_I2C_STATUS_MAST_START 0x08
  37. #define MV64XXX_I2C_STATUS_MAST_REPEAT_START 0x10
  38. #define MV64XXX_I2C_STATUS_MAST_WR_ADDR_ACK 0x18
  39. #define MV64XXX_I2C_STATUS_MAST_WR_ADDR_NO_ACK 0x20
  40. #define MV64XXX_I2C_STATUS_MAST_WR_ACK 0x28
  41. #define MV64XXX_I2C_STATUS_MAST_WR_NO_ACK 0x30
  42. #define MV64XXX_I2C_STATUS_MAST_LOST_ARB 0x38
  43. #define MV64XXX_I2C_STATUS_MAST_RD_ADDR_ACK 0x40
  44. #define MV64XXX_I2C_STATUS_MAST_RD_ADDR_NO_ACK 0x48
  45. #define MV64XXX_I2C_STATUS_MAST_RD_DATA_ACK 0x50
  46. #define MV64XXX_I2C_STATUS_MAST_RD_DATA_NO_ACK 0x58
  47. #define MV64XXX_I2C_STATUS_MAST_WR_ADDR_2_ACK 0xd0
  48. #define MV64XXX_I2C_STATUS_MAST_WR_ADDR_2_NO_ACK 0xd8
  49. #define MV64XXX_I2C_STATUS_MAST_RD_ADDR_2_ACK 0xe0
  50. #define MV64XXX_I2C_STATUS_MAST_RD_ADDR_2_NO_ACK 0xe8
  51. #define MV64XXX_I2C_STATUS_NO_STATUS 0xf8
  52. /* Driver states */
  53. enum {
  54. MV64XXX_I2C_STATE_INVALID,
  55. MV64XXX_I2C_STATE_IDLE,
  56. MV64XXX_I2C_STATE_WAITING_FOR_START_COND,
  57. MV64XXX_I2C_STATE_WAITING_FOR_ADDR_1_ACK,
  58. MV64XXX_I2C_STATE_WAITING_FOR_ADDR_2_ACK,
  59. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_ACK,
  60. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA,
  61. };
  62. /* Driver actions */
  63. enum {
  64. MV64XXX_I2C_ACTION_INVALID,
  65. MV64XXX_I2C_ACTION_CONTINUE,
  66. MV64XXX_I2C_ACTION_SEND_START,
  67. MV64XXX_I2C_ACTION_SEND_ADDR_1,
  68. MV64XXX_I2C_ACTION_SEND_ADDR_2,
  69. MV64XXX_I2C_ACTION_SEND_DATA,
  70. MV64XXX_I2C_ACTION_RCV_DATA,
  71. MV64XXX_I2C_ACTION_RCV_DATA_STOP,
  72. MV64XXX_I2C_ACTION_SEND_STOP,
  73. };
  74. struct mv64xxx_i2c_data {
  75. int irq;
  76. u32 state;
  77. u32 action;
  78. u32 aborting;
  79. u32 cntl_bits;
  80. void __iomem *reg_base;
  81. u32 reg_base_p;
  82. u32 addr1;
  83. u32 addr2;
  84. u32 bytes_left;
  85. u32 byte_posn;
  86. u32 block;
  87. int rc;
  88. u32 freq_m;
  89. u32 freq_n;
  90. wait_queue_head_t waitq;
  91. spinlock_t lock;
  92. struct i2c_msg *msg;
  93. struct i2c_adapter adapter;
  94. };
  95. /*
  96. *****************************************************************************
  97. *
  98. * Finite State Machine & Interrupt Routines
  99. *
  100. *****************************************************************************
  101. */
  102. /* Reset hardware and initialize FSM */
  103. static void
  104. mv64xxx_i2c_hw_init(struct mv64xxx_i2c_data *drv_data)
  105. {
  106. writel(0, drv_data->reg_base + MV64XXX_I2C_REG_SOFT_RESET);
  107. writel((((drv_data->freq_m & 0xf) << 3) | (drv_data->freq_n & 0x7)),
  108. drv_data->reg_base + MV64XXX_I2C_REG_BAUD);
  109. writel(0, drv_data->reg_base + MV64XXX_I2C_REG_SLAVE_ADDR);
  110. writel(0, drv_data->reg_base + MV64XXX_I2C_REG_EXT_SLAVE_ADDR);
  111. writel(MV64XXX_I2C_REG_CONTROL_TWSIEN | MV64XXX_I2C_REG_CONTROL_STOP,
  112. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  113. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  114. }
  115. static void
  116. mv64xxx_i2c_fsm(struct mv64xxx_i2c_data *drv_data, u32 status)
  117. {
  118. /*
  119. * If state is idle, then this is likely the remnants of an old
  120. * operation that driver has given up on or the user has killed.
  121. * If so, issue the stop condition and go to idle.
  122. */
  123. if (drv_data->state == MV64XXX_I2C_STATE_IDLE) {
  124. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  125. return;
  126. }
  127. /* The status from the ctlr [mostly] tells us what to do next */
  128. switch (status) {
  129. /* Start condition interrupt */
  130. case MV64XXX_I2C_STATUS_MAST_START: /* 0x08 */
  131. case MV64XXX_I2C_STATUS_MAST_REPEAT_START: /* 0x10 */
  132. drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_1;
  133. drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_ADDR_1_ACK;
  134. break;
  135. /* Performing a write */
  136. case MV64XXX_I2C_STATUS_MAST_WR_ADDR_ACK: /* 0x18 */
  137. if (drv_data->msg->flags & I2C_M_TEN) {
  138. drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2;
  139. drv_data->state =
  140. MV64XXX_I2C_STATE_WAITING_FOR_ADDR_2_ACK;
  141. break;
  142. }
  143. /* FALLTHRU */
  144. case MV64XXX_I2C_STATUS_MAST_WR_ADDR_2_ACK: /* 0xd0 */
  145. case MV64XXX_I2C_STATUS_MAST_WR_ACK: /* 0x28 */
  146. if ((drv_data->bytes_left == 0)
  147. || (drv_data->aborting
  148. && (drv_data->byte_posn != 0))) {
  149. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  150. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  151. } else {
  152. drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA;
  153. drv_data->state =
  154. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_ACK;
  155. drv_data->bytes_left--;
  156. }
  157. break;
  158. /* Performing a read */
  159. case MV64XXX_I2C_STATUS_MAST_RD_ADDR_ACK: /* 40 */
  160. if (drv_data->msg->flags & I2C_M_TEN) {
  161. drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2;
  162. drv_data->state =
  163. MV64XXX_I2C_STATE_WAITING_FOR_ADDR_2_ACK;
  164. break;
  165. }
  166. /* FALLTHRU */
  167. case MV64XXX_I2C_STATUS_MAST_RD_ADDR_2_ACK: /* 0xe0 */
  168. if (drv_data->bytes_left == 0) {
  169. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  170. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  171. break;
  172. }
  173. /* FALLTHRU */
  174. case MV64XXX_I2C_STATUS_MAST_RD_DATA_ACK: /* 0x50 */
  175. if (status != MV64XXX_I2C_STATUS_MAST_RD_DATA_ACK)
  176. drv_data->action = MV64XXX_I2C_ACTION_CONTINUE;
  177. else {
  178. drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA;
  179. drv_data->bytes_left--;
  180. }
  181. drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA;
  182. if ((drv_data->bytes_left == 1) || drv_data->aborting)
  183. drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_ACK;
  184. break;
  185. case MV64XXX_I2C_STATUS_MAST_RD_DATA_NO_ACK: /* 0x58 */
  186. drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA_STOP;
  187. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  188. break;
  189. case MV64XXX_I2C_STATUS_MAST_WR_ADDR_NO_ACK: /* 0x20 */
  190. case MV64XXX_I2C_STATUS_MAST_WR_NO_ACK: /* 30 */
  191. case MV64XXX_I2C_STATUS_MAST_RD_ADDR_NO_ACK: /* 48 */
  192. /* Doesn't seem to be a device at other end */
  193. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  194. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  195. drv_data->rc = -ENODEV;
  196. break;
  197. default:
  198. dev_err(&drv_data->adapter.dev,
  199. "mv64xxx_i2c_fsm: Ctlr Error -- state: 0x%x, "
  200. "status: 0x%x, addr: 0x%x, flags: 0x%x\n",
  201. drv_data->state, status, drv_data->msg->addr,
  202. drv_data->msg->flags);
  203. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  204. mv64xxx_i2c_hw_init(drv_data);
  205. drv_data->rc = -EIO;
  206. }
  207. }
  208. static void
  209. mv64xxx_i2c_do_action(struct mv64xxx_i2c_data *drv_data)
  210. {
  211. switch(drv_data->action) {
  212. case MV64XXX_I2C_ACTION_CONTINUE:
  213. writel(drv_data->cntl_bits,
  214. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  215. break;
  216. case MV64XXX_I2C_ACTION_SEND_START:
  217. writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_START,
  218. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  219. break;
  220. case MV64XXX_I2C_ACTION_SEND_ADDR_1:
  221. writel(drv_data->addr1,
  222. drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  223. writel(drv_data->cntl_bits,
  224. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  225. break;
  226. case MV64XXX_I2C_ACTION_SEND_ADDR_2:
  227. writel(drv_data->addr2,
  228. drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  229. writel(drv_data->cntl_bits,
  230. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  231. break;
  232. case MV64XXX_I2C_ACTION_SEND_DATA:
  233. writel(drv_data->msg->buf[drv_data->byte_posn++],
  234. drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  235. writel(drv_data->cntl_bits,
  236. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  237. break;
  238. case MV64XXX_I2C_ACTION_RCV_DATA:
  239. drv_data->msg->buf[drv_data->byte_posn++] =
  240. readl(drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  241. writel(drv_data->cntl_bits,
  242. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  243. break;
  244. case MV64XXX_I2C_ACTION_RCV_DATA_STOP:
  245. drv_data->msg->buf[drv_data->byte_posn++] =
  246. readl(drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  247. drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN;
  248. writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP,
  249. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  250. drv_data->block = 0;
  251. wake_up_interruptible(&drv_data->waitq);
  252. break;
  253. case MV64XXX_I2C_ACTION_INVALID:
  254. default:
  255. dev_err(&drv_data->adapter.dev,
  256. "mv64xxx_i2c_do_action: Invalid action: %d\n",
  257. drv_data->action);
  258. drv_data->rc = -EIO;
  259. /* FALLTHRU */
  260. case MV64XXX_I2C_ACTION_SEND_STOP:
  261. drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN;
  262. writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP,
  263. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  264. drv_data->block = 0;
  265. wake_up_interruptible(&drv_data->waitq);
  266. break;
  267. }
  268. }
  269. static int
  270. mv64xxx_i2c_intr(int irq, void *dev_id)
  271. {
  272. struct mv64xxx_i2c_data *drv_data = dev_id;
  273. unsigned long flags;
  274. u32 status;
  275. int rc = IRQ_NONE;
  276. spin_lock_irqsave(&drv_data->lock, flags);
  277. while (readl(drv_data->reg_base + MV64XXX_I2C_REG_CONTROL) &
  278. MV64XXX_I2C_REG_CONTROL_IFLG) {
  279. status = readl(drv_data->reg_base + MV64XXX_I2C_REG_STATUS);
  280. mv64xxx_i2c_fsm(drv_data, status);
  281. mv64xxx_i2c_do_action(drv_data);
  282. rc = IRQ_HANDLED;
  283. }
  284. spin_unlock_irqrestore(&drv_data->lock, flags);
  285. return rc;
  286. }
  287. /*
  288. *****************************************************************************
  289. *
  290. * I2C Msg Execution Routines
  291. *
  292. *****************************************************************************
  293. */
  294. static void
  295. mv64xxx_i2c_prepare_for_io(struct mv64xxx_i2c_data *drv_data,
  296. struct i2c_msg *msg)
  297. {
  298. u32 dir = 0;
  299. drv_data->msg = msg;
  300. drv_data->byte_posn = 0;
  301. drv_data->bytes_left = msg->len;
  302. drv_data->aborting = 0;
  303. drv_data->rc = 0;
  304. drv_data->cntl_bits = MV64XXX_I2C_REG_CONTROL_ACK |
  305. MV64XXX_I2C_REG_CONTROL_INTEN | MV64XXX_I2C_REG_CONTROL_TWSIEN;
  306. if (msg->flags & I2C_M_RD)
  307. dir = 1;
  308. if (msg->flags & I2C_M_REV_DIR_ADDR)
  309. dir ^= 1;
  310. if (msg->flags & I2C_M_TEN) {
  311. drv_data->addr1 = 0xf0 | (((u32)msg->addr & 0x300) >> 7) | dir;
  312. drv_data->addr2 = (u32)msg->addr & 0xff;
  313. } else {
  314. drv_data->addr1 = ((u32)msg->addr & 0x7f) << 1 | dir;
  315. drv_data->addr2 = 0;
  316. }
  317. }
  318. static void
  319. mv64xxx_i2c_wait_for_completion(struct mv64xxx_i2c_data *drv_data)
  320. {
  321. long time_left;
  322. unsigned long flags;
  323. char abort = 0;
  324. time_left = wait_event_interruptible_timeout(drv_data->waitq,
  325. !drv_data->block, msecs_to_jiffies(drv_data->adapter.timeout));
  326. spin_lock_irqsave(&drv_data->lock, flags);
  327. if (!time_left) { /* Timed out */
  328. drv_data->rc = -ETIMEDOUT;
  329. abort = 1;
  330. } else if (time_left < 0) { /* Interrupted/Error */
  331. drv_data->rc = time_left; /* errno value */
  332. abort = 1;
  333. }
  334. if (abort && drv_data->block) {
  335. drv_data->aborting = 1;
  336. spin_unlock_irqrestore(&drv_data->lock, flags);
  337. time_left = wait_event_timeout(drv_data->waitq,
  338. !drv_data->block,
  339. msecs_to_jiffies(drv_data->adapter.timeout));
  340. if ((time_left <= 0) && drv_data->block) {
  341. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  342. dev_err(&drv_data->adapter.dev,
  343. "mv64xxx: I2C bus locked, block: %d, "
  344. "time_left: %d\n", drv_data->block,
  345. (int)time_left);
  346. mv64xxx_i2c_hw_init(drv_data);
  347. }
  348. } else
  349. spin_unlock_irqrestore(&drv_data->lock, flags);
  350. }
  351. static int
  352. mv64xxx_i2c_execute_msg(struct mv64xxx_i2c_data *drv_data, struct i2c_msg *msg)
  353. {
  354. unsigned long flags;
  355. spin_lock_irqsave(&drv_data->lock, flags);
  356. mv64xxx_i2c_prepare_for_io(drv_data, msg);
  357. if (unlikely(msg->flags & I2C_M_NOSTART)) { /* Skip start/addr phases */
  358. if (drv_data->msg->flags & I2C_M_RD) {
  359. /* No action to do, wait for slave to send a byte */
  360. drv_data->action = MV64XXX_I2C_ACTION_CONTINUE;
  361. drv_data->state =
  362. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA;
  363. } else {
  364. drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA;
  365. drv_data->state =
  366. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_ACK;
  367. drv_data->bytes_left--;
  368. }
  369. } else {
  370. drv_data->action = MV64XXX_I2C_ACTION_SEND_START;
  371. drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_START_COND;
  372. }
  373. drv_data->block = 1;
  374. mv64xxx_i2c_do_action(drv_data);
  375. spin_unlock_irqrestore(&drv_data->lock, flags);
  376. mv64xxx_i2c_wait_for_completion(drv_data);
  377. return drv_data->rc;
  378. }
  379. /*
  380. *****************************************************************************
  381. *
  382. * I2C Core Support Routines (Interface to higher level I2C code)
  383. *
  384. *****************************************************************************
  385. */
  386. static u32
  387. mv64xxx_i2c_functionality(struct i2c_adapter *adap)
  388. {
  389. return I2C_FUNC_I2C | I2C_FUNC_10BIT_ADDR | I2C_FUNC_SMBUS_EMUL;
  390. }
  391. static int
  392. mv64xxx_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num)
  393. {
  394. struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap);
  395. int i, rc;
  396. for (i=0; i<num; i++)
  397. if ((rc = mv64xxx_i2c_execute_msg(drv_data, &msgs[i])) < 0)
  398. return rc;
  399. return num;
  400. }
  401. static const struct i2c_algorithm mv64xxx_i2c_algo = {
  402. .master_xfer = mv64xxx_i2c_xfer,
  403. .functionality = mv64xxx_i2c_functionality,
  404. };
  405. /*
  406. *****************************************************************************
  407. *
  408. * Driver Interface & Early Init Routines
  409. *
  410. *****************************************************************************
  411. */
  412. static int __devinit
  413. mv64xxx_i2c_map_regs(struct platform_device *pd,
  414. struct mv64xxx_i2c_data *drv_data)
  415. {
  416. struct resource *r;
  417. if ((r = platform_get_resource(pd, IORESOURCE_MEM, 0)) &&
  418. request_mem_region(r->start, MV64XXX_I2C_REG_BLOCK_SIZE,
  419. drv_data->adapter.name)) {
  420. drv_data->reg_base = ioremap(r->start,
  421. MV64XXX_I2C_REG_BLOCK_SIZE);
  422. drv_data->reg_base_p = r->start;
  423. } else
  424. return -ENOMEM;
  425. return 0;
  426. }
  427. static void __devexit
  428. mv64xxx_i2c_unmap_regs(struct mv64xxx_i2c_data *drv_data)
  429. {
  430. if (drv_data->reg_base) {
  431. iounmap(drv_data->reg_base);
  432. release_mem_region(drv_data->reg_base_p,
  433. MV64XXX_I2C_REG_BLOCK_SIZE);
  434. }
  435. drv_data->reg_base = NULL;
  436. drv_data->reg_base_p = 0;
  437. }
  438. static int __devinit
  439. mv64xxx_i2c_probe(struct platform_device *pd)
  440. {
  441. struct mv64xxx_i2c_data *drv_data;
  442. struct mv64xxx_i2c_pdata *pdata = pd->dev.platform_data;
  443. int rc;
  444. if ((pd->id != 0) || !pdata)
  445. return -ENODEV;
  446. drv_data = kzalloc(sizeof(struct mv64xxx_i2c_data), GFP_KERNEL);
  447. if (!drv_data)
  448. return -ENOMEM;
  449. if (mv64xxx_i2c_map_regs(pd, drv_data)) {
  450. rc = -ENODEV;
  451. goto exit_kfree;
  452. }
  453. strlcpy(drv_data->adapter.name, MV64XXX_I2C_CTLR_NAME " adapter",
  454. sizeof(drv_data->adapter.name));
  455. init_waitqueue_head(&drv_data->waitq);
  456. spin_lock_init(&drv_data->lock);
  457. drv_data->freq_m = pdata->freq_m;
  458. drv_data->freq_n = pdata->freq_n;
  459. drv_data->irq = platform_get_irq(pd, 0);
  460. if (drv_data->irq < 0) {
  461. rc = -ENXIO;
  462. goto exit_unmap_regs;
  463. }
  464. drv_data->adapter.dev.parent = &pd->dev;
  465. drv_data->adapter.id = I2C_HW_MV64XXX;
  466. drv_data->adapter.algo = &mv64xxx_i2c_algo;
  467. drv_data->adapter.owner = THIS_MODULE;
  468. drv_data->adapter.class = I2C_CLASS_HWMON;
  469. drv_data->adapter.timeout = pdata->timeout;
  470. drv_data->adapter.retries = pdata->retries;
  471. drv_data->adapter.nr = pd->id;
  472. platform_set_drvdata(pd, drv_data);
  473. i2c_set_adapdata(&drv_data->adapter, drv_data);
  474. mv64xxx_i2c_hw_init(drv_data);
  475. if (request_irq(drv_data->irq, mv64xxx_i2c_intr, 0,
  476. MV64XXX_I2C_CTLR_NAME, drv_data)) {
  477. dev_err(&drv_data->adapter.dev,
  478. "mv64xxx: Can't register intr handler irq: %d\n",
  479. drv_data->irq);
  480. rc = -EINVAL;
  481. goto exit_unmap_regs;
  482. } else if ((rc = i2c_add_numbered_adapter(&drv_data->adapter)) != 0) {
  483. dev_err(&drv_data->adapter.dev,
  484. "mv64xxx: Can't add i2c adapter, rc: %d\n", -rc);
  485. goto exit_free_irq;
  486. }
  487. return 0;
  488. exit_free_irq:
  489. free_irq(drv_data->irq, drv_data);
  490. exit_unmap_regs:
  491. mv64xxx_i2c_unmap_regs(drv_data);
  492. exit_kfree:
  493. kfree(drv_data);
  494. return rc;
  495. }
  496. static int __devexit
  497. mv64xxx_i2c_remove(struct platform_device *dev)
  498. {
  499. struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(dev);
  500. int rc;
  501. rc = i2c_del_adapter(&drv_data->adapter);
  502. free_irq(drv_data->irq, drv_data);
  503. mv64xxx_i2c_unmap_regs(drv_data);
  504. kfree(drv_data);
  505. return rc;
  506. }
  507. static struct platform_driver mv64xxx_i2c_driver = {
  508. .probe = mv64xxx_i2c_probe,
  509. .remove = mv64xxx_i2c_remove,
  510. .driver = {
  511. .owner = THIS_MODULE,
  512. .name = MV64XXX_I2C_CTLR_NAME,
  513. },
  514. };
  515. static int __init
  516. mv64xxx_i2c_init(void)
  517. {
  518. return platform_driver_register(&mv64xxx_i2c_driver);
  519. }
  520. static void __exit
  521. mv64xxx_i2c_exit(void)
  522. {
  523. platform_driver_unregister(&mv64xxx_i2c_driver);
  524. }
  525. module_init(mv64xxx_i2c_init);
  526. module_exit(mv64xxx_i2c_exit);
  527. MODULE_AUTHOR("Mark A. Greer <mgreer@mvista.com>");
  528. MODULE_DESCRIPTION("Marvell mv64xxx host bridge i2c ctlr driver");
  529. MODULE_LICENSE("GPL");