pinctrl: actions: Add interrupt support for OWL S900 SoC
Add interrupt support for Actions Semi OWL S900 SoC. Signed-off-by: Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org> Reviewed-by: Andy Shevchenko <andy.shevchenko@gmail.com> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
parent
e3bc2ebd92
commit
6c5d0736e9
|
@ -5,6 +5,7 @@ config PINCTRL_OWL
|
|||
select PINCONF
|
||||
select GENERIC_PINCONF
|
||||
select GPIOLIB
|
||||
select GPIOLIB_IRQCHIP
|
||||
help
|
||||
Say Y here to enable Actions Semi OWL pinctrl driver
|
||||
|
||||
|
|
|
@ -13,6 +13,7 @@
|
|||
#include <linux/err.h>
|
||||
#include <linux/gpio/driver.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/platform_device.h>
|
||||
|
@ -45,6 +46,9 @@ struct owl_pinctrl {
|
|||
struct clk *clk;
|
||||
const struct owl_pinctrl_soc_data *soc;
|
||||
void __iomem *base;
|
||||
struct irq_chip irq_chip;
|
||||
unsigned int num_irq;
|
||||
unsigned int *irq;
|
||||
};
|
||||
|
||||
static void owl_update_bits(void __iomem *base, u32 mask, u32 val)
|
||||
|
@ -701,10 +705,213 @@ static int owl_gpio_direction_output(struct gpio_chip *chip,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void irq_set_type(struct owl_pinctrl *pctrl, int gpio, unsigned int type)
|
||||
{
|
||||
const struct owl_gpio_port *port;
|
||||
void __iomem *gpio_base;
|
||||
unsigned long flags;
|
||||
unsigned int offset, value, irq_type = 0;
|
||||
|
||||
switch (type) {
|
||||
case IRQ_TYPE_EDGE_BOTH:
|
||||
/*
|
||||
* Since the hardware doesn't support interrupts on both edges,
|
||||
* emulate it in the software by setting the single edge
|
||||
* interrupt and switching to the opposite edge while ACKing
|
||||
* the interrupt
|
||||
*/
|
||||
if (owl_gpio_get(&pctrl->chip, gpio))
|
||||
irq_type = OWL_GPIO_INT_EDGE_FALLING;
|
||||
else
|
||||
irq_type = OWL_GPIO_INT_EDGE_RISING;
|
||||
break;
|
||||
|
||||
case IRQ_TYPE_EDGE_RISING:
|
||||
irq_type = OWL_GPIO_INT_EDGE_RISING;
|
||||
break;
|
||||
|
||||
case IRQ_TYPE_EDGE_FALLING:
|
||||
irq_type = OWL_GPIO_INT_EDGE_FALLING;
|
||||
break;
|
||||
|
||||
case IRQ_TYPE_LEVEL_HIGH:
|
||||
irq_type = OWL_GPIO_INT_LEVEL_HIGH;
|
||||
break;
|
||||
|
||||
case IRQ_TYPE_LEVEL_LOW:
|
||||
irq_type = OWL_GPIO_INT_LEVEL_LOW;
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
port = owl_gpio_get_port(pctrl, &gpio);
|
||||
if (WARN_ON(port == NULL))
|
||||
return;
|
||||
|
||||
gpio_base = pctrl->base + port->offset;
|
||||
|
||||
raw_spin_lock_irqsave(&pctrl->lock, flags);
|
||||
|
||||
offset = (gpio < 16) ? 4 : 0;
|
||||
value = readl_relaxed(gpio_base + port->intc_type + offset);
|
||||
value &= ~(OWL_GPIO_INT_MASK << ((gpio % 16) * 2));
|
||||
value |= irq_type << ((gpio % 16) * 2);
|
||||
writel_relaxed(value, gpio_base + port->intc_type + offset);
|
||||
|
||||
raw_spin_unlock_irqrestore(&pctrl->lock, flags);
|
||||
}
|
||||
|
||||
static void owl_gpio_irq_mask(struct irq_data *data)
|
||||
{
|
||||
struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
|
||||
struct owl_pinctrl *pctrl = gpiochip_get_data(gc);
|
||||
const struct owl_gpio_port *port;
|
||||
void __iomem *gpio_base;
|
||||
unsigned long flags;
|
||||
unsigned int gpio = data->hwirq;
|
||||
u32 val;
|
||||
|
||||
port = owl_gpio_get_port(pctrl, &gpio);
|
||||
if (WARN_ON(port == NULL))
|
||||
return;
|
||||
|
||||
gpio_base = pctrl->base + port->offset;
|
||||
|
||||
raw_spin_lock_irqsave(&pctrl->lock, flags);
|
||||
|
||||
owl_gpio_update_reg(gpio_base + port->intc_msk, gpio, false);
|
||||
|
||||
/* disable port interrupt if no interrupt pending bit is active */
|
||||
val = readl_relaxed(gpio_base + port->intc_msk);
|
||||
if (val == 0)
|
||||
owl_gpio_update_reg(gpio_base + port->intc_ctl,
|
||||
OWL_GPIO_CTLR_ENABLE, false);
|
||||
|
||||
raw_spin_unlock_irqrestore(&pctrl->lock, flags);
|
||||
}
|
||||
|
||||
static void owl_gpio_irq_unmask(struct irq_data *data)
|
||||
{
|
||||
struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
|
||||
struct owl_pinctrl *pctrl = gpiochip_get_data(gc);
|
||||
const struct owl_gpio_port *port;
|
||||
void __iomem *gpio_base;
|
||||
unsigned long flags;
|
||||
unsigned int gpio = data->hwirq;
|
||||
u32 value;
|
||||
|
||||
port = owl_gpio_get_port(pctrl, &gpio);
|
||||
if (WARN_ON(port == NULL))
|
||||
return;
|
||||
|
||||
gpio_base = pctrl->base + port->offset;
|
||||
raw_spin_lock_irqsave(&pctrl->lock, flags);
|
||||
|
||||
/* enable port interrupt */
|
||||
value = readl_relaxed(gpio_base + port->intc_ctl);
|
||||
value |= BIT(OWL_GPIO_CTLR_ENABLE) | BIT(OWL_GPIO_CTLR_SAMPLE_CLK_24M);
|
||||
writel_relaxed(value, gpio_base + port->intc_ctl);
|
||||
|
||||
/* enable GPIO interrupt */
|
||||
owl_gpio_update_reg(gpio_base + port->intc_msk, gpio, true);
|
||||
|
||||
raw_spin_unlock_irqrestore(&pctrl->lock, flags);
|
||||
}
|
||||
|
||||
static void owl_gpio_irq_ack(struct irq_data *data)
|
||||
{
|
||||
struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
|
||||
struct owl_pinctrl *pctrl = gpiochip_get_data(gc);
|
||||
const struct owl_gpio_port *port;
|
||||
void __iomem *gpio_base;
|
||||
unsigned long flags;
|
||||
unsigned int gpio = data->hwirq;
|
||||
|
||||
/*
|
||||
* Switch the interrupt edge to the opposite edge of the interrupt
|
||||
* which got triggered for the case of emulating both edges
|
||||
*/
|
||||
if (irqd_get_trigger_type(data) == IRQ_TYPE_EDGE_BOTH) {
|
||||
if (owl_gpio_get(gc, gpio))
|
||||
irq_set_type(pctrl, gpio, IRQ_TYPE_EDGE_FALLING);
|
||||
else
|
||||
irq_set_type(pctrl, gpio, IRQ_TYPE_EDGE_RISING);
|
||||
}
|
||||
|
||||
port = owl_gpio_get_port(pctrl, &gpio);
|
||||
if (WARN_ON(port == NULL))
|
||||
return;
|
||||
|
||||
gpio_base = pctrl->base + port->offset;
|
||||
|
||||
raw_spin_lock_irqsave(&pctrl->lock, flags);
|
||||
|
||||
owl_gpio_update_reg(gpio_base + port->intc_ctl,
|
||||
OWL_GPIO_CTLR_PENDING, true);
|
||||
|
||||
raw_spin_unlock_irqrestore(&pctrl->lock, flags);
|
||||
}
|
||||
|
||||
static int owl_gpio_irq_set_type(struct irq_data *data, unsigned int type)
|
||||
{
|
||||
struct gpio_chip *gc = irq_data_get_irq_chip_data(data);
|
||||
struct owl_pinctrl *pctrl = gpiochip_get_data(gc);
|
||||
|
||||
if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH))
|
||||
irq_set_handler_locked(data, handle_level_irq);
|
||||
else
|
||||
irq_set_handler_locked(data, handle_edge_irq);
|
||||
|
||||
irq_set_type(pctrl, data->hwirq, type);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void owl_gpio_irq_handler(struct irq_desc *desc)
|
||||
{
|
||||
struct owl_pinctrl *pctrl = irq_desc_get_handler_data(desc);
|
||||
struct irq_chip *chip = irq_desc_get_chip(desc);
|
||||
struct irq_domain *domain = pctrl->chip.irq.domain;
|
||||
unsigned int parent = irq_desc_get_irq(desc);
|
||||
const struct owl_gpio_port *port;
|
||||
void __iomem *base;
|
||||
unsigned int pin, irq, offset = 0, i;
|
||||
unsigned long pending_irq;
|
||||
|
||||
chained_irq_enter(chip, desc);
|
||||
|
||||
for (i = 0; i < pctrl->soc->nports; i++) {
|
||||
port = &pctrl->soc->ports[i];
|
||||
base = pctrl->base + port->offset;
|
||||
|
||||
/* skip ports that are not associated with this irq */
|
||||
if (parent != pctrl->irq[i])
|
||||
goto skip;
|
||||
|
||||
pending_irq = readl_relaxed(base + port->intc_pd);
|
||||
|
||||
for_each_set_bit(pin, &pending_irq, port->pins) {
|
||||
irq = irq_find_mapping(domain, offset + pin);
|
||||
generic_handle_irq(irq);
|
||||
|
||||
/* clear pending interrupt */
|
||||
owl_gpio_update_reg(base + port->intc_pd, pin, true);
|
||||
}
|
||||
|
||||
skip:
|
||||
offset += port->pins;
|
||||
}
|
||||
|
||||
chained_irq_exit(chip, desc);
|
||||
}
|
||||
|
||||
static int owl_gpio_init(struct owl_pinctrl *pctrl)
|
||||
{
|
||||
struct gpio_chip *chip;
|
||||
int ret;
|
||||
struct gpio_irq_chip *gpio_irq;
|
||||
int ret, i, j, offset;
|
||||
|
||||
chip = &pctrl->chip;
|
||||
chip->base = -1;
|
||||
|
@ -714,6 +921,35 @@ static int owl_gpio_init(struct owl_pinctrl *pctrl)
|
|||
chip->owner = THIS_MODULE;
|
||||
chip->of_node = pctrl->dev->of_node;
|
||||
|
||||
pctrl->irq_chip.name = chip->of_node->name;
|
||||
pctrl->irq_chip.irq_ack = owl_gpio_irq_ack;
|
||||
pctrl->irq_chip.irq_mask = owl_gpio_irq_mask;
|
||||
pctrl->irq_chip.irq_unmask = owl_gpio_irq_unmask;
|
||||
pctrl->irq_chip.irq_set_type = owl_gpio_irq_set_type;
|
||||
|
||||
gpio_irq = &chip->irq;
|
||||
gpio_irq->chip = &pctrl->irq_chip;
|
||||
gpio_irq->handler = handle_simple_irq;
|
||||
gpio_irq->default_type = IRQ_TYPE_NONE;
|
||||
gpio_irq->parent_handler = owl_gpio_irq_handler;
|
||||
gpio_irq->parent_handler_data = pctrl;
|
||||
gpio_irq->num_parents = pctrl->num_irq;
|
||||
gpio_irq->parents = pctrl->irq;
|
||||
|
||||
gpio_irq->map = devm_kcalloc(pctrl->dev, chip->ngpio,
|
||||
sizeof(*gpio_irq->map), GFP_KERNEL);
|
||||
if (!gpio_irq->map)
|
||||
return -ENOMEM;
|
||||
|
||||
for (i = 0, offset = 0; i < pctrl->soc->nports; i++) {
|
||||
const struct owl_gpio_port *port = &pctrl->soc->ports[i];
|
||||
|
||||
for (j = 0; j < port->pins; j++)
|
||||
gpio_irq->map[offset + j] = gpio_irq->parents[i];
|
||||
|
||||
offset += port->pins;
|
||||
}
|
||||
|
||||
ret = gpiochip_add_data(&pctrl->chip, pctrl);
|
||||
if (ret) {
|
||||
dev_err(pctrl->dev, "failed to register gpiochip\n");
|
||||
|
@ -728,7 +964,7 @@ int owl_pinctrl_probe(struct platform_device *pdev,
|
|||
{
|
||||
struct resource *res;
|
||||
struct owl_pinctrl *pctrl;
|
||||
int ret;
|
||||
int ret, i;
|
||||
|
||||
pctrl = devm_kzalloc(&pdev->dev, sizeof(*pctrl), GFP_KERNEL);
|
||||
if (!pctrl)
|
||||
|
@ -772,14 +1008,41 @@ int owl_pinctrl_probe(struct platform_device *pdev,
|
|||
&owl_pinctrl_desc, pctrl);
|
||||
if (IS_ERR(pctrl->pctrldev)) {
|
||||
dev_err(&pdev->dev, "could not register Actions OWL pinmux driver\n");
|
||||
return PTR_ERR(pctrl->pctrldev);
|
||||
ret = PTR_ERR(pctrl->pctrldev);
|
||||
goto err_exit;
|
||||
}
|
||||
|
||||
ret = platform_irq_count(pdev);
|
||||
if (ret < 0)
|
||||
goto err_exit;
|
||||
|
||||
pctrl->num_irq = ret;
|
||||
|
||||
pctrl->irq = devm_kcalloc(&pdev->dev, pctrl->num_irq,
|
||||
sizeof(*pctrl->irq), GFP_KERNEL);
|
||||
if (!pctrl->irq) {
|
||||
ret = -ENOMEM;
|
||||
goto err_exit;
|
||||
}
|
||||
|
||||
for (i = 0; i < pctrl->num_irq ; i++) {
|
||||
pctrl->irq[i] = platform_get_irq(pdev, i);
|
||||
if (pctrl->irq[i] < 0) {
|
||||
ret = pctrl->irq[i];
|
||||
goto err_exit;
|
||||
}
|
||||
}
|
||||
|
||||
ret = owl_gpio_init(pctrl);
|
||||
if (ret)
|
||||
return ret;
|
||||
goto err_exit;
|
||||
|
||||
platform_set_drvdata(pdev, pctrl);
|
||||
|
||||
return 0;
|
||||
|
||||
err_exit:
|
||||
clk_disable_unprepare(pctrl->clk);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
|
|
@ -29,6 +29,18 @@ enum owl_pinconf_drv {
|
|||
OWL_PINCONF_DRV_12MA,
|
||||
};
|
||||
|
||||
/* GPIO CTRL Bit Definition */
|
||||
#define OWL_GPIO_CTLR_PENDING 0
|
||||
#define OWL_GPIO_CTLR_ENABLE 1
|
||||
#define OWL_GPIO_CTLR_SAMPLE_CLK_24M 2
|
||||
|
||||
/* GPIO TYPE Bit Definition */
|
||||
#define OWL_GPIO_INT_LEVEL_HIGH 0
|
||||
#define OWL_GPIO_INT_LEVEL_LOW 1
|
||||
#define OWL_GPIO_INT_EDGE_RISING 2
|
||||
#define OWL_GPIO_INT_EDGE_FALLING 3
|
||||
#define OWL_GPIO_INT_MASK 3
|
||||
|
||||
/**
|
||||
* struct owl_pullctl - Actions pad pull control register
|
||||
* @reg: offset to the pull control register
|
||||
|
@ -121,6 +133,10 @@ struct owl_pinmux_func {
|
|||
* @outen: offset of the output enable register.
|
||||
* @inen: offset of the input enable register.
|
||||
* @dat: offset of the data register.
|
||||
* @intc_ctl: offset of the interrupt control register.
|
||||
* @intc_pd: offset of the interrupt pending register.
|
||||
* @intc_msk: offset of the interrupt mask register.
|
||||
* @intc_type: offset of the interrupt type register.
|
||||
*/
|
||||
struct owl_gpio_port {
|
||||
unsigned int offset;
|
||||
|
@ -128,6 +144,10 @@ struct owl_gpio_port {
|
|||
unsigned int outen;
|
||||
unsigned int inen;
|
||||
unsigned int dat;
|
||||
unsigned int intc_ctl;
|
||||
unsigned int intc_pd;
|
||||
unsigned int intc_msk;
|
||||
unsigned int intc_type;
|
||||
};
|
||||
|
||||
/**
|
||||
|
@ -140,7 +160,7 @@ struct owl_gpio_port {
|
|||
* @ngroups: number of entries in @groups.
|
||||
* @padinfo: array describing the pad info of this SoC.
|
||||
* @ngpios: number of pingroups the driver should expose as GPIOs.
|
||||
* @port: array describing all GPIO ports of this SoC.
|
||||
* @ports: array describing all GPIO ports of this SoC.
|
||||
* @nports: number of GPIO ports in this SoC.
|
||||
*/
|
||||
struct owl_pinctrl_soc_data {
|
||||
|
|
|
@ -1821,22 +1821,27 @@ static struct owl_padinfo s900_padinfo[NUM_PADS] = {
|
|||
[SGPIO3] = PAD_INFO_PULLCTL_ST(SGPIO3)
|
||||
};
|
||||
|
||||
#define OWL_GPIO_PORT(port, base, count, _outen, _inen, _dat) \
|
||||
[OWL_GPIO_PORT_##port] = { \
|
||||
.offset = base, \
|
||||
.pins = count, \
|
||||
.outen = _outen, \
|
||||
.inen = _inen, \
|
||||
.dat = _dat, \
|
||||
#define OWL_GPIO_PORT(port, base, count, _outen, _inen, _dat, \
|
||||
_intc_ctl, _intc_pd, _intc_msk, _intc_type) \
|
||||
[OWL_GPIO_PORT_##port] = { \
|
||||
.offset = base, \
|
||||
.pins = count, \
|
||||
.outen = _outen, \
|
||||
.inen = _inen, \
|
||||
.dat = _dat, \
|
||||
.intc_ctl = _intc_ctl, \
|
||||
.intc_pd = _intc_pd, \
|
||||
.intc_msk = _intc_msk, \
|
||||
.intc_type = _intc_type, \
|
||||
}
|
||||
|
||||
static const struct owl_gpio_port s900_gpio_ports[] = {
|
||||
OWL_GPIO_PORT(A, 0x0000, 32, 0x0, 0x4, 0x8),
|
||||
OWL_GPIO_PORT(B, 0x000C, 32, 0x0, 0x4, 0x8),
|
||||
OWL_GPIO_PORT(C, 0x0018, 12, 0x0, 0x4, 0x8),
|
||||
OWL_GPIO_PORT(D, 0x0024, 30, 0x0, 0x4, 0x8),
|
||||
OWL_GPIO_PORT(E, 0x0030, 32, 0x0, 0x4, 0x8),
|
||||
OWL_GPIO_PORT(F, 0x00F0, 8, 0x0, 0x4, 0x8)
|
||||
OWL_GPIO_PORT(A, 0x0000, 32, 0x0, 0x4, 0x8, 0x204, 0x208, 0x20C, 0x240),
|
||||
OWL_GPIO_PORT(B, 0x000C, 32, 0x0, 0x4, 0x8, 0x534, 0x204, 0x208, 0x23C),
|
||||
OWL_GPIO_PORT(C, 0x0018, 12, 0x0, 0x4, 0x8, 0x52C, 0x200, 0x204, 0x238),
|
||||
OWL_GPIO_PORT(D, 0x0024, 30, 0x0, 0x4, 0x8, 0x524, 0x1FC, 0x200, 0x234),
|
||||
OWL_GPIO_PORT(E, 0x0030, 32, 0x0, 0x4, 0x8, 0x51C, 0x1F8, 0x1FC, 0x230),
|
||||
OWL_GPIO_PORT(F, 0x00F0, 8, 0x0, 0x4, 0x8, 0x460, 0x140, 0x144, 0x178)
|
||||
};
|
||||
|
||||
static struct owl_pinctrl_soc_data s900_pinctrl_data = {
|
||||
|
|
Loading…
Reference in New Issue