|
@@ -62,6 +62,11 @@ struct vf610_gpio_port {
|
|
|
|
|
|
static struct irq_chip vf610_gpio_irq_chip;
|
|
|
|
|
|
+static struct vf610_gpio_port *to_vf610_gp(struct gpio_chip *gc)
|
|
|
+{
|
|
|
+ return container_of(gc, struct vf610_gpio_port, gc);
|
|
|
+}
|
|
|
+
|
|
|
static const struct of_device_id vf610_gpio_dt_ids[] = {
|
|
|
{ .compatible = "fsl,vf610-gpio" },
|
|
|
{ /* sentinel */ }
|
|
@@ -89,16 +94,14 @@ static void vf610_gpio_free(struct gpio_chip *chip, unsigned offset)
|
|
|
|
|
|
static int vf610_gpio_get(struct gpio_chip *gc, unsigned int gpio)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port =
|
|
|
- container_of(gc, struct vf610_gpio_port, gc);
|
|
|
+ struct vf610_gpio_port *port = to_vf610_gp(gc);
|
|
|
|
|
|
return !!(vf610_gpio_readl(port->gpio_base + GPIO_PDIR) & BIT(gpio));
|
|
|
}
|
|
|
|
|
|
static void vf610_gpio_set(struct gpio_chip *gc, unsigned int gpio, int val)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port =
|
|
|
- container_of(gc, struct vf610_gpio_port, gc);
|
|
|
+ struct vf610_gpio_port *port = to_vf610_gp(gc);
|
|
|
unsigned long mask = BIT(gpio);
|
|
|
|
|
|
if (val)
|
|
@@ -122,7 +125,8 @@ static int vf610_gpio_direction_output(struct gpio_chip *chip, unsigned gpio,
|
|
|
|
|
|
static void vf610_gpio_irq_handler(struct irq_desc *desc)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port = irq_desc_get_handler_data(desc);
|
|
|
+ struct vf610_gpio_port *port =
|
|
|
+ to_vf610_gp(irq_desc_get_handler_data(desc));
|
|
|
struct irq_chip *chip = irq_desc_get_chip(desc);
|
|
|
int pin;
|
|
|
unsigned long irq_isfr;
|
|
@@ -142,7 +146,8 @@ static void vf610_gpio_irq_handler(struct irq_desc *desc)
|
|
|
|
|
|
static void vf610_gpio_irq_ack(struct irq_data *d)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port = irq_data_get_irq_chip_data(d);
|
|
|
+ struct vf610_gpio_port *port =
|
|
|
+ to_vf610_gp(irq_data_get_irq_chip_data(d));
|
|
|
int gpio = d->hwirq;
|
|
|
|
|
|
vf610_gpio_writel(BIT(gpio), port->base + PORT_ISFR);
|
|
@@ -150,7 +155,8 @@ static void vf610_gpio_irq_ack(struct irq_data *d)
|
|
|
|
|
|
static int vf610_gpio_irq_set_type(struct irq_data *d, u32 type)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port = irq_data_get_irq_chip_data(d);
|
|
|
+ struct vf610_gpio_port *port =
|
|
|
+ to_vf610_gp(irq_data_get_irq_chip_data(d));
|
|
|
u8 irqc;
|
|
|
|
|
|
switch (type) {
|
|
@@ -185,7 +191,8 @@ static int vf610_gpio_irq_set_type(struct irq_data *d, u32 type)
|
|
|
|
|
|
static void vf610_gpio_irq_mask(struct irq_data *d)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port = irq_data_get_irq_chip_data(d);
|
|
|
+ struct vf610_gpio_port *port =
|
|
|
+ to_vf610_gp(irq_data_get_irq_chip_data(d));
|
|
|
void __iomem *pcr_base = port->base + PORT_PCR(d->hwirq);
|
|
|
|
|
|
vf610_gpio_writel(0, pcr_base);
|
|
@@ -193,7 +200,8 @@ static void vf610_gpio_irq_mask(struct irq_data *d)
|
|
|
|
|
|
static void vf610_gpio_irq_unmask(struct irq_data *d)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port = irq_data_get_irq_chip_data(d);
|
|
|
+ struct vf610_gpio_port *port =
|
|
|
+ to_vf610_gp(irq_data_get_irq_chip_data(d));
|
|
|
void __iomem *pcr_base = port->base + PORT_PCR(d->hwirq);
|
|
|
|
|
|
vf610_gpio_writel(port->irqc[d->hwirq] << PORT_PCR_IRQC_OFFSET,
|
|
@@ -202,7 +210,8 @@ static void vf610_gpio_irq_unmask(struct irq_data *d)
|
|
|
|
|
|
static int vf610_gpio_irq_set_wake(struct irq_data *d, u32 enable)
|
|
|
{
|
|
|
- struct vf610_gpio_port *port = irq_data_get_irq_chip_data(d);
|
|
|
+ struct vf610_gpio_port *port =
|
|
|
+ to_vf610_gp(irq_data_get_irq_chip_data(d));
|
|
|
|
|
|
if (enable)
|
|
|
enable_irq_wake(port->irq);
|