ARM: OMAP: Convert IO macros
authorDirk Behme <dirk.behme@gmail.com>
Mon, 10 Nov 2008 19:15:25 +0000 (20:15 +0100)
committerJean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
Fri, 21 Nov 2008 00:44:35 +0000 (01:44 +0100)
Convert IO macros to readx/writex.

Signed-off-by: Dirk Behme <dirk.behme@gmail.com>
drivers/i2c/omap24xx_i2c.c

index d2e8207c5296d6be94b49ed573bddeb0157066ac..4427938ff3cd078030555082a43e98732ff00bfe 100644 (file)
@@ -25,9 +25,6 @@
 #include <asm/arch/i2c.h>
 #include <asm/io.h>
 
-#define inw(a) __raw_readw(a)
-#define outw(a,v) __raw_writew(a,v)
-
 static void wait_for_bb (void);
 static u16 wait_for_pin (void);
 static void flush_fifo(void);
@@ -36,32 +33,32 @@ void i2c_init (int speed, int slaveadd)
 {
        u16 scl;
 
-       outw(0x2, I2C_SYSC); /* for ES2 after soft reset */
+       writew(0x2, I2C_SYSC); /* for ES2 after soft reset */
        udelay(1000);
-       outw(0x0, I2C_SYSC); /* will probably self clear but */
+       writew(0x0, I2C_SYSC); /* will probably self clear but */
 
-       if (inw (I2C_CON) & I2C_CON_EN) {
-               outw (0, I2C_CON);
+       if (readw (I2C_CON) & I2C_CON_EN) {
+               writew (0, I2C_CON);
                udelay (50000);
        }
 
        /* 12MHz I2C module clock */
-       outw (0, I2C_PSC);
+       writew (0, I2C_PSC);
        speed = speed/1000;                 /* 100 or 400 */
        scl = ((12000/(speed*2)) - 7);  /* use 7 when PSC = 0 */
-       outw (scl, I2C_SCLL);
-       outw (scl, I2C_SCLH);
+       writew (scl, I2C_SCLL);
+       writew (scl, I2C_SCLH);
        /* own address */
-       outw (slaveadd, I2C_OA);
-       outw (I2C_CON_EN, I2C_CON);
+       writew (slaveadd, I2C_OA);
+       writew (I2C_CON_EN, I2C_CON);
 
        /* have to enable intrrupts or OMAP i2c module doesn't work */
-       outw (I2C_IE_XRDY_IE | I2C_IE_RRDY_IE | I2C_IE_ARDY_IE |
-             I2C_IE_NACK_IE | I2C_IE_AL_IE, I2C_IE);
+       writew (I2C_IE_XRDY_IE | I2C_IE_RRDY_IE | I2C_IE_ARDY_IE |
+               I2C_IE_NACK_IE | I2C_IE_AL_IE, I2C_IE);
        udelay (1000);
        flush_fifo();
-       outw (0xFFFF, I2C_STAT);
-       outw (0, I2C_CNT);
+       writew (0xFFFF, I2C_STAT);
+       writew (0, I2C_CNT);
 }
 
 static int i2c_read_byte (u8 devaddr, u8 regoffset, u8 * value)
@@ -73,19 +70,19 @@ static int i2c_read_byte (u8 devaddr, u8 regoffset, u8 * value)
        wait_for_bb ();
 
        /* one byte only */
-       outw (1, I2C_CNT);
+       writew (1, I2C_CNT);
        /* set slave address */
-       outw (devaddr, I2C_SA);
+       writew (devaddr, I2C_SA);
        /* no stop bit needed here */
-       outw (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_TRX, I2C_CON);
+       writew (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_TRX, I2C_CON);
 
        status = wait_for_pin ();
 
        if (status & I2C_STAT_XRDY) {
                /* Important: have to use byte access */
-               *(volatile u8 *) (I2C_DATA) = regoffset;
+               writeb (regoffset, I2C_DATA);
                udelay (20000);
-               if (inw (I2C_STAT) & I2C_STAT_NACK) {
+               if (readw (I2C_STAT) & I2C_STAT_NACK) {
                        i2c_error = 1;
                }
        } else {
@@ -94,42 +91,42 @@ static int i2c_read_byte (u8 devaddr, u8 regoffset, u8 * value)
 
        if (!i2c_error) {
                /* free bus, otherwise we can't use a combined transction */
-               outw (0, I2C_CON);
-               while (inw (I2C_STAT) || (inw (I2C_CON) & I2C_CON_MST)) {
+               writew (0, I2C_CON);
+               while (readw (I2C_STAT) || (readw (I2C_CON) & I2C_CON_MST)) {
                        udelay (10000);
                        /* Have to clear pending interrupt to clear I2C_STAT */
-                       outw (0xFFFF, I2C_STAT);
+                       writew (0xFFFF, I2C_STAT);
                }
 
                wait_for_bb ();
                /* set slave address */
-               outw (devaddr, I2C_SA);
+               writew (devaddr, I2C_SA);
                /* read one byte from slave */
-               outw (1, I2C_CNT);
+               writew (1, I2C_CNT);
                /* need stop bit here */
-               outw (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_STP,
-                     I2C_CON);
+               writew (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_STP,
+                       I2C_CON);
 
                status = wait_for_pin ();
                if (status & I2C_STAT_RRDY) {
-                       *value = inw (I2C_DATA);
+                       *value = readw (I2C_DATA);
                        udelay (20000);
                } else {
                        i2c_error = 1;
                }
 
                if (!i2c_error) {
-                       outw (I2C_CON_EN, I2C_CON);
-                       while (inw (I2C_STAT)
-                              || (inw (I2C_CON) & I2C_CON_MST)) {
+                       writew (I2C_CON_EN, I2C_CON);
+                       while (readw (I2C_STAT)
+                              || (readw (I2C_CON) & I2C_CON_MST)) {
                                udelay (10000);
-                               outw (0xFFFF, I2C_STAT);
+                               writew (0xFFFF, I2C_STAT);
                        }
                }
        }
        flush_fifo();
-       outw (0xFFFF, I2C_STAT);
-       outw (0, I2C_CNT);
+       writew (0xFFFF, I2C_STAT);
+       writew (0, I2C_CNT);
        return i2c_error;
 }
 
@@ -142,22 +139,22 @@ static int i2c_write_byte (u8 devaddr, u8 regoffset, u8 value)
        wait_for_bb ();
 
        /* two bytes */
-       outw (2, I2C_CNT);
+       writew (2, I2C_CNT);
        /* set slave address */
-       outw (devaddr, I2C_SA);
+       writew (devaddr, I2C_SA);
        /* stop bit needed here */
-       outw (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_TRX |
-             I2C_CON_STP, I2C_CON);
+       writew (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_TRX |
+               I2C_CON_STP, I2C_CON);
 
        /* wait until state change */
        status = wait_for_pin ();
 
        if (status & I2C_STAT_XRDY) {
                /* send out two bytes */
-               outw ((value << 8) + regoffset, I2C_DATA);
+               writew ((value << 8) + regoffset, I2C_DATA);
                /* must have enough delay to allow BB bit to go low */
                udelay (50000);
-               if (inw (I2C_STAT) & I2C_STAT_NACK) {
+               if (readw (I2C_STAT) & I2C_STAT_NACK) {
                        i2c_error = 1;
                }
        } else {
@@ -167,18 +164,18 @@ static int i2c_write_byte (u8 devaddr, u8 regoffset, u8 value)
        if (!i2c_error) {
                int eout = 200;
 
-               outw (I2C_CON_EN, I2C_CON);
-               while ((stat = inw (I2C_STAT)) || (inw (I2C_CON) & I2C_CON_MST)) {
+               writew (I2C_CON_EN, I2C_CON);
+               while ((stat = readw (I2C_STAT)) || (readw (I2C_CON) & I2C_CON_MST)) {
                        udelay (1000);
                        /* have to read to clear intrrupt */
-                       outw (0xFFFF, I2C_STAT);
+                       writew (0xFFFF, I2C_STAT);
                        if(--eout == 0) /* better leave with error than hang */
                                break;
                }
        }
        flush_fifo();
-       outw (0xFFFF, I2C_STAT);
-       outw (0, I2C_CNT);
+       writew (0xFFFF, I2C_STAT);
+       writew (0, I2C_CNT);
        return i2c_error;
 }
 
@@ -189,10 +186,10 @@ static void flush_fifo(void)
         * you get a bus error
         */
        while(1){
-               stat = inw(I2C_STAT);
+               stat = readw(I2C_STAT);
                if(stat == I2C_STAT_RRDY){
-                       inw(I2C_DATA);
-                       outw(I2C_STAT_RRDY,I2C_STAT);
+                       readw(I2C_DATA);
+                       writew(I2C_STAT_RRDY,I2C_STAT);
                        udelay(1000);
                }else
                        break;
@@ -203,7 +200,7 @@ int i2c_probe (uchar chip)
 {
        int res = 1; /* default = fail */
 
-       if (chip == inw (I2C_OA)) {
+       if (chip == readw (I2C_OA)) {
                return res;
        }
 
@@ -211,27 +208,27 @@ int i2c_probe (uchar chip)
        wait_for_bb ();
 
        /* try to read one byte */
-       outw (1, I2C_CNT);
+       writew (1, I2C_CNT);
        /* set slave address */
-       outw (chip, I2C_SA);
+       writew (chip, I2C_SA);
        /* stop bit needed here */
-       outw (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_STP, I2C_CON);
+       writew (I2C_CON_EN | I2C_CON_MST | I2C_CON_STT | I2C_CON_STP, I2C_CON);
        /* enough delay for the NACK bit set */
        udelay (50000);
 
-       if (!(inw (I2C_STAT) & I2C_STAT_NACK)) {
+       if (!(readw (I2C_STAT) & I2C_STAT_NACK)) {
                res = 0;      /* success case */
                flush_fifo();
-               outw(0xFFFF, I2C_STAT);
+               writew(0xFFFF, I2C_STAT);
        } else {
-               outw(0xFFFF, I2C_STAT);  /* failue, clear sources*/
-               outw (inw (I2C_CON) | I2C_CON_STP, I2C_CON); /* finish up xfer */
+               writew(0xFFFF, I2C_STAT);        /* failue, clear sources*/
+               writew (readw (I2C_CON) | I2C_CON_STP, I2C_CON); /* finish up xfer */
                udelay(20000);
                wait_for_bb ();
        }
        flush_fifo();
-       outw (0, I2C_CNT); /* don't allow any more data in...we don't want it.*/
-       outw(0xFFFF, I2C_STAT);
+       writew (0, I2C_CNT); /* don't allow any more data in...we don't want it.*/
+       writew(0xFFFF, I2C_STAT);
        return res;
 }
 
@@ -290,17 +287,17 @@ static void wait_for_bb (void)
        int timeout = 10;
        u16 stat;
 
-       outw(0xFFFF, I2C_STAT);  /* clear current interruts...*/
-       while ((stat = inw (I2C_STAT) & I2C_STAT_BB) && timeout--) {
-               outw (stat, I2C_STAT);
+       writew(0xFFFF, I2C_STAT);        /* clear current interruts...*/
+       while ((stat = readw (I2C_STAT) & I2C_STAT_BB) && timeout--) {
+               writew (stat, I2C_STAT);
                udelay (50000);
        }
 
        if (timeout <= 0) {
                printf ("timed out in wait_for_bb: I2C_STAT=%x\n",
-                       inw (I2C_STAT));
+                       readw (I2C_STAT));
        }
-       outw(0xFFFF, I2C_STAT);  /* clear delayed stuff*/
+       writew(0xFFFF, I2C_STAT);        /* clear delayed stuff*/
 }
 
 static u16 wait_for_pin (void)
@@ -310,7 +307,7 @@ static u16 wait_for_pin (void)
 
        do {
                udelay (1000);
-               status = inw (I2C_STAT);
+               status = readw (I2C_STAT);
        } while (  !(status &
                   (I2C_STAT_ROVR | I2C_STAT_XUDF | I2C_STAT_XRDY |
                    I2C_STAT_RRDY | I2C_STAT_ARDY | I2C_STAT_NACK |
@@ -318,8 +315,8 @@ static u16 wait_for_pin (void)
 
        if (timeout <= 0) {
                printf ("timed out in wait_for_pin: I2C_STAT=%x\n",
-                       inw (I2C_STAT));
-                       outw(0xFFFF, I2C_STAT);
+                       readw (I2C_STAT));
+                       writew(0xFFFF, I2C_STAT);
 }
        return status;
 }