mirror of
https://github.com/torvalds/linux.git
synced 2024-11-10 22:21:40 +00:00
gpio: 104-dio-48e: Utilize iomap interface
This driver doesn't need to access I/O ports directly via inb()/outb() and friends. This patch abstracts such access by calling ioport_map() to enable the use of more typical ioread8()/iowrite8() I/O memory accessor calls. Suggested-by: David Laight <David.Laight@ACULAB.COM> Signed-off-by: William Breathitt Gray <william.gray@linaro.org> Reviewed-by: Linus Walleij <linus.walleij@linaro.org> Signed-off-by: Bartosz Golaszewski <brgl@bgdev.pl>
This commit is contained in:
parent
cf8f4462e5
commit
e993e23605
@ -49,7 +49,7 @@ struct dio48e_gpio {
|
||||
unsigned char out_state[6];
|
||||
unsigned char control[2];
|
||||
raw_spinlock_t lock;
|
||||
unsigned int base;
|
||||
void __iomem *base;
|
||||
unsigned char irq_mask;
|
||||
};
|
||||
|
||||
@ -70,7 +70,7 @@ static int dio48e_gpio_direction_input(struct gpio_chip *chip, unsigned int offs
|
||||
struct dio48e_gpio *const dio48egpio = gpiochip_get_data(chip);
|
||||
const unsigned int io_port = offset / 8;
|
||||
const unsigned int control_port = io_port / 3;
|
||||
const unsigned int control_addr = dio48egpio->base + 3 + control_port * 4;
|
||||
void __iomem *const control_addr = dio48egpio->base + 3 + control_port * 4;
|
||||
unsigned long flags;
|
||||
unsigned int control;
|
||||
|
||||
@ -95,9 +95,9 @@ static int dio48e_gpio_direction_input(struct gpio_chip *chip, unsigned int offs
|
||||
}
|
||||
|
||||
control = BIT(7) | dio48egpio->control[control_port];
|
||||
outb(control, control_addr);
|
||||
iowrite8(control, control_addr);
|
||||
control &= ~BIT(7);
|
||||
outb(control, control_addr);
|
||||
iowrite8(control, control_addr);
|
||||
|
||||
raw_spin_unlock_irqrestore(&dio48egpio->lock, flags);
|
||||
|
||||
@ -111,7 +111,7 @@ static int dio48e_gpio_direction_output(struct gpio_chip *chip, unsigned int off
|
||||
const unsigned int io_port = offset / 8;
|
||||
const unsigned int control_port = io_port / 3;
|
||||
const unsigned int mask = BIT(offset % 8);
|
||||
const unsigned int control_addr = dio48egpio->base + 3 + control_port * 4;
|
||||
void __iomem *const control_addr = dio48egpio->base + 3 + control_port * 4;
|
||||
const unsigned int out_port = (io_port > 2) ? io_port + 1 : io_port;
|
||||
unsigned long flags;
|
||||
unsigned int control;
|
||||
@ -142,12 +142,12 @@ static int dio48e_gpio_direction_output(struct gpio_chip *chip, unsigned int off
|
||||
dio48egpio->out_state[io_port] &= ~mask;
|
||||
|
||||
control = BIT(7) | dio48egpio->control[control_port];
|
||||
outb(control, control_addr);
|
||||
iowrite8(control, control_addr);
|
||||
|
||||
outb(dio48egpio->out_state[io_port], dio48egpio->base + out_port);
|
||||
iowrite8(dio48egpio->out_state[io_port], dio48egpio->base + out_port);
|
||||
|
||||
control &= ~BIT(7);
|
||||
outb(control, control_addr);
|
||||
iowrite8(control, control_addr);
|
||||
|
||||
raw_spin_unlock_irqrestore(&dio48egpio->lock, flags);
|
||||
|
||||
@ -171,7 +171,7 @@ static int dio48e_gpio_get(struct gpio_chip *chip, unsigned int offset)
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
port_state = inb(dio48egpio->base + in_port);
|
||||
port_state = ioread8(dio48egpio->base + in_port);
|
||||
|
||||
raw_spin_unlock_irqrestore(&dio48egpio->lock, flags);
|
||||
|
||||
@ -186,7 +186,7 @@ static int dio48e_gpio_get_multiple(struct gpio_chip *chip, unsigned long *mask,
|
||||
struct dio48e_gpio *const dio48egpio = gpiochip_get_data(chip);
|
||||
unsigned long offset;
|
||||
unsigned long gpio_mask;
|
||||
unsigned int port_addr;
|
||||
void __iomem *port_addr;
|
||||
unsigned long port_state;
|
||||
|
||||
/* clear bits array to a clean slate */
|
||||
@ -194,7 +194,7 @@ static int dio48e_gpio_get_multiple(struct gpio_chip *chip, unsigned long *mask,
|
||||
|
||||
for_each_set_clump8(offset, gpio_mask, mask, ARRAY_SIZE(ports) * 8) {
|
||||
port_addr = dio48egpio->base + ports[offset / 8];
|
||||
port_state = inb(port_addr) & gpio_mask;
|
||||
port_state = ioread8(port_addr) & gpio_mask;
|
||||
|
||||
bitmap_set_value8(bits, port_state, offset);
|
||||
}
|
||||
@ -217,7 +217,7 @@ static void dio48e_gpio_set(struct gpio_chip *chip, unsigned int offset, int val
|
||||
else
|
||||
dio48egpio->out_state[port] &= ~mask;
|
||||
|
||||
outb(dio48egpio->out_state[port], dio48egpio->base + out_port);
|
||||
iowrite8(dio48egpio->out_state[port], dio48egpio->base + out_port);
|
||||
|
||||
raw_spin_unlock_irqrestore(&dio48egpio->lock, flags);
|
||||
}
|
||||
@ -229,7 +229,7 @@ static void dio48e_gpio_set_multiple(struct gpio_chip *chip,
|
||||
unsigned long offset;
|
||||
unsigned long gpio_mask;
|
||||
size_t index;
|
||||
unsigned int port_addr;
|
||||
void __iomem *port_addr;
|
||||
unsigned long bitmask;
|
||||
unsigned long flags;
|
||||
|
||||
@ -244,7 +244,7 @@ static void dio48e_gpio_set_multiple(struct gpio_chip *chip,
|
||||
/* update output state data and set device gpio register */
|
||||
dio48egpio->out_state[index] &= ~gpio_mask;
|
||||
dio48egpio->out_state[index] |= bitmask;
|
||||
outb(dio48egpio->out_state[index], port_addr);
|
||||
iowrite8(dio48egpio->out_state[index], port_addr);
|
||||
|
||||
raw_spin_unlock_irqrestore(&dio48egpio->lock, flags);
|
||||
}
|
||||
@ -274,7 +274,7 @@ static void dio48e_irq_mask(struct irq_data *data)
|
||||
|
||||
if (!dio48egpio->irq_mask)
|
||||
/* disable interrupts */
|
||||
inb(dio48egpio->base + 0xB);
|
||||
ioread8(dio48egpio->base + 0xB);
|
||||
|
||||
raw_spin_unlock_irqrestore(&dio48egpio->lock, flags);
|
||||
}
|
||||
@ -294,8 +294,8 @@ static void dio48e_irq_unmask(struct irq_data *data)
|
||||
|
||||
if (!dio48egpio->irq_mask) {
|
||||
/* enable interrupts */
|
||||
outb(0x00, dio48egpio->base + 0xF);
|
||||
outb(0x00, dio48egpio->base + 0xB);
|
||||
iowrite8(0x00, dio48egpio->base + 0xF);
|
||||
iowrite8(0x00, dio48egpio->base + 0xB);
|
||||
}
|
||||
|
||||
if (offset == 19)
|
||||
@ -341,7 +341,7 @@ static irqreturn_t dio48e_irq_handler(int irq, void *dev_id)
|
||||
|
||||
raw_spin_lock(&dio48egpio->lock);
|
||||
|
||||
outb(0x00, dio48egpio->base + 0xF);
|
||||
iowrite8(0x00, dio48egpio->base + 0xF);
|
||||
|
||||
raw_spin_unlock(&dio48egpio->lock);
|
||||
|
||||
@ -373,7 +373,7 @@ static int dio48e_irq_init_hw(struct gpio_chip *gc)
|
||||
struct dio48e_gpio *const dio48egpio = gpiochip_get_data(gc);
|
||||
|
||||
/* Disable IRQ by default */
|
||||
inb(dio48egpio->base + 0xB);
|
||||
ioread8(dio48egpio->base + 0xB);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -395,6 +395,10 @@ static int dio48e_probe(struct device *dev, unsigned int id)
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
dio48egpio->base = devm_ioport_map(dev, base[id], DIO48E_EXTENT);
|
||||
if (!dio48egpio->base)
|
||||
return -ENOMEM;
|
||||
|
||||
dio48egpio->chip.label = name;
|
||||
dio48egpio->chip.parent = dev;
|
||||
dio48egpio->chip.owner = THIS_MODULE;
|
||||
@ -408,7 +412,6 @@ static int dio48e_probe(struct device *dev, unsigned int id)
|
||||
dio48egpio->chip.get_multiple = dio48e_gpio_get_multiple;
|
||||
dio48egpio->chip.set = dio48e_gpio_set;
|
||||
dio48egpio->chip.set_multiple = dio48e_gpio_set_multiple;
|
||||
dio48egpio->base = base[id];
|
||||
|
||||
girq = &dio48egpio->chip.irq;
|
||||
girq->chip = &dio48e_irqchip;
|
||||
@ -423,16 +426,16 @@ static int dio48e_probe(struct device *dev, unsigned int id)
|
||||
raw_spin_lock_init(&dio48egpio->lock);
|
||||
|
||||
/* initialize all GPIO as output */
|
||||
outb(0x80, base[id] + 3);
|
||||
outb(0x00, base[id]);
|
||||
outb(0x00, base[id] + 1);
|
||||
outb(0x00, base[id] + 2);
|
||||
outb(0x00, base[id] + 3);
|
||||
outb(0x80, base[id] + 7);
|
||||
outb(0x00, base[id] + 4);
|
||||
outb(0x00, base[id] + 5);
|
||||
outb(0x00, base[id] + 6);
|
||||
outb(0x00, base[id] + 7);
|
||||
iowrite8(0x80, dio48egpio->base + 3);
|
||||
iowrite8(0x00, dio48egpio->base);
|
||||
iowrite8(0x00, dio48egpio->base + 1);
|
||||
iowrite8(0x00, dio48egpio->base + 2);
|
||||
iowrite8(0x00, dio48egpio->base + 3);
|
||||
iowrite8(0x80, dio48egpio->base + 7);
|
||||
iowrite8(0x00, dio48egpio->base + 4);
|
||||
iowrite8(0x00, dio48egpio->base + 5);
|
||||
iowrite8(0x00, dio48egpio->base + 6);
|
||||
iowrite8(0x00, dio48egpio->base + 7);
|
||||
|
||||
err = devm_gpiochip_add_data(dev, &dio48egpio->chip, dio48egpio);
|
||||
if (err) {
|
||||
|
Loading…
Reference in New Issue
Block a user