[S390] __syscall_return error check.
[linux-2.6/libata-dev.git] / drivers / i2c / busses / i2c-mpc.c
blob2721e4c8184a9a64f505686ebf7bf6e1e80ecf59
1 /*
2 * (C) Copyright 2003-2004
3 * Humboldt Solutions Ltd, adrian@humboldt.co.uk.
5 * This is a combined i2c adapter and algorithm driver for the
6 * MPC107/Tsi107 PowerPC northbridge and processors that include
7 * the same I2C unit (8240, 8245, 85xx).
9 * Release 0.8
11 * This file is licensed under the terms of the GNU General Public
12 * License version 2. This program is licensed "as is" without any
13 * warranty of any kind, whether express or implied.
16 #include <linux/config.h>
17 #include <linux/kernel.h>
18 #include <linux/module.h>
19 #include <linux/sched.h>
20 #include <linux/init.h>
21 #include <linux/pci.h>
22 #include <linux/platform_device.h>
24 #include <asm/io.h>
25 #include <linux/fsl_devices.h>
26 #include <linux/i2c.h>
27 #include <linux/interrupt.h>
28 #include <linux/delay.h>
30 #define MPC_I2C_ADDR 0x00
31 #define MPC_I2C_FDR 0x04
32 #define MPC_I2C_CR 0x08
33 #define MPC_I2C_SR 0x0c
34 #define MPC_I2C_DR 0x10
35 #define MPC_I2C_DFSRR 0x14
36 #define MPC_I2C_REGION 0x20
38 #define CCR_MEN 0x80
39 #define CCR_MIEN 0x40
40 #define CCR_MSTA 0x20
41 #define CCR_MTX 0x10
42 #define CCR_TXAK 0x08
43 #define CCR_RSTA 0x04
45 #define CSR_MCF 0x80
46 #define CSR_MAAS 0x40
47 #define CSR_MBB 0x20
48 #define CSR_MAL 0x10
49 #define CSR_SRW 0x04
50 #define CSR_MIF 0x02
51 #define CSR_RXAK 0x01
53 struct mpc_i2c {
54 void __iomem *base;
55 u32 interrupt;
56 wait_queue_head_t queue;
57 struct i2c_adapter adap;
58 int irq;
59 u32 flags;
62 static __inline__ void writeccr(struct mpc_i2c *i2c, u32 x)
64 writeb(x, i2c->base + MPC_I2C_CR);
67 static irqreturn_t mpc_i2c_isr(int irq, void *dev_id, struct pt_regs *regs)
69 struct mpc_i2c *i2c = dev_id;
70 if (readb(i2c->base + MPC_I2C_SR) & CSR_MIF) {
71 /* Read again to allow register to stabilise */
72 i2c->interrupt = readb(i2c->base + MPC_I2C_SR);
73 writeb(0, i2c->base + MPC_I2C_SR);
74 wake_up_interruptible(&i2c->queue);
76 return IRQ_HANDLED;
79 static int i2c_wait(struct mpc_i2c *i2c, unsigned timeout, int writing)
81 unsigned long orig_jiffies = jiffies;
82 u32 x;
83 int result = 0;
85 if (i2c->irq == 0)
87 while (!(readb(i2c->base + MPC_I2C_SR) & CSR_MIF)) {
88 schedule();
89 if (time_after(jiffies, orig_jiffies + timeout)) {
90 pr_debug("I2C: timeout\n");
91 result = -EIO;
92 break;
95 x = readb(i2c->base + MPC_I2C_SR);
96 writeb(0, i2c->base + MPC_I2C_SR);
97 } else {
98 /* Interrupt mode */
99 result = wait_event_interruptible_timeout(i2c->queue,
100 (i2c->interrupt & CSR_MIF), timeout * HZ);
102 if (unlikely(result < 0))
103 pr_debug("I2C: wait interrupted\n");
104 else if (unlikely(!(i2c->interrupt & CSR_MIF))) {
105 pr_debug("I2C: wait timeout\n");
106 result = -ETIMEDOUT;
109 x = i2c->interrupt;
110 i2c->interrupt = 0;
113 if (result < 0)
114 return result;
116 if (!(x & CSR_MCF)) {
117 pr_debug("I2C: unfinished\n");
118 return -EIO;
121 if (x & CSR_MAL) {
122 pr_debug("I2C: MAL\n");
123 return -EIO;
126 if (writing && (x & CSR_RXAK)) {
127 pr_debug("I2C: No RXAK\n");
128 /* generate stop */
129 writeccr(i2c, CCR_MEN);
130 return -EIO;
132 return 0;
135 static void mpc_i2c_setclock(struct mpc_i2c *i2c)
137 /* Set clock and filters */
138 if (i2c->flags & FSL_I2C_DEV_SEPARATE_DFSRR) {
139 writeb(0x31, i2c->base + MPC_I2C_FDR);
140 writeb(0x10, i2c->base + MPC_I2C_DFSRR);
141 } else if (i2c->flags & FSL_I2C_DEV_CLOCK_5200)
142 writeb(0x3f, i2c->base + MPC_I2C_FDR);
143 else
144 writel(0x1031, i2c->base + MPC_I2C_FDR);
147 static void mpc_i2c_start(struct mpc_i2c *i2c)
149 /* Clear arbitration */
150 writeb(0, i2c->base + MPC_I2C_SR);
151 /* Start with MEN */
152 writeccr(i2c, CCR_MEN);
155 static void mpc_i2c_stop(struct mpc_i2c *i2c)
157 writeccr(i2c, CCR_MEN);
160 static int mpc_write(struct mpc_i2c *i2c, int target,
161 const u8 * data, int length, int restart)
163 int i;
164 unsigned timeout = i2c->adap.timeout;
165 u32 flags = restart ? CCR_RSTA : 0;
167 /* Start with MEN */
168 if (!restart)
169 writeccr(i2c, CCR_MEN);
170 /* Start as master */
171 writeccr(i2c, CCR_MIEN | CCR_MEN | CCR_MSTA | CCR_MTX | flags);
172 /* Write target byte */
173 writeb((target << 1), i2c->base + MPC_I2C_DR);
175 if (i2c_wait(i2c, timeout, 1) < 0)
176 return -1;
178 for (i = 0; i < length; i++) {
179 /* Write data byte */
180 writeb(data[i], i2c->base + MPC_I2C_DR);
182 if (i2c_wait(i2c, timeout, 1) < 0)
183 return -1;
186 return 0;
189 static int mpc_read(struct mpc_i2c *i2c, int target,
190 u8 * data, int length, int restart)
192 unsigned timeout = i2c->adap.timeout;
193 int i;
194 u32 flags = restart ? CCR_RSTA : 0;
196 /* Start with MEN */
197 if (!restart)
198 writeccr(i2c, CCR_MEN);
199 /* Switch to read - restart */
200 writeccr(i2c, CCR_MIEN | CCR_MEN | CCR_MSTA | CCR_MTX | flags);
201 /* Write target address byte - this time with the read flag set */
202 writeb((target << 1) | 1, i2c->base + MPC_I2C_DR);
204 if (i2c_wait(i2c, timeout, 1) < 0)
205 return -1;
207 if (length) {
208 if (length == 1)
209 writeccr(i2c, CCR_MIEN | CCR_MEN | CCR_MSTA | CCR_TXAK);
210 else
211 writeccr(i2c, CCR_MIEN | CCR_MEN | CCR_MSTA);
212 /* Dummy read */
213 readb(i2c->base + MPC_I2C_DR);
216 for (i = 0; i < length; i++) {
217 if (i2c_wait(i2c, timeout, 0) < 0)
218 return -1;
220 /* Generate txack on next to last byte */
221 if (i == length - 2)
222 writeccr(i2c, CCR_MIEN | CCR_MEN | CCR_MSTA | CCR_TXAK);
223 /* Generate stop on last byte */
224 if (i == length - 1)
225 writeccr(i2c, CCR_MIEN | CCR_MEN | CCR_TXAK);
226 data[i] = readb(i2c->base + MPC_I2C_DR);
229 return length;
232 static int mpc_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
234 struct i2c_msg *pmsg;
235 int i;
236 int ret = 0;
237 unsigned long orig_jiffies = jiffies;
238 struct mpc_i2c *i2c = i2c_get_adapdata(adap);
240 mpc_i2c_start(i2c);
242 /* Allow bus up to 1s to become not busy */
243 while (readb(i2c->base + MPC_I2C_SR) & CSR_MBB) {
244 if (signal_pending(current)) {
245 pr_debug("I2C: Interrupted\n");
246 return -EINTR;
248 if (time_after(jiffies, orig_jiffies + HZ)) {
249 pr_debug("I2C: timeout\n");
250 return -EIO;
252 schedule();
255 for (i = 0; ret >= 0 && i < num; i++) {
256 pmsg = &msgs[i];
257 pr_debug("Doing %s %d bytes to 0x%02x - %d of %d messages\n",
258 pmsg->flags & I2C_M_RD ? "read" : "write",
259 pmsg->len, pmsg->addr, i + 1, num);
260 if (pmsg->flags & I2C_M_RD)
261 ret =
262 mpc_read(i2c, pmsg->addr, pmsg->buf, pmsg->len, i);
263 else
264 ret =
265 mpc_write(i2c, pmsg->addr, pmsg->buf, pmsg->len, i);
267 mpc_i2c_stop(i2c);
268 return (ret < 0) ? ret : num;
271 static u32 mpc_functionality(struct i2c_adapter *adap)
273 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
276 static struct i2c_algorithm mpc_algo = {
277 .master_xfer = mpc_xfer,
278 .functionality = mpc_functionality,
281 static struct i2c_adapter mpc_ops = {
282 .owner = THIS_MODULE,
283 .name = "MPC adapter",
284 .id = I2C_HW_MPC107,
285 .algo = &mpc_algo,
286 .class = I2C_CLASS_HWMON,
287 .timeout = 1,
288 .retries = 1
291 static int fsl_i2c_probe(struct platform_device *pdev)
293 int result = 0;
294 struct mpc_i2c *i2c;
295 struct fsl_i2c_platform_data *pdata;
296 struct resource *r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
298 pdata = (struct fsl_i2c_platform_data *) pdev->dev.platform_data;
300 if (!(i2c = kzalloc(sizeof(*i2c), GFP_KERNEL))) {
301 return -ENOMEM;
304 i2c->irq = platform_get_irq(pdev, 0);
305 if (i2c->irq < 0) {
306 result = -ENXIO;
307 goto fail_get_irq;
309 i2c->flags = pdata->device_flags;
310 init_waitqueue_head(&i2c->queue);
312 i2c->base = ioremap((phys_addr_t)r->start, MPC_I2C_REGION);
314 if (!i2c->base) {
315 printk(KERN_ERR "i2c-mpc - failed to map controller\n");
316 result = -ENOMEM;
317 goto fail_map;
320 if (i2c->irq != 0)
321 if ((result = request_irq(i2c->irq, mpc_i2c_isr,
322 SA_SHIRQ, "i2c-mpc", i2c)) < 0) {
323 printk(KERN_ERR
324 "i2c-mpc - failed to attach interrupt\n");
325 goto fail_irq;
328 mpc_i2c_setclock(i2c);
329 platform_set_drvdata(pdev, i2c);
331 i2c->adap = mpc_ops;
332 i2c_set_adapdata(&i2c->adap, i2c);
333 i2c->adap.dev.parent = &pdev->dev;
334 if ((result = i2c_add_adapter(&i2c->adap)) < 0) {
335 printk(KERN_ERR "i2c-mpc - failed to add adapter\n");
336 goto fail_add;
339 return result;
341 fail_add:
342 if (i2c->irq != 0)
343 free_irq(i2c->irq, NULL);
344 fail_irq:
345 iounmap(i2c->base);
346 fail_map:
347 fail_get_irq:
348 kfree(i2c);
349 return result;
352 static int fsl_i2c_remove(struct platform_device *pdev)
354 struct mpc_i2c *i2c = platform_get_drvdata(pdev);
356 i2c_del_adapter(&i2c->adap);
357 platform_set_drvdata(pdev, NULL);
359 if (i2c->irq != 0)
360 free_irq(i2c->irq, i2c);
362 iounmap(i2c->base);
363 kfree(i2c);
364 return 0;
367 /* Structure for a device driver */
368 static struct platform_driver fsl_i2c_driver = {
369 .probe = fsl_i2c_probe,
370 .remove = fsl_i2c_remove,
371 .driver = {
372 .owner = THIS_MODULE,
373 .name = "fsl-i2c",
377 static int __init fsl_i2c_init(void)
379 return platform_driver_register(&fsl_i2c_driver);
382 static void __exit fsl_i2c_exit(void)
384 platform_driver_unregister(&fsl_i2c_driver);
387 module_init(fsl_i2c_init);
388 module_exit(fsl_i2c_exit);
390 MODULE_AUTHOR("Adrian Cox <adrian@humboldt.co.uk>");
391 MODULE_DESCRIPTION
392 ("I2C-Bus adapter for MPC107 bridge and MPC824x/85xx/52xx processors");
393 MODULE_LICENSE("GPL");