GK SDK 源码库: XMIPCLinuxV100R005C00SPC030 (kernel/tools/open_source excluded)
This commit is contained in:
@@ -0,0 +1,421 @@
|
||||
// SPDX-License-Identifier: GPL-2.0+
|
||||
/*
|
||||
* (C) Copyright 2016 - Beniamino Galvani <b.galvani@gmail.com>
|
||||
*/
|
||||
|
||||
#include <common.h>
|
||||
#include <dm.h>
|
||||
#include <dm/device-internal.h>
|
||||
#include <dm/lists.h>
|
||||
#include <dm/pinctrl.h>
|
||||
#include <fdt_support.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/sizes.h>
|
||||
#include <asm/gpio.h>
|
||||
|
||||
#include "pinctrl-meson.h"
|
||||
|
||||
DECLARE_GLOBAL_DATA_PTR;
|
||||
|
||||
static const char *meson_pinctrl_dummy_name = "_dummy";
|
||||
|
||||
static char pin_name[PINNAME_SIZE];
|
||||
|
||||
int meson_pinctrl_get_groups_count(struct udevice *dev)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
|
||||
return priv->data->num_groups;
|
||||
}
|
||||
|
||||
const char *meson_pinctrl_get_group_name(struct udevice *dev,
|
||||
unsigned int selector)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
|
||||
if (!priv->data->groups[selector].name)
|
||||
return meson_pinctrl_dummy_name;
|
||||
|
||||
return priv->data->groups[selector].name;
|
||||
}
|
||||
|
||||
int meson_pinctrl_get_pins_count(struct udevice *dev)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
|
||||
return priv->data->num_pins;
|
||||
}
|
||||
|
||||
const char *meson_pinctrl_get_pin_name(struct udevice *dev,
|
||||
unsigned int selector)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
|
||||
if (selector > priv->data->num_pins ||
|
||||
selector > priv->data->funcs[0].num_groups)
|
||||
snprintf(pin_name, PINNAME_SIZE, "Error");
|
||||
else
|
||||
snprintf(pin_name, PINNAME_SIZE, "%s",
|
||||
priv->data->funcs[0].groups[selector]);
|
||||
|
||||
return pin_name;
|
||||
}
|
||||
|
||||
int meson_pinmux_get_functions_count(struct udevice *dev)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
|
||||
return priv->data->num_funcs;
|
||||
}
|
||||
|
||||
const char *meson_pinmux_get_function_name(struct udevice *dev,
|
||||
unsigned int selector)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
|
||||
return priv->data->funcs[selector].name;
|
||||
}
|
||||
|
||||
static int meson_gpio_calc_reg_and_bit(struct udevice *dev, unsigned int offset,
|
||||
enum meson_reg_type reg_type,
|
||||
unsigned int *reg, unsigned int *bit)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
struct meson_bank *bank = NULL;
|
||||
struct meson_reg_desc *desc;
|
||||
unsigned int pin;
|
||||
int i;
|
||||
|
||||
pin = priv->data->pin_base + offset;
|
||||
|
||||
for (i = 0; i < priv->data->num_banks; i++) {
|
||||
if (pin >= priv->data->banks[i].first &&
|
||||
pin <= priv->data->banks[i].last) {
|
||||
bank = &priv->data->banks[i];
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!bank)
|
||||
return -EINVAL;
|
||||
|
||||
desc = &bank->regs[reg_type];
|
||||
*reg = desc->reg * 4;
|
||||
*bit = desc->bit + pin - bank->first;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int meson_gpio_get(struct udevice *dev, unsigned int offset)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev->parent);
|
||||
unsigned int reg, bit;
|
||||
int ret;
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_IN, ®,
|
||||
&bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
return !!(readl(priv->reg_gpio + reg) & BIT(bit));
|
||||
}
|
||||
|
||||
int meson_gpio_set(struct udevice *dev, unsigned int offset, int value)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev->parent);
|
||||
unsigned int reg, bit;
|
||||
int ret;
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_OUT, ®,
|
||||
&bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
clrsetbits_le32(priv->reg_gpio + reg, BIT(bit), value ? BIT(bit) : 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int meson_gpio_get_direction(struct udevice *dev, unsigned int offset)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev->parent);
|
||||
unsigned int reg, bit, val;
|
||||
int ret;
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_DIR, ®,
|
||||
&bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
val = readl(priv->reg_gpio + reg);
|
||||
|
||||
return (val & BIT(bit)) ? GPIOF_INPUT : GPIOF_OUTPUT;
|
||||
}
|
||||
|
||||
int meson_gpio_direction_input(struct udevice *dev, unsigned int offset)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev->parent);
|
||||
unsigned int reg, bit;
|
||||
int ret;
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_DIR, ®,
|
||||
&bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
setbits_le32(priv->reg_gpio + reg, BIT(bit));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int meson_gpio_direction_output(struct udevice *dev,
|
||||
unsigned int offset, int value)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev->parent);
|
||||
unsigned int reg, bit;
|
||||
int ret;
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_DIR, ®,
|
||||
&bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
clrbits_le32(priv->reg_gpio + reg, BIT(bit));
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev->parent, offset, REG_OUT, ®,
|
||||
&bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
clrsetbits_le32(priv->reg_gpio + reg, BIT(bit), value ? BIT(bit) : 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int meson_pinconf_bias_set(struct udevice *dev, unsigned int pin,
|
||||
unsigned int param)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
unsigned int offset = pin - priv->data->pin_base;
|
||||
unsigned int reg, bit;
|
||||
int ret;
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev, offset, REG_PULLEN, ®, &bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
if (param == PIN_CONFIG_BIAS_DISABLE) {
|
||||
clrsetbits_le32(priv->reg_pullen + reg, BIT(bit), 0);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* othewise, enable the bias and select level */
|
||||
clrsetbits_le32(priv->reg_pullen + reg, BIT(bit), 1);
|
||||
ret = meson_gpio_calc_reg_and_bit(dev, offset, REG_PULL, ®, &bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
clrsetbits_le32(priv->reg_pull + reg, BIT(bit),
|
||||
param == PIN_CONFIG_BIAS_PULL_UP);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int meson_pinconf_drive_strength_set(struct udevice *dev,
|
||||
unsigned int pin,
|
||||
unsigned int drive_strength_ua)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
unsigned int offset = pin - priv->data->pin_base;
|
||||
unsigned int reg, bit;
|
||||
unsigned int ds_val;
|
||||
int ret;
|
||||
|
||||
if (!priv->reg_ds) {
|
||||
dev_err(dev, "drive-strength-microamp not supported\n");
|
||||
return -ENOTSUPP;
|
||||
}
|
||||
|
||||
ret = meson_gpio_calc_reg_and_bit(dev, offset, REG_DS, ®, &bit);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
bit = bit << 1;
|
||||
|
||||
if (drive_strength_ua <= 500) {
|
||||
ds_val = MESON_PINCONF_DRV_500UA;
|
||||
} else if (drive_strength_ua <= 2500) {
|
||||
ds_val = MESON_PINCONF_DRV_2500UA;
|
||||
} else if (drive_strength_ua <= 3000) {
|
||||
ds_val = MESON_PINCONF_DRV_3000UA;
|
||||
} else if (drive_strength_ua <= 4000) {
|
||||
ds_val = MESON_PINCONF_DRV_4000UA;
|
||||
} else {
|
||||
dev_warn(dev,
|
||||
"pin %u: invalid drive-strength-microamp : %d , default to 4mA\n",
|
||||
pin, drive_strength_ua);
|
||||
ds_val = MESON_PINCONF_DRV_4000UA;
|
||||
}
|
||||
|
||||
clrsetbits_le32(priv->reg_ds + reg, 0x3 << bit, ds_val << bit);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int meson_pinconf_set(struct udevice *dev, unsigned int pin,
|
||||
unsigned int param, unsigned int arg)
|
||||
{
|
||||
int ret;
|
||||
|
||||
switch (param) {
|
||||
case PIN_CONFIG_BIAS_DISABLE:
|
||||
case PIN_CONFIG_BIAS_PULL_UP:
|
||||
case PIN_CONFIG_BIAS_PULL_DOWN:
|
||||
ret = meson_pinconf_bias_set(dev, pin, param);
|
||||
break;
|
||||
case PIN_CONFIG_DRIVE_STRENGTH_UA:
|
||||
ret = meson_pinconf_drive_strength_set(dev, pin, arg);
|
||||
break;
|
||||
default:
|
||||
dev_err(dev, "unsupported configuration parameter %u\n", param);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int meson_pinconf_group_set(struct udevice *dev,
|
||||
unsigned int group_selector,
|
||||
unsigned int param, unsigned int arg)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
struct meson_pmx_group *grp = &priv->data->groups[group_selector];
|
||||
int i, ret;
|
||||
|
||||
for (i = 0; i < grp->num_pins; i++) {
|
||||
ret = meson_pinconf_set(dev, grp->pins[i], param, arg);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int meson_gpio_probe(struct udevice *dev)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev->parent);
|
||||
struct gpio_dev_priv *uc_priv;
|
||||
|
||||
uc_priv = dev_get_uclass_priv(dev);
|
||||
uc_priv->bank_name = priv->data->name;
|
||||
uc_priv->gpio_count = priv->data->num_pins;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static fdt_addr_t parse_address(int offset, const char *name, int na, int ns)
|
||||
{
|
||||
int index, len = 0;
|
||||
const fdt32_t *reg;
|
||||
|
||||
index = fdt_stringlist_search(gd->fdt_blob, offset, "reg-names", name);
|
||||
if (index < 0)
|
||||
return FDT_ADDR_T_NONE;
|
||||
|
||||
reg = fdt_getprop(gd->fdt_blob, offset, "reg", &len);
|
||||
if (!reg || (len <= (index * sizeof(fdt32_t) * (na + ns))))
|
||||
return FDT_ADDR_T_NONE;
|
||||
|
||||
reg += index * (na + ns);
|
||||
|
||||
return fdt_translate_address((void *)gd->fdt_blob, offset, reg);
|
||||
}
|
||||
|
||||
int meson_pinctrl_probe(struct udevice *dev)
|
||||
{
|
||||
struct meson_pinctrl *priv = dev_get_priv(dev);
|
||||
struct uclass_driver *drv;
|
||||
struct udevice *gpio_dev;
|
||||
fdt_addr_t addr;
|
||||
int node, gpio = -1, len;
|
||||
int na, ns;
|
||||
char *name;
|
||||
|
||||
na = fdt_address_cells(gd->fdt_blob, dev_of_offset(dev->parent));
|
||||
if (na < 1) {
|
||||
debug("bad #address-cells\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
ns = fdt_size_cells(gd->fdt_blob, dev_of_offset(dev->parent));
|
||||
if (ns < 1) {
|
||||
debug("bad #size-cells\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
fdt_for_each_subnode(node, gd->fdt_blob, dev_of_offset(dev)) {
|
||||
if (fdt_getprop(gd->fdt_blob, node, "gpio-controller", &len)) {
|
||||
gpio = node;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!gpio) {
|
||||
debug("gpio node not found\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
addr = parse_address(gpio, "mux", na, ns);
|
||||
if (addr == FDT_ADDR_T_NONE) {
|
||||
debug("mux address not found\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
priv->reg_mux = (void __iomem *)addr;
|
||||
|
||||
addr = parse_address(gpio, "gpio", na, ns);
|
||||
if (addr == FDT_ADDR_T_NONE) {
|
||||
debug("gpio address not found\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
priv->reg_gpio = (void __iomem *)addr;
|
||||
|
||||
addr = parse_address(gpio, "pull", na, ns);
|
||||
/* Use gpio region if pull one is not present */
|
||||
if (addr == FDT_ADDR_T_NONE)
|
||||
priv->reg_pull = priv->reg_gpio;
|
||||
else
|
||||
priv->reg_pull = (void __iomem *)addr;
|
||||
|
||||
addr = parse_address(gpio, "pull-enable", na, ns);
|
||||
/* Use pull region if pull-enable one is not present */
|
||||
if (addr == FDT_ADDR_T_NONE)
|
||||
priv->reg_pullen = priv->reg_pull;
|
||||
else
|
||||
priv->reg_pullen = (void __iomem *)addr;
|
||||
|
||||
addr = parse_address(gpio, "ds", na, ns);
|
||||
/* Drive strength region is optional */
|
||||
if (addr == FDT_ADDR_T_NONE)
|
||||
priv->reg_ds = NULL;
|
||||
else
|
||||
priv->reg_ds = (void __iomem *)addr;
|
||||
|
||||
priv->data = (struct meson_pinctrl_data *)dev_get_driver_data(dev);
|
||||
|
||||
/* Lookup GPIO driver */
|
||||
drv = lists_uclass_lookup(UCLASS_GPIO);
|
||||
if (!drv) {
|
||||
puts("Cannot find GPIO driver\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
name = calloc(1, 32);
|
||||
sprintf(name, "meson-gpio");
|
||||
|
||||
/* Create child device UCLASS_GPIO and bind it */
|
||||
device_bind(dev, priv->data->gpio_driver, name, NULL, gpio, &gpio_dev);
|
||||
dev_set_of_offset(gpio_dev, gpio);
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user