i2c-mv64xxx.c 16 KB

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