mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-12 21:44:06 +08:00
c288ea6798
- new testing module: gpio-sim that is scheduled to replace gpio-mockup - initial changes aiming at converting all GPIO drivers to using the fwnode interface and limiting any references to OF symbols to gpiolib-of.c - add support for Tegra234 and Tegra241 to gpio-tegra186 - add support for new models (SSD201 and SSD202D) to gpio-msc313 - add basic support for interrupts to gpio-aggregator - add support for AMDIF031 HID device to gpio-amdpt - drop support for unused platforms in gpio-xlp - cleanup leftovers from the removal of the legacy Samsung Exynos GPIO driver - use raw spinlocks in gpio-aspeed and gpio-aspeed-sgpio to make PREEMPT_RT happy - generalize the common 'ngpios' device property by reading it in the core gpiolib code so that we can remove duplicate reads from drivers - allow line names from device properties to override names set by drivers - code shrink in gpiod_add_lookup_table() - add new model to the DT bindings for gpio-vf610 - convert DT bindings for tegra devices to YAML - improvements to interrupt handling in gpio-rcar and gpio-rockchip - updates to intel drivers from Andy (details in the merge commit) - some minor tweaks, improvements and coding-style fixes all around the subsystem -----BEGIN PGP SIGNATURE----- iQIzBAABCAAdFiEEFp3rbAvDxGAT0sefEacuoBRx13IFAmHdpawACgkQEacuoBRx 13KBTxAA1uB3zOqq5L9gn7cLR8Pi1/N4o7ltB0uwIFGJ8X5+jkHqkEi2TRa7Nyv1 OODt/C2g8iguhynQJ1g//ZW12tzoThwI9fUzixZ9FRBMmX5oHeCcrS/YAYP4GDJY T9KOiXPDJ+vHV7SbM4k8gIlMHFk5Uq1jjvNnDIebzyBlyzAKxH9dIY3r1zt0Y4BR aKlAD5pxmLDAMAWVlTRo5e/W/Xd0ob0LCkDwlgozb3gwoPQbQQIPHuw+jPl5cMR2 wBRNVFuJLi5dnpyrOoCXWWDQzeQzw8x+5vlwZfLkr2pF4FfDWoxefmbrDulzU+Au t6TULGcFKhLalyozY2D2mWNo8lMs4fDt/SXrDHwgS/cmGpq7RUGfvFuV6a9IOukP /uqoMYviIRswJuvPBs6dBNFaZxJkw4cWzd9tIzywb07mpkUCwX8wARwg+dZGvdQt 4aAJwkJHuR29bEpDVfWwd2UV+fdAX5RiVQqLznNzGK51O+vS4UklYyWtO44R+fgm F81y2zOo0ly9xA6YkGjoSATnWDTmzTQSrnwcFv9J9UewY3PJpQc4xgqvZysur5cb 0k/kuf9eWazmo46gW3ztv8GfXogDko8DEKrEgGs47tg97RDR5YbzOkOmnsqWvoUd nSVyx6vs2ijXsEi96FKhfTrU0AT2YcAIbEWjQoQvBR+3zkase7I= =OUhL -----END PGP SIGNATURE----- Merge tag 'gpio-updates-for-v5.17' of git://git.kernel.org/pub/scm/linux/kernel/git/brgl/linux Pull gpio updates from Bartosz Golaszewski: "The gpio-sim module is back, this time without any changes to configfs. This results in a less elegant user-space interface but I never got any follow-up on the committable items and didn't want to delay this module for several more months. Other than that we have support for several new models and some support going away. We started working on converting GPIO drivers to using fwnode exclusively in order to limit references to OF symbols to gpiolib-of.c exclusively. We also have regular tweaks and improvements all over the place. Summary: - new testing module: gpio-sim that is scheduled to replace gpio-mockup - initial changes aiming at converting all GPIO drivers to using the fwnode interface and limiting any references to OF symbols to gpiolib-of.c - add support for Tegra234 and Tegra241 to gpio-tegra186 - add support for new models (SSD201 and SSD202D) to gpio-msc313 - add basic support for interrupts to gpio-aggregator - add support for AMDIF031 HID device to gpio-amdpt - drop support for unused platforms in gpio-xlp - cleanup leftovers from the removal of the legacy Samsung Exynos GPIO driver - use raw spinlocks in gpio-aspeed and gpio-aspeed-sgpio to make PREEMPT_RT happy - generalize the common 'ngpios' device property by reading it in the core gpiolib code so that we can remove duplicate reads from drivers - allow line names from device properties to override names set by drivers - code shrink in gpiod_add_lookup_table() - add new model to the DT bindings for gpio-vf610 - convert DT bindings for tegra devices to YAML - improvements to interrupt handling in gpio-rcar and gpio-rockchip - updates to intel drivers from Andy (details in the merge commit) - some minor tweaks, improvements and coding-style fixes all around the subsystem" * tag 'gpio-updates-for-v5.17' of git://git.kernel.org/pub/scm/linux/kernel/git/brgl/linux: (59 commits) gpio: rcar: Propagate errors from devm_request_irq() gpio: rcar: Use platform_get_irq() to get the interrupt gpio: ts5500: Use platform_get_irq() to get the interrupt gpio: dwapb: Switch to use fwnode instead of of_node gpiolib: acpi: make fwnode take precedence in struct gpio_chip dt-bindings: gpio: samsung: drop unused bindings gpio: max3191x: Use bitmap_free() to free bitmap gpio: regmap: Switch to use fwnode instead of of_node gpio: tegra186: Add support for Tegra241 dt-bindings: gpio: Add Tegra241 support gpio: brcmstb: Use local variable to access OF node gpio: Remove unused local OF node pointers gpio: sim: add missing fwnode_handle_put() in gpio_sim_probe() gpio: msc313: Add support for SSD201 and SSD202D gpio: msc313: Code clean ups dt-bindings: gpio: msc313: Add offsets for ssd20xd dt-bindings: gpio: msc313: Add compatible for ssd20xd gpio: sim: fix uninitialized ret variable gpio: Propagate firmware node from a parent device gpio: Setup parent device and get rid of unnecessary of_node assignment ...
613 lines
15 KiB
C
613 lines
15 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright 2019 American Megatrends International LLC.
|
|
*
|
|
* Author: Karthikeyan Mani <karthikeyanm@amiindia.co.in>
|
|
*/
|
|
|
|
#include <linux/bitfield.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/gpio/driver.h>
|
|
#include <linux/hashtable.h>
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/string.h>
|
|
|
|
#define ASPEED_SGPIO_CTRL 0x54
|
|
|
|
#define ASPEED_SGPIO_CLK_DIV_MASK GENMASK(31, 16)
|
|
#define ASPEED_SGPIO_ENABLE BIT(0)
|
|
#define ASPEED_SGPIO_PINS_SHIFT 6
|
|
|
|
struct aspeed_sgpio_pdata {
|
|
const u32 pin_mask;
|
|
};
|
|
|
|
struct aspeed_sgpio {
|
|
struct gpio_chip chip;
|
|
struct irq_chip intc;
|
|
struct clk *pclk;
|
|
raw_spinlock_t lock;
|
|
void __iomem *base;
|
|
int irq;
|
|
};
|
|
|
|
struct aspeed_sgpio_bank {
|
|
u16 val_regs;
|
|
u16 rdata_reg;
|
|
u16 irq_regs;
|
|
u16 tolerance_regs;
|
|
const char names[4][3];
|
|
};
|
|
|
|
/*
|
|
* Note: The "value" register returns the input value when the GPIO is
|
|
* configured as an input.
|
|
*
|
|
* The "rdata" register returns the output value when the GPIO is
|
|
* configured as an output.
|
|
*/
|
|
static const struct aspeed_sgpio_bank aspeed_sgpio_banks[] = {
|
|
{
|
|
.val_regs = 0x0000,
|
|
.rdata_reg = 0x0070,
|
|
.irq_regs = 0x0004,
|
|
.tolerance_regs = 0x0018,
|
|
.names = { "A", "B", "C", "D" },
|
|
},
|
|
{
|
|
.val_regs = 0x001C,
|
|
.rdata_reg = 0x0074,
|
|
.irq_regs = 0x0020,
|
|
.tolerance_regs = 0x0034,
|
|
.names = { "E", "F", "G", "H" },
|
|
},
|
|
{
|
|
.val_regs = 0x0038,
|
|
.rdata_reg = 0x0078,
|
|
.irq_regs = 0x003C,
|
|
.tolerance_regs = 0x0050,
|
|
.names = { "I", "J", "K", "L" },
|
|
},
|
|
{
|
|
.val_regs = 0x0090,
|
|
.rdata_reg = 0x007C,
|
|
.irq_regs = 0x0094,
|
|
.tolerance_regs = 0x00A8,
|
|
.names = { "M", "N", "O", "P" },
|
|
},
|
|
};
|
|
|
|
enum aspeed_sgpio_reg {
|
|
reg_val,
|
|
reg_rdata,
|
|
reg_irq_enable,
|
|
reg_irq_type0,
|
|
reg_irq_type1,
|
|
reg_irq_type2,
|
|
reg_irq_status,
|
|
reg_tolerance,
|
|
};
|
|
|
|
#define GPIO_VAL_VALUE 0x00
|
|
#define GPIO_IRQ_ENABLE 0x00
|
|
#define GPIO_IRQ_TYPE0 0x04
|
|
#define GPIO_IRQ_TYPE1 0x08
|
|
#define GPIO_IRQ_TYPE2 0x0C
|
|
#define GPIO_IRQ_STATUS 0x10
|
|
|
|
static void __iomem *bank_reg(struct aspeed_sgpio *gpio,
|
|
const struct aspeed_sgpio_bank *bank,
|
|
const enum aspeed_sgpio_reg reg)
|
|
{
|
|
switch (reg) {
|
|
case reg_val:
|
|
return gpio->base + bank->val_regs + GPIO_VAL_VALUE;
|
|
case reg_rdata:
|
|
return gpio->base + bank->rdata_reg;
|
|
case reg_irq_enable:
|
|
return gpio->base + bank->irq_regs + GPIO_IRQ_ENABLE;
|
|
case reg_irq_type0:
|
|
return gpio->base + bank->irq_regs + GPIO_IRQ_TYPE0;
|
|
case reg_irq_type1:
|
|
return gpio->base + bank->irq_regs + GPIO_IRQ_TYPE1;
|
|
case reg_irq_type2:
|
|
return gpio->base + bank->irq_regs + GPIO_IRQ_TYPE2;
|
|
case reg_irq_status:
|
|
return gpio->base + bank->irq_regs + GPIO_IRQ_STATUS;
|
|
case reg_tolerance:
|
|
return gpio->base + bank->tolerance_regs;
|
|
default:
|
|
/* acturally if code runs to here, it's an error case */
|
|
BUG();
|
|
}
|
|
}
|
|
|
|
#define GPIO_BANK(x) ((x) >> 6)
|
|
#define GPIO_OFFSET(x) ((x) & GENMASK(5, 0))
|
|
#define GPIO_BIT(x) BIT(GPIO_OFFSET(x) >> 1)
|
|
|
|
static const struct aspeed_sgpio_bank *to_bank(unsigned int offset)
|
|
{
|
|
unsigned int bank;
|
|
|
|
bank = GPIO_BANK(offset);
|
|
|
|
WARN_ON(bank >= ARRAY_SIZE(aspeed_sgpio_banks));
|
|
return &aspeed_sgpio_banks[bank];
|
|
}
|
|
|
|
static int aspeed_sgpio_init_valid_mask(struct gpio_chip *gc,
|
|
unsigned long *valid_mask, unsigned int ngpios)
|
|
{
|
|
bitmap_set(valid_mask, 0, ngpios);
|
|
return 0;
|
|
}
|
|
|
|
static void aspeed_sgpio_irq_init_valid_mask(struct gpio_chip *gc,
|
|
unsigned long *valid_mask, unsigned int ngpios)
|
|
{
|
|
unsigned int i;
|
|
|
|
/* input GPIOs are even bits */
|
|
for (i = 0; i < ngpios; i++) {
|
|
if (i % 2)
|
|
clear_bit(i, valid_mask);
|
|
}
|
|
}
|
|
|
|
static bool aspeed_sgpio_is_input(unsigned int offset)
|
|
{
|
|
return !(offset % 2);
|
|
}
|
|
|
|
static int aspeed_sgpio_get(struct gpio_chip *gc, unsigned int offset)
|
|
{
|
|
struct aspeed_sgpio *gpio = gpiochip_get_data(gc);
|
|
const struct aspeed_sgpio_bank *bank = to_bank(offset);
|
|
unsigned long flags;
|
|
enum aspeed_sgpio_reg reg;
|
|
int rc = 0;
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
|
|
reg = aspeed_sgpio_is_input(offset) ? reg_val : reg_rdata;
|
|
rc = !!(ioread32(bank_reg(gpio, bank, reg)) & GPIO_BIT(offset));
|
|
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int sgpio_set_value(struct gpio_chip *gc, unsigned int offset, int val)
|
|
{
|
|
struct aspeed_sgpio *gpio = gpiochip_get_data(gc);
|
|
const struct aspeed_sgpio_bank *bank = to_bank(offset);
|
|
void __iomem *addr_r, *addr_w;
|
|
u32 reg = 0;
|
|
|
|
if (aspeed_sgpio_is_input(offset))
|
|
return -EINVAL;
|
|
|
|
/* Since this is an output, read the cached value from rdata, then
|
|
* update val. */
|
|
addr_r = bank_reg(gpio, bank, reg_rdata);
|
|
addr_w = bank_reg(gpio, bank, reg_val);
|
|
|
|
reg = ioread32(addr_r);
|
|
|
|
if (val)
|
|
reg |= GPIO_BIT(offset);
|
|
else
|
|
reg &= ~GPIO_BIT(offset);
|
|
|
|
iowrite32(reg, addr_w);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void aspeed_sgpio_set(struct gpio_chip *gc, unsigned int offset, int val)
|
|
{
|
|
struct aspeed_sgpio *gpio = gpiochip_get_data(gc);
|
|
unsigned long flags;
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
|
|
sgpio_set_value(gc, offset, val);
|
|
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
}
|
|
|
|
static int aspeed_sgpio_dir_in(struct gpio_chip *gc, unsigned int offset)
|
|
{
|
|
return aspeed_sgpio_is_input(offset) ? 0 : -EINVAL;
|
|
}
|
|
|
|
static int aspeed_sgpio_dir_out(struct gpio_chip *gc, unsigned int offset, int val)
|
|
{
|
|
struct aspeed_sgpio *gpio = gpiochip_get_data(gc);
|
|
unsigned long flags;
|
|
int rc;
|
|
|
|
/* No special action is required for setting the direction; we'll
|
|
* error-out in sgpio_set_value if this isn't an output GPIO */
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
rc = sgpio_set_value(gc, offset, val);
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int aspeed_sgpio_get_direction(struct gpio_chip *gc, unsigned int offset)
|
|
{
|
|
return !!aspeed_sgpio_is_input(offset);
|
|
}
|
|
|
|
static void irqd_to_aspeed_sgpio_data(struct irq_data *d,
|
|
struct aspeed_sgpio **gpio,
|
|
const struct aspeed_sgpio_bank **bank,
|
|
u32 *bit, int *offset)
|
|
{
|
|
struct aspeed_sgpio *internal;
|
|
|
|
*offset = irqd_to_hwirq(d);
|
|
internal = irq_data_get_irq_chip_data(d);
|
|
WARN_ON(!internal);
|
|
|
|
*gpio = internal;
|
|
*bank = to_bank(*offset);
|
|
*bit = GPIO_BIT(*offset);
|
|
}
|
|
|
|
static void aspeed_sgpio_irq_ack(struct irq_data *d)
|
|
{
|
|
const struct aspeed_sgpio_bank *bank;
|
|
struct aspeed_sgpio *gpio;
|
|
unsigned long flags;
|
|
void __iomem *status_addr;
|
|
int offset;
|
|
u32 bit;
|
|
|
|
irqd_to_aspeed_sgpio_data(d, &gpio, &bank, &bit, &offset);
|
|
|
|
status_addr = bank_reg(gpio, bank, reg_irq_status);
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
|
|
iowrite32(bit, status_addr);
|
|
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
}
|
|
|
|
static void aspeed_sgpio_irq_set_mask(struct irq_data *d, bool set)
|
|
{
|
|
const struct aspeed_sgpio_bank *bank;
|
|
struct aspeed_sgpio *gpio;
|
|
unsigned long flags;
|
|
u32 reg, bit;
|
|
void __iomem *addr;
|
|
int offset;
|
|
|
|
irqd_to_aspeed_sgpio_data(d, &gpio, &bank, &bit, &offset);
|
|
addr = bank_reg(gpio, bank, reg_irq_enable);
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
|
|
reg = ioread32(addr);
|
|
if (set)
|
|
reg |= bit;
|
|
else
|
|
reg &= ~bit;
|
|
|
|
iowrite32(reg, addr);
|
|
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
}
|
|
|
|
static void aspeed_sgpio_irq_mask(struct irq_data *d)
|
|
{
|
|
aspeed_sgpio_irq_set_mask(d, false);
|
|
}
|
|
|
|
static void aspeed_sgpio_irq_unmask(struct irq_data *d)
|
|
{
|
|
aspeed_sgpio_irq_set_mask(d, true);
|
|
}
|
|
|
|
static int aspeed_sgpio_set_type(struct irq_data *d, unsigned int type)
|
|
{
|
|
u32 type0 = 0;
|
|
u32 type1 = 0;
|
|
u32 type2 = 0;
|
|
u32 bit, reg;
|
|
const struct aspeed_sgpio_bank *bank;
|
|
irq_flow_handler_t handler;
|
|
struct aspeed_sgpio *gpio;
|
|
unsigned long flags;
|
|
void __iomem *addr;
|
|
int offset;
|
|
|
|
irqd_to_aspeed_sgpio_data(d, &gpio, &bank, &bit, &offset);
|
|
|
|
switch (type & IRQ_TYPE_SENSE_MASK) {
|
|
case IRQ_TYPE_EDGE_BOTH:
|
|
type2 |= bit;
|
|
fallthrough;
|
|
case IRQ_TYPE_EDGE_RISING:
|
|
type0 |= bit;
|
|
fallthrough;
|
|
case IRQ_TYPE_EDGE_FALLING:
|
|
handler = handle_edge_irq;
|
|
break;
|
|
case IRQ_TYPE_LEVEL_HIGH:
|
|
type0 |= bit;
|
|
fallthrough;
|
|
case IRQ_TYPE_LEVEL_LOW:
|
|
type1 |= bit;
|
|
handler = handle_level_irq;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
|
|
addr = bank_reg(gpio, bank, reg_irq_type0);
|
|
reg = ioread32(addr);
|
|
reg = (reg & ~bit) | type0;
|
|
iowrite32(reg, addr);
|
|
|
|
addr = bank_reg(gpio, bank, reg_irq_type1);
|
|
reg = ioread32(addr);
|
|
reg = (reg & ~bit) | type1;
|
|
iowrite32(reg, addr);
|
|
|
|
addr = bank_reg(gpio, bank, reg_irq_type2);
|
|
reg = ioread32(addr);
|
|
reg = (reg & ~bit) | type2;
|
|
iowrite32(reg, addr);
|
|
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
|
|
irq_set_handler_locked(d, handler);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void aspeed_sgpio_irq_handler(struct irq_desc *desc)
|
|
{
|
|
struct gpio_chip *gc = irq_desc_get_handler_data(desc);
|
|
struct irq_chip *ic = irq_desc_get_chip(desc);
|
|
struct aspeed_sgpio *data = gpiochip_get_data(gc);
|
|
unsigned int i, p;
|
|
unsigned long reg;
|
|
|
|
chained_irq_enter(ic, desc);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(aspeed_sgpio_banks); i++) {
|
|
const struct aspeed_sgpio_bank *bank = &aspeed_sgpio_banks[i];
|
|
|
|
reg = ioread32(bank_reg(data, bank, reg_irq_status));
|
|
|
|
for_each_set_bit(p, ®, 32)
|
|
generic_handle_domain_irq(gc->irq.domain, (i * 32 + p) * 2);
|
|
}
|
|
|
|
chained_irq_exit(ic, desc);
|
|
}
|
|
|
|
static int aspeed_sgpio_setup_irqs(struct aspeed_sgpio *gpio,
|
|
struct platform_device *pdev)
|
|
{
|
|
int rc, i;
|
|
const struct aspeed_sgpio_bank *bank;
|
|
struct gpio_irq_chip *irq;
|
|
|
|
rc = platform_get_irq(pdev, 0);
|
|
if (rc < 0)
|
|
return rc;
|
|
|
|
gpio->irq = rc;
|
|
|
|
/* Disable IRQ and clear Interrupt status registers for all SGPIO Pins. */
|
|
for (i = 0; i < ARRAY_SIZE(aspeed_sgpio_banks); i++) {
|
|
bank = &aspeed_sgpio_banks[i];
|
|
/* disable irq enable bits */
|
|
iowrite32(0x00000000, bank_reg(gpio, bank, reg_irq_enable));
|
|
/* clear status bits */
|
|
iowrite32(0xffffffff, bank_reg(gpio, bank, reg_irq_status));
|
|
}
|
|
|
|
gpio->intc.name = dev_name(&pdev->dev);
|
|
gpio->intc.irq_ack = aspeed_sgpio_irq_ack;
|
|
gpio->intc.irq_mask = aspeed_sgpio_irq_mask;
|
|
gpio->intc.irq_unmask = aspeed_sgpio_irq_unmask;
|
|
gpio->intc.irq_set_type = aspeed_sgpio_set_type;
|
|
|
|
irq = &gpio->chip.irq;
|
|
irq->chip = &gpio->intc;
|
|
irq->init_valid_mask = aspeed_sgpio_irq_init_valid_mask;
|
|
irq->handler = handle_bad_irq;
|
|
irq->default_type = IRQ_TYPE_NONE;
|
|
irq->parent_handler = aspeed_sgpio_irq_handler;
|
|
irq->parent_handler_data = gpio;
|
|
irq->parents = &gpio->irq;
|
|
irq->num_parents = 1;
|
|
|
|
/* Apply default IRQ settings */
|
|
for (i = 0; i < ARRAY_SIZE(aspeed_sgpio_banks); i++) {
|
|
bank = &aspeed_sgpio_banks[i];
|
|
/* set falling or level-low irq */
|
|
iowrite32(0x00000000, bank_reg(gpio, bank, reg_irq_type0));
|
|
/* trigger type is edge */
|
|
iowrite32(0x00000000, bank_reg(gpio, bank, reg_irq_type1));
|
|
/* single edge trigger */
|
|
iowrite32(0x00000000, bank_reg(gpio, bank, reg_irq_type2));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct aspeed_sgpio_pdata ast2400_sgpio_pdata = {
|
|
.pin_mask = GENMASK(9, 6),
|
|
};
|
|
|
|
static int aspeed_sgpio_reset_tolerance(struct gpio_chip *chip,
|
|
unsigned int offset, bool enable)
|
|
{
|
|
struct aspeed_sgpio *gpio = gpiochip_get_data(chip);
|
|
unsigned long flags;
|
|
void __iomem *reg;
|
|
u32 val;
|
|
|
|
reg = bank_reg(gpio, to_bank(offset), reg_tolerance);
|
|
|
|
raw_spin_lock_irqsave(&gpio->lock, flags);
|
|
|
|
val = readl(reg);
|
|
|
|
if (enable)
|
|
val |= GPIO_BIT(offset);
|
|
else
|
|
val &= ~GPIO_BIT(offset);
|
|
|
|
writel(val, reg);
|
|
|
|
raw_spin_unlock_irqrestore(&gpio->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int aspeed_sgpio_set_config(struct gpio_chip *chip, unsigned int offset,
|
|
unsigned long config)
|
|
{
|
|
unsigned long param = pinconf_to_config_param(config);
|
|
u32 arg = pinconf_to_config_argument(config);
|
|
|
|
if (param == PIN_CONFIG_PERSIST_STATE)
|
|
return aspeed_sgpio_reset_tolerance(chip, offset, arg);
|
|
|
|
return -ENOTSUPP;
|
|
}
|
|
|
|
static const struct aspeed_sgpio_pdata ast2600_sgpiom_pdata = {
|
|
.pin_mask = GENMASK(10, 6),
|
|
};
|
|
|
|
static const struct of_device_id aspeed_sgpio_of_table[] = {
|
|
{ .compatible = "aspeed,ast2400-sgpio", .data = &ast2400_sgpio_pdata, },
|
|
{ .compatible = "aspeed,ast2500-sgpio", .data = &ast2400_sgpio_pdata, },
|
|
{ .compatible = "aspeed,ast2600-sgpiom", .data = &ast2600_sgpiom_pdata, },
|
|
{}
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(of, aspeed_sgpio_of_table);
|
|
|
|
static int __init aspeed_sgpio_probe(struct platform_device *pdev)
|
|
{
|
|
u32 nr_gpios, sgpio_freq, sgpio_clk_div, gpio_cnt_regval, pin_mask;
|
|
const struct aspeed_sgpio_pdata *pdata;
|
|
struct aspeed_sgpio *gpio;
|
|
unsigned long apb_freq;
|
|
int rc;
|
|
|
|
gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
|
|
if (!gpio)
|
|
return -ENOMEM;
|
|
|
|
gpio->base = devm_platform_ioremap_resource(pdev, 0);
|
|
if (IS_ERR(gpio->base))
|
|
return PTR_ERR(gpio->base);
|
|
|
|
pdata = device_get_match_data(&pdev->dev);
|
|
if (!pdata)
|
|
return -EINVAL;
|
|
|
|
pin_mask = pdata->pin_mask;
|
|
|
|
rc = device_property_read_u32(&pdev->dev, "ngpios", &nr_gpios);
|
|
if (rc < 0) {
|
|
dev_err(&pdev->dev, "Could not read ngpios property\n");
|
|
return -EINVAL;
|
|
} else if (nr_gpios % 8) {
|
|
dev_err(&pdev->dev, "Number of GPIOs not multiple of 8: %d\n",
|
|
nr_gpios);
|
|
return -EINVAL;
|
|
}
|
|
|
|
rc = device_property_read_u32(&pdev->dev, "bus-frequency", &sgpio_freq);
|
|
if (rc < 0) {
|
|
dev_err(&pdev->dev, "Could not read bus-frequency property\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
gpio->pclk = devm_clk_get(&pdev->dev, NULL);
|
|
if (IS_ERR(gpio->pclk)) {
|
|
dev_err(&pdev->dev, "devm_clk_get failed\n");
|
|
return PTR_ERR(gpio->pclk);
|
|
}
|
|
|
|
apb_freq = clk_get_rate(gpio->pclk);
|
|
|
|
/*
|
|
* From the datasheet,
|
|
* SGPIO period = 1/PCLK * 2 * (GPIO254[31:16] + 1)
|
|
* period = 2 * (GPIO254[31:16] + 1) / PCLK
|
|
* frequency = 1 / (2 * (GPIO254[31:16] + 1) / PCLK)
|
|
* frequency = PCLK / (2 * (GPIO254[31:16] + 1))
|
|
* frequency * 2 * (GPIO254[31:16] + 1) = PCLK
|
|
* GPIO254[31:16] = PCLK / (frequency * 2) - 1
|
|
*/
|
|
if (sgpio_freq == 0)
|
|
return -EINVAL;
|
|
|
|
sgpio_clk_div = (apb_freq / (sgpio_freq * 2)) - 1;
|
|
|
|
if (sgpio_clk_div > (1 << 16) - 1)
|
|
return -EINVAL;
|
|
|
|
gpio_cnt_regval = ((nr_gpios / 8) << ASPEED_SGPIO_PINS_SHIFT) & pin_mask;
|
|
iowrite32(FIELD_PREP(ASPEED_SGPIO_CLK_DIV_MASK, sgpio_clk_div) | gpio_cnt_regval |
|
|
ASPEED_SGPIO_ENABLE, gpio->base + ASPEED_SGPIO_CTRL);
|
|
|
|
raw_spin_lock_init(&gpio->lock);
|
|
|
|
gpio->chip.parent = &pdev->dev;
|
|
gpio->chip.ngpio = nr_gpios * 2;
|
|
gpio->chip.init_valid_mask = aspeed_sgpio_init_valid_mask;
|
|
gpio->chip.direction_input = aspeed_sgpio_dir_in;
|
|
gpio->chip.direction_output = aspeed_sgpio_dir_out;
|
|
gpio->chip.get_direction = aspeed_sgpio_get_direction;
|
|
gpio->chip.request = NULL;
|
|
gpio->chip.free = NULL;
|
|
gpio->chip.get = aspeed_sgpio_get;
|
|
gpio->chip.set = aspeed_sgpio_set;
|
|
gpio->chip.set_config = aspeed_sgpio_set_config;
|
|
gpio->chip.label = dev_name(&pdev->dev);
|
|
gpio->chip.base = -1;
|
|
|
|
aspeed_sgpio_setup_irqs(gpio, pdev);
|
|
|
|
rc = devm_gpiochip_add_data(&pdev->dev, &gpio->chip, gpio);
|
|
if (rc < 0)
|
|
return rc;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver aspeed_sgpio_driver = {
|
|
.driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.of_match_table = aspeed_sgpio_of_table,
|
|
},
|
|
};
|
|
|
|
module_platform_driver_probe(aspeed_sgpio_driver, aspeed_sgpio_probe);
|
|
MODULE_DESCRIPTION("Aspeed Serial GPIO Driver");
|
|
MODULE_LICENSE("GPL");
|