i2c-mv64xxx.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605
  1. /*
  2. * Driver for the i2c controller on the Marvell line of host bridges
  3. * (e.g, gt642[46]0, mv643[46]0, mv644[46]0, and Orion SoC family).
  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_i2c.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 reg_size;
  83. u32 addr1;
  84. u32 addr2;
  85. u32 bytes_left;
  86. u32 byte_posn;
  87. u32 block;
  88. int rc;
  89. u32 freq_m;
  90. u32 freq_n;
  91. wait_queue_head_t waitq;
  92. spinlock_t lock;
  93. struct i2c_msg *msg;
  94. struct i2c_adapter adapter;
  95. };
  96. /*
  97. *****************************************************************************
  98. *
  99. * Finite State Machine & Interrupt Routines
  100. *
  101. *****************************************************************************
  102. */
  103. /* Reset hardware and initialize FSM */
  104. static void
  105. mv64xxx_i2c_hw_init(struct mv64xxx_i2c_data *drv_data)
  106. {
  107. writel(0, drv_data->reg_base + MV64XXX_I2C_REG_SOFT_RESET);
  108. writel((((drv_data->freq_m & 0xf) << 3) | (drv_data->freq_n & 0x7)),
  109. drv_data->reg_base + MV64XXX_I2C_REG_BAUD);
  110. writel(0, drv_data->reg_base + MV64XXX_I2C_REG_SLAVE_ADDR);
  111. writel(0, drv_data->reg_base + MV64XXX_I2C_REG_EXT_SLAVE_ADDR);
  112. writel(MV64XXX_I2C_REG_CONTROL_TWSIEN | MV64XXX_I2C_REG_CONTROL_STOP,
  113. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  114. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  115. }
  116. static void
  117. mv64xxx_i2c_fsm(struct mv64xxx_i2c_data *drv_data, u32 status)
  118. {
  119. /*
  120. * If state is idle, then this is likely the remnants of an old
  121. * operation that driver has given up on or the user has killed.
  122. * If so, issue the stop condition and go to idle.
  123. */
  124. if (drv_data->state == MV64XXX_I2C_STATE_IDLE) {
  125. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  126. return;
  127. }
  128. /* The status from the ctlr [mostly] tells us what to do next */
  129. switch (status) {
  130. /* Start condition interrupt */
  131. case MV64XXX_I2C_STATUS_MAST_START: /* 0x08 */
  132. case MV64XXX_I2C_STATUS_MAST_REPEAT_START: /* 0x10 */
  133. drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_1;
  134. drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_ADDR_1_ACK;
  135. break;
  136. /* Performing a write */
  137. case MV64XXX_I2C_STATUS_MAST_WR_ADDR_ACK: /* 0x18 */
  138. if (drv_data->msg->flags & I2C_M_TEN) {
  139. drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2;
  140. drv_data->state =
  141. MV64XXX_I2C_STATE_WAITING_FOR_ADDR_2_ACK;
  142. break;
  143. }
  144. /* FALLTHRU */
  145. case MV64XXX_I2C_STATUS_MAST_WR_ADDR_2_ACK: /* 0xd0 */
  146. case MV64XXX_I2C_STATUS_MAST_WR_ACK: /* 0x28 */
  147. if ((drv_data->bytes_left == 0)
  148. || (drv_data->aborting
  149. && (drv_data->byte_posn != 0))) {
  150. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  151. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  152. } else {
  153. drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA;
  154. drv_data->state =
  155. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_ACK;
  156. drv_data->bytes_left--;
  157. }
  158. break;
  159. /* Performing a read */
  160. case MV64XXX_I2C_STATUS_MAST_RD_ADDR_ACK: /* 40 */
  161. if (drv_data->msg->flags & I2C_M_TEN) {
  162. drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2;
  163. drv_data->state =
  164. MV64XXX_I2C_STATE_WAITING_FOR_ADDR_2_ACK;
  165. break;
  166. }
  167. /* FALLTHRU */
  168. case MV64XXX_I2C_STATUS_MAST_RD_ADDR_2_ACK: /* 0xe0 */
  169. if (drv_data->bytes_left == 0) {
  170. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  171. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  172. break;
  173. }
  174. /* FALLTHRU */
  175. case MV64XXX_I2C_STATUS_MAST_RD_DATA_ACK: /* 0x50 */
  176. if (status != MV64XXX_I2C_STATUS_MAST_RD_DATA_ACK)
  177. drv_data->action = MV64XXX_I2C_ACTION_CONTINUE;
  178. else {
  179. drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA;
  180. drv_data->bytes_left--;
  181. }
  182. drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA;
  183. if ((drv_data->bytes_left == 1) || drv_data->aborting)
  184. drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_ACK;
  185. break;
  186. case MV64XXX_I2C_STATUS_MAST_RD_DATA_NO_ACK: /* 0x58 */
  187. drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA_STOP;
  188. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  189. break;
  190. case MV64XXX_I2C_STATUS_MAST_WR_ADDR_NO_ACK: /* 0x20 */
  191. case MV64XXX_I2C_STATUS_MAST_WR_NO_ACK: /* 30 */
  192. case MV64XXX_I2C_STATUS_MAST_RD_ADDR_NO_ACK: /* 48 */
  193. /* Doesn't seem to be a device at other end */
  194. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  195. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  196. drv_data->rc = -ENODEV;
  197. break;
  198. default:
  199. dev_err(&drv_data->adapter.dev,
  200. "mv64xxx_i2c_fsm: Ctlr Error -- state: 0x%x, "
  201. "status: 0x%x, addr: 0x%x, flags: 0x%x\n",
  202. drv_data->state, status, drv_data->msg->addr,
  203. drv_data->msg->flags);
  204. drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP;
  205. mv64xxx_i2c_hw_init(drv_data);
  206. drv_data->rc = -EIO;
  207. }
  208. }
  209. static void
  210. mv64xxx_i2c_do_action(struct mv64xxx_i2c_data *drv_data)
  211. {
  212. switch(drv_data->action) {
  213. case MV64XXX_I2C_ACTION_CONTINUE:
  214. writel(drv_data->cntl_bits,
  215. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  216. break;
  217. case MV64XXX_I2C_ACTION_SEND_START:
  218. writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_START,
  219. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  220. break;
  221. case MV64XXX_I2C_ACTION_SEND_ADDR_1:
  222. writel(drv_data->addr1,
  223. drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  224. writel(drv_data->cntl_bits,
  225. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  226. break;
  227. case MV64XXX_I2C_ACTION_SEND_ADDR_2:
  228. writel(drv_data->addr2,
  229. drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  230. writel(drv_data->cntl_bits,
  231. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  232. break;
  233. case MV64XXX_I2C_ACTION_SEND_DATA:
  234. writel(drv_data->msg->buf[drv_data->byte_posn++],
  235. drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  236. writel(drv_data->cntl_bits,
  237. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  238. break;
  239. case MV64XXX_I2C_ACTION_RCV_DATA:
  240. drv_data->msg->buf[drv_data->byte_posn++] =
  241. readl(drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  242. writel(drv_data->cntl_bits,
  243. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  244. break;
  245. case MV64XXX_I2C_ACTION_RCV_DATA_STOP:
  246. drv_data->msg->buf[drv_data->byte_posn++] =
  247. readl(drv_data->reg_base + MV64XXX_I2C_REG_DATA);
  248. drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN;
  249. writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP,
  250. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  251. drv_data->block = 0;
  252. wake_up_interruptible(&drv_data->waitq);
  253. break;
  254. case MV64XXX_I2C_ACTION_INVALID:
  255. default:
  256. dev_err(&drv_data->adapter.dev,
  257. "mv64xxx_i2c_do_action: Invalid action: %d\n",
  258. drv_data->action);
  259. drv_data->rc = -EIO;
  260. /* FALLTHRU */
  261. case MV64XXX_I2C_ACTION_SEND_STOP:
  262. drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN;
  263. writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP,
  264. drv_data->reg_base + MV64XXX_I2C_REG_CONTROL);
  265. drv_data->block = 0;
  266. wake_up_interruptible(&drv_data->waitq);
  267. break;
  268. }
  269. }
  270. static int
  271. mv64xxx_i2c_intr(int irq, void *dev_id)
  272. {
  273. struct mv64xxx_i2c_data *drv_data = dev_id;
  274. unsigned long flags;
  275. u32 status;
  276. int rc = IRQ_NONE;
  277. spin_lock_irqsave(&drv_data->lock, flags);
  278. while (readl(drv_data->reg_base + MV64XXX_I2C_REG_CONTROL) &
  279. MV64XXX_I2C_REG_CONTROL_IFLG) {
  280. status = readl(drv_data->reg_base + MV64XXX_I2C_REG_STATUS);
  281. mv64xxx_i2c_fsm(drv_data, status);
  282. mv64xxx_i2c_do_action(drv_data);
  283. rc = IRQ_HANDLED;
  284. }
  285. spin_unlock_irqrestore(&drv_data->lock, flags);
  286. return rc;
  287. }
  288. /*
  289. *****************************************************************************
  290. *
  291. * I2C Msg Execution Routines
  292. *
  293. *****************************************************************************
  294. */
  295. static void
  296. mv64xxx_i2c_prepare_for_io(struct mv64xxx_i2c_data *drv_data,
  297. struct i2c_msg *msg)
  298. {
  299. u32 dir = 0;
  300. drv_data->msg = msg;
  301. drv_data->byte_posn = 0;
  302. drv_data->bytes_left = msg->len;
  303. drv_data->aborting = 0;
  304. drv_data->rc = 0;
  305. drv_data->cntl_bits = MV64XXX_I2C_REG_CONTROL_ACK |
  306. MV64XXX_I2C_REG_CONTROL_INTEN | MV64XXX_I2C_REG_CONTROL_TWSIEN;
  307. if (msg->flags & I2C_M_RD)
  308. dir = 1;
  309. if (msg->flags & I2C_M_REV_DIR_ADDR)
  310. dir ^= 1;
  311. if (msg->flags & I2C_M_TEN) {
  312. drv_data->addr1 = 0xf0 | (((u32)msg->addr & 0x300) >> 7) | dir;
  313. drv_data->addr2 = (u32)msg->addr & 0xff;
  314. } else {
  315. drv_data->addr1 = ((u32)msg->addr & 0x7f) << 1 | dir;
  316. drv_data->addr2 = 0;
  317. }
  318. }
  319. static void
  320. mv64xxx_i2c_wait_for_completion(struct mv64xxx_i2c_data *drv_data)
  321. {
  322. long time_left;
  323. unsigned long flags;
  324. char abort = 0;
  325. time_left = wait_event_interruptible_timeout(drv_data->waitq,
  326. !drv_data->block, msecs_to_jiffies(drv_data->adapter.timeout));
  327. spin_lock_irqsave(&drv_data->lock, flags);
  328. if (!time_left) { /* Timed out */
  329. drv_data->rc = -ETIMEDOUT;
  330. abort = 1;
  331. } else if (time_left < 0) { /* Interrupted/Error */
  332. drv_data->rc = time_left; /* errno value */
  333. abort = 1;
  334. }
  335. if (abort && drv_data->block) {
  336. drv_data->aborting = 1;
  337. spin_unlock_irqrestore(&drv_data->lock, flags);
  338. time_left = wait_event_timeout(drv_data->waitq,
  339. !drv_data->block,
  340. msecs_to_jiffies(drv_data->adapter.timeout));
  341. if ((time_left <= 0) && drv_data->block) {
  342. drv_data->state = MV64XXX_I2C_STATE_IDLE;
  343. dev_err(&drv_data->adapter.dev,
  344. "mv64xxx: I2C bus locked, block: %d, "
  345. "time_left: %d\n", drv_data->block,
  346. (int)time_left);
  347. mv64xxx_i2c_hw_init(drv_data);
  348. }
  349. } else
  350. spin_unlock_irqrestore(&drv_data->lock, flags);
  351. }
  352. static int
  353. mv64xxx_i2c_execute_msg(struct mv64xxx_i2c_data *drv_data, struct i2c_msg *msg)
  354. {
  355. unsigned long flags;
  356. spin_lock_irqsave(&drv_data->lock, flags);
  357. mv64xxx_i2c_prepare_for_io(drv_data, msg);
  358. if (unlikely(msg->flags & I2C_M_NOSTART)) { /* Skip start/addr phases */
  359. if (drv_data->msg->flags & I2C_M_RD) {
  360. /* No action to do, wait for slave to send a byte */
  361. drv_data->action = MV64XXX_I2C_ACTION_CONTINUE;
  362. drv_data->state =
  363. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA;
  364. } else {
  365. drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA;
  366. drv_data->state =
  367. MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_ACK;
  368. drv_data->bytes_left--;
  369. }
  370. } else {
  371. drv_data->action = MV64XXX_I2C_ACTION_SEND_START;
  372. drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_START_COND;
  373. }
  374. drv_data->block = 1;
  375. mv64xxx_i2c_do_action(drv_data);
  376. spin_unlock_irqrestore(&drv_data->lock, flags);
  377. mv64xxx_i2c_wait_for_completion(drv_data);
  378. return drv_data->rc;
  379. }
  380. /*
  381. *****************************************************************************
  382. *
  383. * I2C Core Support Routines (Interface to higher level I2C code)
  384. *
  385. *****************************************************************************
  386. */
  387. static u32
  388. mv64xxx_i2c_functionality(struct i2c_adapter *adap)
  389. {
  390. return I2C_FUNC_I2C | I2C_FUNC_10BIT_ADDR | I2C_FUNC_SMBUS_EMUL;
  391. }
  392. static int
  393. mv64xxx_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num)
  394. {
  395. struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap);
  396. int i, rc;
  397. for (i=0; i<num; i++)
  398. if ((rc = mv64xxx_i2c_execute_msg(drv_data, &msgs[i])) < 0)
  399. return rc;
  400. return num;
  401. }
  402. static const struct i2c_algorithm mv64xxx_i2c_algo = {
  403. .master_xfer = mv64xxx_i2c_xfer,
  404. .functionality = mv64xxx_i2c_functionality,
  405. };
  406. /*
  407. *****************************************************************************
  408. *
  409. * Driver Interface & Early Init Routines
  410. *
  411. *****************************************************************************
  412. */
  413. static int __devinit
  414. mv64xxx_i2c_map_regs(struct platform_device *pd,
  415. struct mv64xxx_i2c_data *drv_data)
  416. {
  417. int size;
  418. struct resource *r = platform_get_resource(pd, IORESOURCE_MEM, 0);
  419. if (!r)
  420. return -ENODEV;
  421. size = r->end - r->start + 1;
  422. if (!request_mem_region(r->start, size, drv_data->adapter.name))
  423. return -EBUSY;
  424. drv_data->reg_base = ioremap(r->start, size);
  425. drv_data->reg_base_p = r->start;
  426. drv_data->reg_size = size;
  427. return 0;
  428. }
  429. static void __devexit
  430. mv64xxx_i2c_unmap_regs(struct mv64xxx_i2c_data *drv_data)
  431. {
  432. if (drv_data->reg_base) {
  433. iounmap(drv_data->reg_base);
  434. release_mem_region(drv_data->reg_base_p, drv_data->reg_size);
  435. }
  436. drv_data->reg_base = NULL;
  437. drv_data->reg_base_p = 0;
  438. }
  439. static int __devinit
  440. mv64xxx_i2c_probe(struct platform_device *pd)
  441. {
  442. struct mv64xxx_i2c_data *drv_data;
  443. struct mv64xxx_i2c_pdata *pdata = pd->dev.platform_data;
  444. int rc;
  445. if ((pd->id != 0) || !pdata)
  446. return -ENODEV;
  447. drv_data = kzalloc(sizeof(struct mv64xxx_i2c_data), GFP_KERNEL);
  448. if (!drv_data)
  449. return -ENOMEM;
  450. if (mv64xxx_i2c_map_regs(pd, drv_data)) {
  451. rc = -ENODEV;
  452. goto exit_kfree;
  453. }
  454. strlcpy(drv_data->adapter.name, MV64XXX_I2C_CTLR_NAME " adapter",
  455. sizeof(drv_data->adapter.name));
  456. init_waitqueue_head(&drv_data->waitq);
  457. spin_lock_init(&drv_data->lock);
  458. drv_data->freq_m = pdata->freq_m;
  459. drv_data->freq_n = pdata->freq_n;
  460. drv_data->irq = platform_get_irq(pd, 0);
  461. if (drv_data->irq < 0) {
  462. rc = -ENXIO;
  463. goto exit_unmap_regs;
  464. }
  465. drv_data->adapter.dev.parent = &pd->dev;
  466. drv_data->adapter.id = I2C_HW_MV64XXX;
  467. drv_data->adapter.algo = &mv64xxx_i2c_algo;
  468. drv_data->adapter.owner = THIS_MODULE;
  469. drv_data->adapter.class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
  470. drv_data->adapter.timeout = pdata->timeout;
  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");