fix madwifi mode setting

[openwrt.git] / target / linux / rb532 / files / drivers / block / rb500 / ata.c

diff --git a/target/linux/rb532/files/drivers/block/rb500/ata.c b/target/linux/rb532/files/drivers/block/rb500/ata.c
index fc5f97b..31e6782 100644 (file)
--- a/target/linux/rb532/files/drivers/block/rb500/ata.c
+++ b/target/linux/rb532/files/drivers/block/rb500/ata.c
@@ -15,6 +15,8 @@
 #include <linux/sched.h>
 #include <linux/pci.h>
 #include <linux/ioport.h>      /* request_mem_region() */
 #include <linux/sched.h>
 #include <linux/pci.h>
 #include <linux/ioport.h>      /* request_mem_region() */

+
+#include <asm/gpio.h>

 #include <asm/unaligned.h>             /* ioremap() */
 #include <asm/io.h>            /* ioremap() */
 #include <asm/rc32434/rb.h>
 #include <asm/unaligned.h>             /* ioremap() */
 #include <asm/io.h>            /* ioremap() */
 #include <asm/rc32434/rb.h>


@@ -55,25 +57,15 @@ static inline u8 rareg(unsigned reg, struct cf_mips_dev* dev)
        return readb(dev->baddr + ATA_REG_OFFSET + reg);
 }
 
        return readb(dev->baddr + ATA_REG_OFFSET + reg);
 }
 

-static inline int get_gpio_bit(gpio_func ofs, struct cf_mips_dev *dev)
-{
-       return (gpio_get(ofs) >> dev->pin) & 1;
-}
-
-static inline void set_gpio_bit(int bit, gpio_func ofs, struct cf_mips_dev *dev)
-{
-       gpio_set(ofs, (1 << dev->pin), ((bit & 1) << dev->pin));
-}
-

 static inline int cfrdy(struct cf_mips_dev *dev)
 {
 static inline int cfrdy(struct cf_mips_dev *dev)
 {

-       return get_gpio_bit(DATA, dev);
+       return gpio_get_value(dev->pin);

 }
 
 static inline void prepare_cf_irq(struct cf_mips_dev *dev)
 {
 }
 
 static inline void prepare_cf_irq(struct cf_mips_dev *dev)
 {

-       set_gpio_bit(1, ILEVEL, dev);   /* interrupt on cf ready (not busy) */
-       set_gpio_bit(0, ISTAT, dev);    /* clear interrupt status */
+       rb500_gpio_set_int_level(1, dev->pin);  /* interrupt on cf ready (not busy) */
+       rb500_gpio_set_int_status(0, dev->pin);         /* clear interrupt status */

 }
 
 static inline int cf_present(struct cf_mips_dev* dev)
 }
 
 static inline int cf_present(struct cf_mips_dev* dev)


@@ -85,8 +77,8 @@ static inline int cf_present(struct cf_mips_dev* dev)
        int i;
 
        /* setup CFRDY GPIO as input */
        int i;
 
        /* setup CFRDY GPIO as input */

-       set_gpio_bit(0, FUNC, dev);
-       set_gpio_bit(0, CFG, dev);
+       rb500_gpio_set_func(dev->pin, 0);
+       gpio_direction_input(dev->pin);

 
        for (i = 0; i < 0x10; ++i) {
                if (rareg(i,dev) != 0xff)
 
        for (i = 0; i < 0x10; ++i) {
                if (rareg(i,dev) != 0xff)


@@ -151,9 +143,9 @@ static irqreturn_t cf_irq_handler(int irq, void *dev_id)
         * To avoid this, we change ILEVEL to 0.
         */
        struct cf_mips_dev *dev=dev_id;
         * To avoid this, we change ILEVEL to 0.
         */
        struct cf_mips_dev *dev=dev_id;

-       
-       set_gpio_bit(0, ILEVEL, dev);
-       set_gpio_bit(0, ISTAT, dev);
+
+       rb500_gpio_set_int_level(0, dev->pin);
+       rb500_gpio_set_int_status(0, dev->pin);

        
        del_timer(&dev->to_timer);
        tasklet_schedule(&dev->tasklet);
        
        del_timer(&dev->to_timer);
        tasklet_schedule(&dev->tasklet);


@@ -366,6 +358,8 @@ static int do_identify(struct cf_mips_dev *dev)
        u16 sbuf[CF_SECT_SIZE >> 1];
        int res;
        char tstr[17]; //serial
        u16 sbuf[CF_SECT_SIZE >> 1];
        int res;
        char tstr[17]; //serial

+       char tmp;
+       int i;

        BUG_ON(dev->tstate!=TS_IDLE);
        dev->tbuf = (char *) sbuf;
        dev->tbuf_size = CF_SECT_SIZE;
        BUG_ON(dev->tstate!=TS_IDLE);
        dev->tbuf = (char *) sbuf;
        dev->tbuf_size = CF_SECT_SIZE;


@@ -389,11 +383,19 @@ static int do_identify(struct cf_mips_dev *dev)
        dev->spt = sbuf[6];
        dev->sectors = ((unsigned long) sbuf[7] << 16) | sbuf[8];
        dev->dtype=sbuf[0];
        dev->spt = sbuf[6];
        dev->sectors = ((unsigned long) sbuf[7] << 16) | sbuf[8];
        dev->dtype=sbuf[0];

-       memcpy(tstr,&sbuf[12],16);
-       tstr[16]=0;
+       memcpy(tstr, &sbuf[12], 16);
+       tstr[16] = '\0';
+
+       /* Byte-swap the serial number */
+       for (i = 0; i<8; i++) {
+               tmp = tstr[i * 2];
+               tstr[i * 2] = tstr[i * 2 +1];
+               tstr[i * 2 + 1] = tmp;
+       }
+

        printk(KERN_INFO "cf-mips: %s detected, C/H/S=%d/%d/%d sectors=%u (%uMB) Serial=%s\n",
               (sbuf[0] == 0x848A ? "CF card" : "ATA drive"), dev->cyl, dev->head,
        printk(KERN_INFO "cf-mips: %s detected, C/H/S=%d/%d/%d sectors=%u (%uMB) Serial=%s\n",
               (sbuf[0] == 0x848A ? "CF card" : "ATA drive"), dev->cyl, dev->head,

-              dev->spt, dev->sectors, dev->sectors >> 11,tstr);
+              dev->spt, dev->sectors, dev->sectors >> 11, tstr);

        return 1;
 }
 
        return 1;
 }