| /* |
| * Pinctrl driver for Rockchip SoCs |
| * |
| * Copyright (c) 2013 MundoReader S.L. |
| * Author: Heiko Stuebner <heiko@sntech.de> |
| * |
| * With some ideas taken from pinctrl-samsung: |
| * Copyright (c) 2012 Samsung Electronics Co., Ltd. |
| * http://www.samsung.com |
| * Copyright (c) 2012 Linaro Ltd |
| * http://www.linaro.org |
| * |
| * and pinctrl-at91: |
| * Copyright (C) 2011-2012 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as published |
| * by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| |
| #include <linux/init.h> |
| #include <linux/platform_device.h> |
| #include <linux/io.h> |
| #include <linux/bitops.h> |
| #include <linux/gpio/driver.h> |
| #include <linux/of_address.h> |
| #include <linux/of_irq.h> |
| #include <linux/pinctrl/machine.h> |
| #include <linux/pinctrl/pinconf.h> |
| #include <linux/pinctrl/pinctrl.h> |
| #include <linux/pinctrl/pinmux.h> |
| #include <linux/pinctrl/pinconf-generic.h> |
| #include <linux/irqchip/chained_irq.h> |
| #include <linux/clk.h> |
| #include <linux/regmap.h> |
| #include <linux/mfd/syscon.h> |
| #include <dt-bindings/pinctrl/rockchip.h> |
| |
| #include "core.h" |
| #include "pinconf.h" |
| |
| /* GPIO control registers */ |
| #define GPIO_SWPORT_DR 0x00 |
| #define GPIO_SWPORT_DDR 0x04 |
| #define GPIO_INTEN 0x30 |
| #define GPIO_INTMASK 0x34 |
| #define GPIO_INTTYPE_LEVEL 0x38 |
| #define GPIO_INT_POLARITY 0x3c |
| #define GPIO_INT_STATUS 0x40 |
| #define GPIO_INT_RAWSTATUS 0x44 |
| #define GPIO_DEBOUNCE 0x48 |
| #define GPIO_PORTS_EOI 0x4c |
| #define GPIO_EXT_PORT 0x50 |
| #define GPIO_LS_SYNC 0x60 |
| |
| enum rockchip_pinctrl_type { |
| PX30, |
| RV1108, |
| RK2928, |
| RK3066B, |
| RK3128, |
| RK3188, |
| RK3288, |
| RK3368, |
| RK3399, |
| }; |
| |
| /** |
| * Encode variants of iomux registers into a type variable |
| */ |
| #define IOMUX_GPIO_ONLY BIT(0) |
| #define IOMUX_WIDTH_4BIT BIT(1) |
| #define IOMUX_SOURCE_PMU BIT(2) |
| #define IOMUX_UNROUTED BIT(3) |
| #define IOMUX_WIDTH_3BIT BIT(4) |
| |
| /** |
| * @type: iomux variant using IOMUX_* constants |
| * @offset: if initialized to -1 it will be autocalculated, by specifying |
| * an initial offset value the relevant source offset can be reset |
| * to a new value for autocalculating the following iomux registers. |
| */ |
| struct rockchip_iomux { |
| int type; |
| int offset; |
| }; |
| |
| /** |
| * enum type index corresponding to rockchip_perpin_drv_list arrays index. |
| */ |
| enum rockchip_pin_drv_type { |
| DRV_TYPE_IO_DEFAULT = 0, |
| DRV_TYPE_IO_1V8_OR_3V0, |
| DRV_TYPE_IO_1V8_ONLY, |
| DRV_TYPE_IO_1V8_3V0_AUTO, |
| DRV_TYPE_IO_3V3_ONLY, |
| DRV_TYPE_MAX |
| }; |
| |
| /** |
| * enum type index corresponding to rockchip_pull_list arrays index. |
| */ |
| enum rockchip_pin_pull_type { |
| PULL_TYPE_IO_DEFAULT = 0, |
| PULL_TYPE_IO_1V8_ONLY, |
| PULL_TYPE_MAX |
| }; |
| |
| /** |
| * @drv_type: drive strength variant using rockchip_perpin_drv_type |
| * @offset: if initialized to -1 it will be autocalculated, by specifying |
| * an initial offset value the relevant source offset can be reset |
| * to a new value for autocalculating the following drive strength |
| * registers. if used chips own cal_drv func instead to calculate |
| * registers offset, the variant could be ignored. |
| */ |
| struct rockchip_drv { |
| enum rockchip_pin_drv_type drv_type; |
| int offset; |
| }; |
| |
| /** |
| * @reg_base: register base of the gpio bank |
| * @reg_pull: optional separate register for additional pull settings |
| * @clk: clock of the gpio bank |
| * @irq: interrupt of the gpio bank |
| * @saved_masks: Saved content of GPIO_INTEN at suspend time. |
| * @pin_base: first pin number |
| * @nr_pins: number of pins in this bank |
| * @name: name of the bank |
| * @bank_num: number of the bank, to account for holes |
| * @iomux: array describing the 4 iomux sources of the bank |
| * @drv: array describing the 4 drive strength sources of the bank |
| * @pull_type: array describing the 4 pull type sources of the bank |
| * @valid: is all necessary information present |
| * @of_node: dt node of this bank |
| * @drvdata: common pinctrl basedata |
| * @domain: irqdomain of the gpio bank |
| * @gpio_chip: gpiolib chip |
| * @grange: gpio range |
| * @slock: spinlock for the gpio bank |
| * @route_mask: bits describing the routing pins of per bank |
| */ |
| struct rockchip_pin_bank { |
| void __iomem *reg_base; |
| struct regmap *regmap_pull; |
| struct clk *clk; |
| int irq; |
| u32 saved_masks; |
| u32 pin_base; |
| u8 nr_pins; |
| char *name; |
| u8 bank_num; |
| struct rockchip_iomux iomux[4]; |
| struct rockchip_drv drv[4]; |
| enum rockchip_pin_pull_type pull_type[4]; |
| bool valid; |
| struct device_node *of_node; |
| struct rockchip_pinctrl *drvdata; |
| struct irq_domain *domain; |
| struct gpio_chip gpio_chip; |
| struct pinctrl_gpio_range grange; |
| raw_spinlock_t slock; |
| u32 toggle_edge_mode; |
| u32 recalced_mask; |
| u32 route_mask; |
| }; |
| |
| #define PIN_BANK(id, pins, label) \ |
| { \ |
| .bank_num = id, \ |
| .nr_pins = pins, \ |
| .name = label, \ |
| .iomux = { \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| }, \ |
| } |
| |
| #define PIN_BANK_IOMUX_FLAGS(id, pins, label, iom0, iom1, iom2, iom3) \ |
| { \ |
| .bank_num = id, \ |
| .nr_pins = pins, \ |
| .name = label, \ |
| .iomux = { \ |
| { .type = iom0, .offset = -1 }, \ |
| { .type = iom1, .offset = -1 }, \ |
| { .type = iom2, .offset = -1 }, \ |
| { .type = iom3, .offset = -1 }, \ |
| }, \ |
| } |
| |
| #define PIN_BANK_DRV_FLAGS(id, pins, label, type0, type1, type2, type3) \ |
| { \ |
| .bank_num = id, \ |
| .nr_pins = pins, \ |
| .name = label, \ |
| .iomux = { \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| }, \ |
| .drv = { \ |
| { .drv_type = type0, .offset = -1 }, \ |
| { .drv_type = type1, .offset = -1 }, \ |
| { .drv_type = type2, .offset = -1 }, \ |
| { .drv_type = type3, .offset = -1 }, \ |
| }, \ |
| } |
| |
| #define PIN_BANK_DRV_FLAGS_PULL_FLAGS(id, pins, label, drv0, drv1, \ |
| drv2, drv3, pull0, pull1, \ |
| pull2, pull3) \ |
| { \ |
| .bank_num = id, \ |
| .nr_pins = pins, \ |
| .name = label, \ |
| .iomux = { \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| { .offset = -1 }, \ |
| }, \ |
| .drv = { \ |
| { .drv_type = drv0, .offset = -1 }, \ |
| { .drv_type = drv1, .offset = -1 }, \ |
| { .drv_type = drv2, .offset = -1 }, \ |
| { .drv_type = drv3, .offset = -1 }, \ |
| }, \ |
| .pull_type[0] = pull0, \ |
| .pull_type[1] = pull1, \ |
| .pull_type[2] = pull2, \ |
| .pull_type[3] = pull3, \ |
| } |
| |
| #define PIN_BANK_IOMUX_DRV_FLAGS_OFFSET(id, pins, label, iom0, iom1, \ |
| iom2, iom3, drv0, drv1, drv2, \ |
| drv3, offset0, offset1, \ |
| offset2, offset3) \ |
| { \ |
| .bank_num = id, \ |
| .nr_pins = pins, \ |
| .name = label, \ |
| .iomux = { \ |
| { .type = iom0, .offset = -1 }, \ |
| { .type = iom1, .offset = -1 }, \ |
| { .type = iom2, .offset = -1 }, \ |
| { .type = iom3, .offset = -1 }, \ |
| }, \ |
| .drv = { \ |
| { .drv_type = drv0, .offset = offset0 }, \ |
| { .drv_type = drv1, .offset = offset1 }, \ |
| { .drv_type = drv2, .offset = offset2 }, \ |
| { .drv_type = drv3, .offset = offset3 }, \ |
| }, \ |
| } |
| |
| #define PIN_BANK_IOMUX_FLAGS_DRV_FLAGS_OFFSET_PULL_FLAGS(id, pins, \ |
| label, iom0, iom1, iom2, \ |
| iom3, drv0, drv1, drv2, \ |
| drv3, offset0, offset1, \ |
| offset2, offset3, pull0, \ |
| pull1, pull2, pull3) \ |
| { \ |
| .bank_num = id, \ |
| .nr_pins = pins, \ |
| .name = label, \ |
| .iomux = { \ |
| { .type = iom0, .offset = -1 }, \ |
| { .type = iom1, .offset = -1 }, \ |
| { .type = iom2, .offset = -1 }, \ |
| { .type = iom3, .offset = -1 }, \ |
| }, \ |
| .drv = { \ |
| { .drv_type = drv0, .offset = offset0 }, \ |
| { .drv_type = drv1, .offset = offset1 }, \ |
| { .drv_type = drv2, .offset = offset2 }, \ |
| { .drv_type = drv3, .offset = offset3 }, \ |
| }, \ |
| .pull_type[0] = pull0, \ |
| .pull_type[1] = pull1, \ |
| .pull_type[2] = pull2, \ |
| .pull_type[3] = pull3, \ |
| } |
| |
| /** |
| * struct rockchip_mux_recalced_data: represent a pin iomux data. |
| * @num: bank number. |
| * @pin: pin number. |
| * @bit: index at register. |
| * @reg: register offset. |
| * @mask: mask bit |
| */ |
| struct rockchip_mux_recalced_data { |
| u8 num; |
| u8 pin; |
| u32 reg; |
| u8 bit; |
| u8 mask; |
| }; |
| |
| enum rockchip_mux_route_location { |
| ROCKCHIP_ROUTE_SAME = 0, |
| ROCKCHIP_ROUTE_PMU, |
| ROCKCHIP_ROUTE_GRF, |
| }; |
| |
| /** |
| * struct rockchip_mux_recalced_data: represent a pin iomux data. |
| * @bank_num: bank number. |
| * @pin: index at register or used to calc index. |
| * @func: the min pin. |
| * @route_offset: the max pin. |
| * @route_val: the register offset. |
| */ |
| struct rockchip_mux_route_data { |
| u8 bank_num; |
| u8 pin; |
| u8 func; |
| enum rockchip_mux_route_location route_location; |
| u32 route_offset; |
| u32 route_val; |
| }; |
| |
| /** |
| */ |
| struct rockchip_pin_ctrl { |
| struct rockchip_pin_bank *pin_banks; |
| u32 nr_banks; |
| u32 nr_pins; |
| char *label; |
| enum rockchip_pinctrl_type type; |
| int grf_mux_offset; |
| int pmu_mux_offset; |
| int grf_drv_offset; |
| int pmu_drv_offset; |
| struct rockchip_mux_recalced_data *iomux_recalced; |
| u32 niomux_recalced; |
| struct rockchip_mux_route_data *iomux_routes; |
| u32 niomux_routes; |
| |
| void (*pull_calc_reg)(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit); |
| void (*drv_calc_reg)(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit); |
| int (*schmitt_calc_reg)(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit); |
| }; |
| |
| struct rockchip_pin_config { |
| unsigned int func; |
| unsigned long *configs; |
| unsigned int nconfigs; |
| }; |
| |
| /** |
| * struct rockchip_pin_group: represent group of pins of a pinmux function. |
| * @name: name of the pin group, used to lookup the group. |
| * @pins: the pins included in this group. |
| * @npins: number of pins included in this group. |
| * @func: the mux function number to be programmed when selected. |
| * @configs: the config values to be set for each pin |
| * @nconfigs: number of configs for each pin |
| */ |
| struct rockchip_pin_group { |
| const char *name; |
| unsigned int npins; |
| unsigned int *pins; |
| struct rockchip_pin_config *data; |
| }; |
| |
| /** |
| * struct rockchip_pmx_func: represent a pin function. |
| * @name: name of the pin function, used to lookup the function. |
| * @groups: one or more names of pin groups that provide this function. |
| * @num_groups: number of groups included in @groups. |
| */ |
| struct rockchip_pmx_func { |
| const char *name; |
| const char **groups; |
| u8 ngroups; |
| }; |
| |
| struct rockchip_pinctrl { |
| struct regmap *regmap_base; |
| int reg_size; |
| struct regmap *regmap_pull; |
| struct regmap *regmap_pmu; |
| struct device *dev; |
| struct rockchip_pin_ctrl *ctrl; |
| struct pinctrl_desc pctl; |
| struct pinctrl_dev *pctl_dev; |
| struct rockchip_pin_group *groups; |
| unsigned int ngroups; |
| struct rockchip_pmx_func *functions; |
| unsigned int nfunctions; |
| }; |
| |
| static struct regmap_config rockchip_regmap_config = { |
| .reg_bits = 32, |
| .val_bits = 32, |
| .reg_stride = 4, |
| }; |
| |
| static inline const struct rockchip_pin_group *pinctrl_name_to_group( |
| const struct rockchip_pinctrl *info, |
| const char *name) |
| { |
| int i; |
| |
| for (i = 0; i < info->ngroups; i++) { |
| if (!strcmp(info->groups[i].name, name)) |
| return &info->groups[i]; |
| } |
| |
| return NULL; |
| } |
| |
| /* |
| * given a pin number that is local to a pin controller, find out the pin bank |
| * and the register base of the pin bank. |
| */ |
| static struct rockchip_pin_bank *pin_to_bank(struct rockchip_pinctrl *info, |
| unsigned pin) |
| { |
| struct rockchip_pin_bank *b = info->ctrl->pin_banks; |
| |
| while (pin >= (b->pin_base + b->nr_pins)) |
| b++; |
| |
| return b; |
| } |
| |
| static struct rockchip_pin_bank *bank_num_to_bank( |
| struct rockchip_pinctrl *info, |
| unsigned num) |
| { |
| struct rockchip_pin_bank *b = info->ctrl->pin_banks; |
| int i; |
| |
| for (i = 0; i < info->ctrl->nr_banks; i++, b++) { |
| if (b->bank_num == num) |
| return b; |
| } |
| |
| return ERR_PTR(-EINVAL); |
| } |
| |
| /* |
| * Pinctrl_ops handling |
| */ |
| |
| static int rockchip_get_groups_count(struct pinctrl_dev *pctldev) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| |
| return info->ngroups; |
| } |
| |
| static const char *rockchip_get_group_name(struct pinctrl_dev *pctldev, |
| unsigned selector) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| |
| return info->groups[selector].name; |
| } |
| |
| static int rockchip_get_group_pins(struct pinctrl_dev *pctldev, |
| unsigned selector, const unsigned **pins, |
| unsigned *npins) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| |
| if (selector >= info->ngroups) |
| return -EINVAL; |
| |
| *pins = info->groups[selector].pins; |
| *npins = info->groups[selector].npins; |
| |
| return 0; |
| } |
| |
| static int rockchip_dt_node_to_map(struct pinctrl_dev *pctldev, |
| struct device_node *np, |
| struct pinctrl_map **map, unsigned *num_maps) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| const struct rockchip_pin_group *grp; |
| struct pinctrl_map *new_map; |
| struct device_node *parent; |
| int map_num = 1; |
| int i; |
| |
| /* |
| * first find the group of this node and check if we need to create |
| * config maps for pins |
| */ |
| grp = pinctrl_name_to_group(info, np->name); |
| if (!grp) { |
| dev_err(info->dev, "unable to find group for node %pOFn\n", |
| np); |
| return -EINVAL; |
| } |
| |
| map_num += grp->npins; |
| new_map = devm_kcalloc(pctldev->dev, map_num, sizeof(*new_map), |
| GFP_KERNEL); |
| if (!new_map) |
| return -ENOMEM; |
| |
| *map = new_map; |
| *num_maps = map_num; |
| |
| /* create mux map */ |
| parent = of_get_parent(np); |
| if (!parent) { |
| devm_kfree(pctldev->dev, new_map); |
| return -EINVAL; |
| } |
| new_map[0].type = PIN_MAP_TYPE_MUX_GROUP; |
| new_map[0].data.mux.function = parent->name; |
| new_map[0].data.mux.group = np->name; |
| of_node_put(parent); |
| |
| /* create config map */ |
| new_map++; |
| for (i = 0; i < grp->npins; i++) { |
| new_map[i].type = PIN_MAP_TYPE_CONFIGS_PIN; |
| new_map[i].data.configs.group_or_pin = |
| pin_get_name(pctldev, grp->pins[i]); |
| new_map[i].data.configs.configs = grp->data[i].configs; |
| new_map[i].data.configs.num_configs = grp->data[i].nconfigs; |
| } |
| |
| dev_dbg(pctldev->dev, "maps: function %s group %s num %d\n", |
| (*map)->data.mux.function, (*map)->data.mux.group, map_num); |
| |
| return 0; |
| } |
| |
| static void rockchip_dt_free_map(struct pinctrl_dev *pctldev, |
| struct pinctrl_map *map, unsigned num_maps) |
| { |
| } |
| |
| static const struct pinctrl_ops rockchip_pctrl_ops = { |
| .get_groups_count = rockchip_get_groups_count, |
| .get_group_name = rockchip_get_group_name, |
| .get_group_pins = rockchip_get_group_pins, |
| .dt_node_to_map = rockchip_dt_node_to_map, |
| .dt_free_map = rockchip_dt_free_map, |
| }; |
| |
| /* |
| * Hardware access |
| */ |
| |
| static struct rockchip_mux_recalced_data rv1108_mux_recalced_data[] = { |
| { |
| .num = 1, |
| .pin = 0, |
| .reg = 0x418, |
| .bit = 0, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 1, |
| .reg = 0x418, |
| .bit = 2, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 2, |
| .reg = 0x418, |
| .bit = 4, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 3, |
| .reg = 0x418, |
| .bit = 6, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 4, |
| .reg = 0x418, |
| .bit = 8, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 5, |
| .reg = 0x418, |
| .bit = 10, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 6, |
| .reg = 0x418, |
| .bit = 12, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 7, |
| .reg = 0x418, |
| .bit = 14, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 8, |
| .reg = 0x41c, |
| .bit = 0, |
| .mask = 0x3 |
| }, { |
| .num = 1, |
| .pin = 9, |
| .reg = 0x41c, |
| .bit = 2, |
| .mask = 0x3 |
| }, |
| }; |
| |
| static struct rockchip_mux_recalced_data rk3128_mux_recalced_data[] = { |
| { |
| .num = 2, |
| .pin = 20, |
| .reg = 0xe8, |
| .bit = 0, |
| .mask = 0x7 |
| }, { |
| .num = 2, |
| .pin = 21, |
| .reg = 0xe8, |
| .bit = 4, |
| .mask = 0x7 |
| }, { |
| .num = 2, |
| .pin = 22, |
| .reg = 0xe8, |
| .bit = 8, |
| .mask = 0x7 |
| }, { |
| .num = 2, |
| .pin = 23, |
| .reg = 0xe8, |
| .bit = 12, |
| .mask = 0x7 |
| }, { |
| .num = 2, |
| .pin = 24, |
| .reg = 0xd4, |
| .bit = 12, |
| .mask = 0x7 |
| }, |
| }; |
| |
| static struct rockchip_mux_recalced_data rk3328_mux_recalced_data[] = { |
| { |
| .num = 2, |
| .pin = 12, |
| .reg = 0x24, |
| .bit = 8, |
| .mask = 0x3 |
| }, { |
| .num = 2, |
| .pin = 15, |
| .reg = 0x28, |
| .bit = 0, |
| .mask = 0x7 |
| }, { |
| .num = 2, |
| .pin = 23, |
| .reg = 0x30, |
| .bit = 14, |
| .mask = 0x3 |
| }, |
| }; |
| |
| static void rockchip_get_recalced_mux(struct rockchip_pin_bank *bank, int pin, |
| int *reg, u8 *bit, int *mask) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct rockchip_mux_recalced_data *data; |
| int i; |
| |
| for (i = 0; i < ctrl->niomux_recalced; i++) { |
| data = &ctrl->iomux_recalced[i]; |
| if (data->num == bank->bank_num && |
| data->pin == pin) |
| break; |
| } |
| |
| if (i >= ctrl->niomux_recalced) |
| return; |
| |
| *reg = data->reg; |
| *mask = data->mask; |
| *bit = data->bit; |
| } |
| |
| static struct rockchip_mux_route_data px30_mux_route_data[] = { |
| { |
| /* cif-d2m0 */ |
| .bank_num = 2, |
| .pin = 0, |
| .func = 1, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 7), |
| }, { |
| /* cif-d2m1 */ |
| .bank_num = 3, |
| .pin = 3, |
| .func = 3, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 7) | BIT(7), |
| }, { |
| /* pdm-m0 */ |
| .bank_num = 3, |
| .pin = 22, |
| .func = 2, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 8), |
| }, { |
| /* pdm-m1 */ |
| .bank_num = 2, |
| .pin = 22, |
| .func = 1, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 8) | BIT(8), |
| }, { |
| /* uart2-rxm0 */ |
| .bank_num = 1, |
| .pin = 27, |
| .func = 2, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 10), |
| }, { |
| /* uart2-rxm1 */ |
| .bank_num = 2, |
| .pin = 14, |
| .func = 2, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 10) | BIT(10), |
| }, { |
| /* uart3-rxm0 */ |
| .bank_num = 0, |
| .pin = 17, |
| .func = 2, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 9), |
| }, { |
| /* uart3-rxm1 */ |
| .bank_num = 1, |
| .pin = 15, |
| .func = 2, |
| .route_offset = 0x184, |
| .route_val = BIT(16 + 9) | BIT(9), |
| }, |
| }; |
| |
| static struct rockchip_mux_route_data rk3128_mux_route_data[] = { |
| { |
| /* spi-0 */ |
| .bank_num = 1, |
| .pin = 10, |
| .func = 1, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 3) | BIT(16 + 4), |
| }, { |
| /* spi-1 */ |
| .bank_num = 1, |
| .pin = 27, |
| .func = 3, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 3) | BIT(16 + 4) | BIT(3), |
| }, { |
| /* spi-2 */ |
| .bank_num = 0, |
| .pin = 13, |
| .func = 2, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 3) | BIT(16 + 4) | BIT(4), |
| }, { |
| /* i2s-0 */ |
| .bank_num = 1, |
| .pin = 5, |
| .func = 1, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 5), |
| }, { |
| /* i2s-1 */ |
| .bank_num = 0, |
| .pin = 14, |
| .func = 1, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 5) | BIT(5), |
| }, { |
| /* emmc-0 */ |
| .bank_num = 1, |
| .pin = 22, |
| .func = 2, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 6), |
| }, { |
| /* emmc-1 */ |
| .bank_num = 2, |
| .pin = 4, |
| .func = 2, |
| .route_offset = 0x144, |
| .route_val = BIT(16 + 6) | BIT(6), |
| }, |
| }; |
| |
| static struct rockchip_mux_route_data rk3188_mux_route_data[] = { |
| { |
| /* non-iomuxed emmc/flash pins on flash-dqs */ |
| .bank_num = 0, |
| .pin = 24, |
| .func = 1, |
| .route_location = ROCKCHIP_ROUTE_GRF, |
| .route_offset = 0xa0, |
| .route_val = BIT(16 + 11), |
| }, { |
| /* non-iomuxed emmc/flash pins on emmc-clk */ |
| .bank_num = 0, |
| .pin = 24, |
| .func = 2, |
| .route_location = ROCKCHIP_ROUTE_GRF, |
| .route_offset = 0xa0, |
| .route_val = BIT(16 + 11) | BIT(11), |
| }, |
| }; |
| |
| static struct rockchip_mux_route_data rk3228_mux_route_data[] = { |
| { |
| /* pwm0-0 */ |
| .bank_num = 0, |
| .pin = 26, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16), |
| }, { |
| /* pwm0-1 */ |
| .bank_num = 3, |
| .pin = 21, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16) | BIT(0), |
| }, { |
| /* pwm1-0 */ |
| .bank_num = 0, |
| .pin = 27, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 1), |
| }, { |
| /* pwm1-1 */ |
| .bank_num = 0, |
| .pin = 30, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 1) | BIT(1), |
| }, { |
| /* pwm2-0 */ |
| .bank_num = 0, |
| .pin = 28, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 2), |
| }, { |
| /* pwm2-1 */ |
| .bank_num = 1, |
| .pin = 12, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 2) | BIT(2), |
| }, { |
| /* pwm3-0 */ |
| .bank_num = 3, |
| .pin = 26, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 3), |
| }, { |
| /* pwm3-1 */ |
| .bank_num = 1, |
| .pin = 11, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 3) | BIT(3), |
| }, { |
| /* sdio-0_d0 */ |
| .bank_num = 1, |
| .pin = 1, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 4), |
| }, { |
| /* sdio-1_d0 */ |
| .bank_num = 3, |
| .pin = 2, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 4) | BIT(4), |
| }, { |
| /* spi-0_rx */ |
| .bank_num = 0, |
| .pin = 13, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 5), |
| }, { |
| /* spi-1_rx */ |
| .bank_num = 2, |
| .pin = 0, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 5) | BIT(5), |
| }, { |
| /* emmc-0_cmd */ |
| .bank_num = 1, |
| .pin = 22, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 7), |
| }, { |
| /* emmc-1_cmd */ |
| .bank_num = 2, |
| .pin = 4, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 7) | BIT(7), |
| }, { |
| /* uart2-0_rx */ |
| .bank_num = 1, |
| .pin = 19, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 8), |
| }, { |
| /* uart2-1_rx */ |
| .bank_num = 1, |
| .pin = 10, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 8) | BIT(8), |
| }, { |
| /* uart1-0_rx */ |
| .bank_num = 1, |
| .pin = 10, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 11), |
| }, { |
| /* uart1-1_rx */ |
| .bank_num = 3, |
| .pin = 13, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 11) | BIT(11), |
| }, |
| }; |
| |
| static struct rockchip_mux_route_data rk3288_mux_route_data[] = { |
| { |
| /* edphdmi_cecinoutt1 */ |
| .bank_num = 7, |
| .pin = 16, |
| .func = 2, |
| .route_offset = 0x264, |
| .route_val = BIT(16 + 12) | BIT(12), |
| }, { |
| /* edphdmi_cecinout */ |
| .bank_num = 7, |
| .pin = 23, |
| .func = 4, |
| .route_offset = 0x264, |
| .route_val = BIT(16 + 12), |
| }, |
| }; |
| |
| static struct rockchip_mux_route_data rk3328_mux_route_data[] = { |
| { |
| /* uart2dbg_rxm0 */ |
| .bank_num = 1, |
| .pin = 1, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16) | BIT(16 + 1), |
| }, { |
| /* uart2dbg_rxm1 */ |
| .bank_num = 2, |
| .pin = 1, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16) | BIT(16 + 1) | BIT(0), |
| }, { |
| /* gmac-m1_rxd0 */ |
| .bank_num = 1, |
| .pin = 11, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 2) | BIT(2), |
| }, { |
| /* gmac-m1-optimized_rxd3 */ |
| .bank_num = 1, |
| .pin = 14, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 10) | BIT(10), |
| }, { |
| /* pdm_sdi0m0 */ |
| .bank_num = 2, |
| .pin = 19, |
| .func = 2, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 3), |
| }, { |
| /* pdm_sdi0m1 */ |
| .bank_num = 1, |
| .pin = 23, |
| .func = 3, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 3) | BIT(3), |
| }, { |
| /* spi_rxdm2 */ |
| .bank_num = 3, |
| .pin = 2, |
| .func = 4, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 4) | BIT(16 + 5) | BIT(5), |
| }, { |
| /* i2s2_sdim0 */ |
| .bank_num = 1, |
| .pin = 24, |
| .func = 1, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 6), |
| }, { |
| /* i2s2_sdim1 */ |
| .bank_num = 3, |
| .pin = 2, |
| .func = 6, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 6) | BIT(6), |
| }, { |
| /* card_iom1 */ |
| .bank_num = 2, |
| .pin = 22, |
| .func = 3, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 7) | BIT(7), |
| }, { |
| /* tsp_d5m1 */ |
| .bank_num = 2, |
| .pin = 16, |
| .func = 3, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 8) | BIT(8), |
| }, { |
| /* cif_data5m1 */ |
| .bank_num = 2, |
| .pin = 16, |
| .func = 4, |
| .route_offset = 0x50, |
| .route_val = BIT(16 + 9) | BIT(9), |
| }, |
| }; |
| |
| static struct rockchip_mux_route_data rk3399_mux_route_data[] = { |
| { |
| /* uart2dbga_rx */ |
| .bank_num = 4, |
| .pin = 8, |
| .func = 2, |
| .route_offset = 0xe21c, |
| .route_val = BIT(16 + 10) | BIT(16 + 11), |
| }, { |
| /* uart2dbgb_rx */ |
| .bank_num = 4, |
| .pin = 16, |
| .func = 2, |
| .route_offset = 0xe21c, |
| .route_val = BIT(16 + 10) | BIT(16 + 11) | BIT(10), |
| }, { |
| /* uart2dbgc_rx */ |
| .bank_num = 4, |
| .pin = 19, |
| .func = 1, |
| .route_offset = 0xe21c, |
| .route_val = BIT(16 + 10) | BIT(16 + 11) | BIT(11), |
| }, { |
| /* pcie_clkreqn */ |
| .bank_num = 2, |
| .pin = 26, |
| .func = 2, |
| .route_offset = 0xe21c, |
| .route_val = BIT(16 + 14), |
| }, { |
| /* pcie_clkreqnb */ |
| .bank_num = 4, |
| .pin = 24, |
| .func = 1, |
| .route_offset = 0xe21c, |
| .route_val = BIT(16 + 14) | BIT(14), |
| }, |
| }; |
| |
| static bool rockchip_get_mux_route(struct rockchip_pin_bank *bank, int pin, |
| int mux, u32 *loc, u32 *reg, u32 *value) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct rockchip_mux_route_data *data; |
| int i; |
| |
| for (i = 0; i < ctrl->niomux_routes; i++) { |
| data = &ctrl->iomux_routes[i]; |
| if ((data->bank_num == bank->bank_num) && |
| (data->pin == pin) && (data->func == mux)) |
| break; |
| } |
| |
| if (i >= ctrl->niomux_routes) |
| return false; |
| |
| *loc = data->route_location; |
| *reg = data->route_offset; |
| *value = data->route_val; |
| |
| return true; |
| } |
| |
| static int rockchip_get_mux(struct rockchip_pin_bank *bank, int pin) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| int iomux_num = (pin / 8); |
| struct regmap *regmap; |
| unsigned int val; |
| int reg, ret, mask, mux_type; |
| u8 bit; |
| |
| if (iomux_num > 3) |
| return -EINVAL; |
| |
| if (bank->iomux[iomux_num].type & IOMUX_UNROUTED) { |
| dev_err(info->dev, "pin %d is unrouted\n", pin); |
| return -EINVAL; |
| } |
| |
| if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY) |
| return RK_FUNC_GPIO; |
| |
| regmap = (bank->iomux[iomux_num].type & IOMUX_SOURCE_PMU) |
| ? info->regmap_pmu : info->regmap_base; |
| |
| /* get basic quadrupel of mux registers and the correct reg inside */ |
| mux_type = bank->iomux[iomux_num].type; |
| reg = bank->iomux[iomux_num].offset; |
| if (mux_type & IOMUX_WIDTH_4BIT) { |
| if ((pin % 8) >= 4) |
| reg += 0x4; |
| bit = (pin % 4) * 4; |
| mask = 0xf; |
| } else if (mux_type & IOMUX_WIDTH_3BIT) { |
| if ((pin % 8) >= 5) |
| reg += 0x4; |
| bit = (pin % 8 % 5) * 3; |
| mask = 0x7; |
| } else { |
| bit = (pin % 8) * 2; |
| mask = 0x3; |
| } |
| |
| if (bank->recalced_mask & BIT(pin)) |
| rockchip_get_recalced_mux(bank, pin, ®, &bit, &mask); |
| |
| ret = regmap_read(regmap, reg, &val); |
| if (ret) |
| return ret; |
| |
| return ((val >> bit) & mask); |
| } |
| |
| static int rockchip_verify_mux(struct rockchip_pin_bank *bank, |
| int pin, int mux) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| int iomux_num = (pin / 8); |
| |
| if (iomux_num > 3) |
| return -EINVAL; |
| |
| if (bank->iomux[iomux_num].type & IOMUX_UNROUTED) { |
| dev_err(info->dev, "pin %d is unrouted\n", pin); |
| return -EINVAL; |
| } |
| |
| if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY) { |
| if (mux != RK_FUNC_GPIO) { |
| dev_err(info->dev, |
| "pin %d only supports a gpio mux\n", pin); |
| return -ENOTSUPP; |
| } |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * Set a new mux function for a pin. |
| * |
| * The register is divided into the upper and lower 16 bit. When changing |
| * a value, the previous register value is not read and changed. Instead |
| * it seems the changed bits are marked in the upper 16 bit, while the |
| * changed value gets set in the same offset in the lower 16 bit. |
| * All pin settings seem to be 2 bit wide in both the upper and lower |
| * parts. |
| * @bank: pin bank to change |
| * @pin: pin to change |
| * @mux: new mux function to set |
| */ |
| static int rockchip_set_mux(struct rockchip_pin_bank *bank, int pin, int mux) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| int iomux_num = (pin / 8); |
| struct regmap *regmap; |
| int reg, ret, mask, mux_type; |
| u8 bit; |
| u32 data, rmask, route_location, route_reg, route_val; |
| |
| ret = rockchip_verify_mux(bank, pin, mux); |
| if (ret < 0) |
| return ret; |
| |
| if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY) |
| return 0; |
| |
| dev_dbg(info->dev, "setting mux of GPIO%d-%d to %d\n", |
| bank->bank_num, pin, mux); |
| |
| regmap = (bank->iomux[iomux_num].type & IOMUX_SOURCE_PMU) |
| ? info->regmap_pmu : info->regmap_base; |
| |
| /* get basic quadrupel of mux registers and the correct reg inside */ |
| mux_type = bank->iomux[iomux_num].type; |
| reg = bank->iomux[iomux_num].offset; |
| if (mux_type & IOMUX_WIDTH_4BIT) { |
| if ((pin % 8) >= 4) |
| reg += 0x4; |
| bit = (pin % 4) * 4; |
| mask = 0xf; |
| } else if (mux_type & IOMUX_WIDTH_3BIT) { |
| if ((pin % 8) >= 5) |
| reg += 0x4; |
| bit = (pin % 8 % 5) * 3; |
| mask = 0x7; |
| } else { |
| bit = (pin % 8) * 2; |
| mask = 0x3; |
| } |
| |
| if (bank->recalced_mask & BIT(pin)) |
| rockchip_get_recalced_mux(bank, pin, ®, &bit, &mask); |
| |
| if (bank->route_mask & BIT(pin)) { |
| if (rockchip_get_mux_route(bank, pin, mux, &route_location, |
| &route_reg, &route_val)) { |
| struct regmap *route_regmap = regmap; |
| |
| /* handle special locations */ |
| switch (route_location) { |
| case ROCKCHIP_ROUTE_PMU: |
| route_regmap = info->regmap_pmu; |
| break; |
| case ROCKCHIP_ROUTE_GRF: |
| route_regmap = info->regmap_base; |
| break; |
| } |
| |
| ret = regmap_write(route_regmap, route_reg, route_val); |
| if (ret) |
| return ret; |
| } |
| } |
| |
| data = (mask << (bit + 16)); |
| rmask = data | (data >> 16); |
| data |= (mux & mask) << bit; |
| ret = regmap_update_bits(regmap, reg, rmask, data); |
| |
| return ret; |
| } |
| |
| #define PX30_PULL_PMU_OFFSET 0x10 |
| #define PX30_PULL_GRF_OFFSET 0x60 |
| #define PX30_PULL_BITS_PER_PIN 2 |
| #define PX30_PULL_PINS_PER_REG 8 |
| #define PX30_PULL_BANK_STRIDE 16 |
| |
| static void px30_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 32 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = PX30_PULL_PMU_OFFSET; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = PX30_PULL_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * PX30_PULL_BANK_STRIDE; |
| } |
| |
| *reg += ((pin_num / PX30_PULL_PINS_PER_REG) * 4); |
| *bit = (pin_num % PX30_PULL_PINS_PER_REG); |
| *bit *= PX30_PULL_BITS_PER_PIN; |
| } |
| |
| #define PX30_DRV_PMU_OFFSET 0x20 |
| #define PX30_DRV_GRF_OFFSET 0xf0 |
| #define PX30_DRV_BITS_PER_PIN 2 |
| #define PX30_DRV_PINS_PER_REG 8 |
| #define PX30_DRV_BANK_STRIDE 16 |
| |
| static void px30_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 32 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = PX30_DRV_PMU_OFFSET; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = PX30_DRV_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * PX30_DRV_BANK_STRIDE; |
| } |
| |
| *reg += ((pin_num / PX30_DRV_PINS_PER_REG) * 4); |
| *bit = (pin_num % PX30_DRV_PINS_PER_REG); |
| *bit *= PX30_DRV_BITS_PER_PIN; |
| } |
| |
| #define PX30_SCHMITT_PMU_OFFSET 0x38 |
| #define PX30_SCHMITT_GRF_OFFSET 0xc0 |
| #define PX30_SCHMITT_PINS_PER_PMU_REG 16 |
| #define PX30_SCHMITT_BANK_STRIDE 16 |
| #define PX30_SCHMITT_PINS_PER_GRF_REG 8 |
| |
| static int px30_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, |
| struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| int pins_per_reg; |
| |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = PX30_SCHMITT_PMU_OFFSET; |
| pins_per_reg = PX30_SCHMITT_PINS_PER_PMU_REG; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = PX30_SCHMITT_GRF_OFFSET; |
| pins_per_reg = PX30_SCHMITT_PINS_PER_GRF_REG; |
| *reg += (bank->bank_num - 1) * PX30_SCHMITT_BANK_STRIDE; |
| } |
| |
| *reg += ((pin_num / pins_per_reg) * 4); |
| *bit = pin_num % pins_per_reg; |
| |
| return 0; |
| } |
| |
| #define RV1108_PULL_PMU_OFFSET 0x10 |
| #define RV1108_PULL_OFFSET 0x110 |
| #define RV1108_PULL_PINS_PER_REG 8 |
| #define RV1108_PULL_BITS_PER_PIN 2 |
| #define RV1108_PULL_BANK_STRIDE 16 |
| |
| static void rv1108_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 24 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RV1108_PULL_PMU_OFFSET; |
| } else { |
| *reg = RV1108_PULL_OFFSET; |
| *regmap = info->regmap_base; |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * RV1108_PULL_BANK_STRIDE; |
| } |
| |
| *reg += ((pin_num / RV1108_PULL_PINS_PER_REG) * 4); |
| *bit = (pin_num % RV1108_PULL_PINS_PER_REG); |
| *bit *= RV1108_PULL_BITS_PER_PIN; |
| } |
| |
| #define RV1108_DRV_PMU_OFFSET 0x20 |
| #define RV1108_DRV_GRF_OFFSET 0x210 |
| #define RV1108_DRV_BITS_PER_PIN 2 |
| #define RV1108_DRV_PINS_PER_REG 8 |
| #define RV1108_DRV_BANK_STRIDE 16 |
| |
| static void rv1108_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 24 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RV1108_DRV_PMU_OFFSET; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RV1108_DRV_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * RV1108_DRV_BANK_STRIDE; |
| } |
| |
| *reg += ((pin_num / RV1108_DRV_PINS_PER_REG) * 4); |
| *bit = pin_num % RV1108_DRV_PINS_PER_REG; |
| *bit *= RV1108_DRV_BITS_PER_PIN; |
| } |
| |
| #define RV1108_SCHMITT_PMU_OFFSET 0x30 |
| #define RV1108_SCHMITT_GRF_OFFSET 0x388 |
| #define RV1108_SCHMITT_BANK_STRIDE 8 |
| #define RV1108_SCHMITT_PINS_PER_GRF_REG 16 |
| #define RV1108_SCHMITT_PINS_PER_PMU_REG 8 |
| |
| static int rv1108_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, |
| struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| int pins_per_reg; |
| |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RV1108_SCHMITT_PMU_OFFSET; |
| pins_per_reg = RV1108_SCHMITT_PINS_PER_PMU_REG; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RV1108_SCHMITT_GRF_OFFSET; |
| pins_per_reg = RV1108_SCHMITT_PINS_PER_GRF_REG; |
| *reg += (bank->bank_num - 1) * RV1108_SCHMITT_BANK_STRIDE; |
| } |
| *reg += ((pin_num / pins_per_reg) * 4); |
| *bit = pin_num % pins_per_reg; |
| |
| return 0; |
| } |
| |
| #define RK2928_PULL_OFFSET 0x118 |
| #define RK2928_PULL_PINS_PER_REG 16 |
| #define RK2928_PULL_BANK_STRIDE 8 |
| |
| static void rk2928_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| *regmap = info->regmap_base; |
| *reg = RK2928_PULL_OFFSET; |
| *reg += bank->bank_num * RK2928_PULL_BANK_STRIDE; |
| *reg += (pin_num / RK2928_PULL_PINS_PER_REG) * 4; |
| |
| *bit = pin_num % RK2928_PULL_PINS_PER_REG; |
| }; |
| |
| #define RK3128_PULL_OFFSET 0x118 |
| |
| static void rk3128_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| *regmap = info->regmap_base; |
| *reg = RK3128_PULL_OFFSET; |
| *reg += bank->bank_num * RK2928_PULL_BANK_STRIDE; |
| *reg += ((pin_num / RK2928_PULL_PINS_PER_REG) * 4); |
| |
| *bit = pin_num % RK2928_PULL_PINS_PER_REG; |
| } |
| |
| #define RK3188_PULL_OFFSET 0x164 |
| #define RK3188_PULL_BITS_PER_PIN 2 |
| #define RK3188_PULL_PINS_PER_REG 8 |
| #define RK3188_PULL_BANK_STRIDE 16 |
| #define RK3188_PULL_PMU_OFFSET 0x64 |
| |
| static void rk3188_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 12 pins of the first bank are located elsewhere */ |
| if (bank->bank_num == 0 && pin_num < 12) { |
| *regmap = info->regmap_pmu ? info->regmap_pmu |
| : bank->regmap_pull; |
| *reg = info->regmap_pmu ? RK3188_PULL_PMU_OFFSET : 0; |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3188_PULL_PINS_PER_REG; |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } else { |
| *regmap = info->regmap_pull ? info->regmap_pull |
| : info->regmap_base; |
| *reg = info->regmap_pull ? 0 : RK3188_PULL_OFFSET; |
| |
| /* correct the offset, as it is the 2nd pull register */ |
| *reg -= 4; |
| *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE; |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| |
| /* |
| * The bits in these registers have an inverse ordering |
| * with the lowest pin being in bits 15:14 and the highest |
| * pin in bits 1:0 |
| */ |
| *bit = 7 - (pin_num % RK3188_PULL_PINS_PER_REG); |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } |
| } |
| |
| #define RK3288_PULL_OFFSET 0x140 |
| static void rk3288_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 24 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RK3188_PULL_PMU_OFFSET; |
| |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3188_PULL_PINS_PER_REG; |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RK3288_PULL_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE; |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } |
| } |
| |
| #define RK3288_DRV_PMU_OFFSET 0x70 |
| #define RK3288_DRV_GRF_OFFSET 0x1c0 |
| #define RK3288_DRV_BITS_PER_PIN 2 |
| #define RK3288_DRV_PINS_PER_REG 8 |
| #define RK3288_DRV_BANK_STRIDE 16 |
| |
| static void rk3288_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 24 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RK3288_DRV_PMU_OFFSET; |
| |
| *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3288_DRV_PINS_PER_REG; |
| *bit *= RK3288_DRV_BITS_PER_PIN; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RK3288_DRV_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * RK3288_DRV_BANK_STRIDE; |
| *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
| *bit *= RK3288_DRV_BITS_PER_PIN; |
| } |
| } |
| |
| #define RK3228_PULL_OFFSET 0x100 |
| |
| static void rk3228_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| *regmap = info->regmap_base; |
| *reg = RK3228_PULL_OFFSET; |
| *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE; |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } |
| |
| #define RK3228_DRV_GRF_OFFSET 0x200 |
| |
| static void rk3228_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| *regmap = info->regmap_base; |
| *reg = RK3228_DRV_GRF_OFFSET; |
| *reg += bank->bank_num * RK3288_DRV_BANK_STRIDE; |
| *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
| *bit *= RK3288_DRV_BITS_PER_PIN; |
| } |
| |
| #define RK3368_PULL_GRF_OFFSET 0x100 |
| #define RK3368_PULL_PMU_OFFSET 0x10 |
| |
| static void rk3368_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 32 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RK3368_PULL_PMU_OFFSET; |
| |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3188_PULL_PINS_PER_REG; |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RK3368_PULL_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE; |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } |
| } |
| |
| #define RK3368_DRV_PMU_OFFSET 0x20 |
| #define RK3368_DRV_GRF_OFFSET 0x200 |
| |
| static void rk3368_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The first 32 pins of the first bank are located in PMU */ |
| if (bank->bank_num == 0) { |
| *regmap = info->regmap_pmu; |
| *reg = RK3368_DRV_PMU_OFFSET; |
| |
| *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3288_DRV_PINS_PER_REG; |
| *bit *= RK3288_DRV_BITS_PER_PIN; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RK3368_DRV_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 2nd bank */ |
| *reg -= 0x10; |
| *reg += bank->bank_num * RK3288_DRV_BANK_STRIDE; |
| *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3288_DRV_PINS_PER_REG); |
| *bit *= RK3288_DRV_BITS_PER_PIN; |
| } |
| } |
| |
| #define RK3399_PULL_GRF_OFFSET 0xe040 |
| #define RK3399_PULL_PMU_OFFSET 0x40 |
| #define RK3399_DRV_3BITS_PER_PIN 3 |
| |
| static void rk3399_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| /* The bank0:16 and bank1:32 pins are located in PMU */ |
| if ((bank->bank_num == 0) || (bank->bank_num == 1)) { |
| *regmap = info->regmap_pmu; |
| *reg = RK3399_PULL_PMU_OFFSET; |
| |
| *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE; |
| |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3188_PULL_PINS_PER_REG; |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } else { |
| *regmap = info->regmap_base; |
| *reg = RK3399_PULL_GRF_OFFSET; |
| |
| /* correct the offset, as we're starting with the 3rd bank */ |
| *reg -= 0x20; |
| *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE; |
| *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4); |
| |
| *bit = (pin_num % RK3188_PULL_PINS_PER_REG); |
| *bit *= RK3188_PULL_BITS_PER_PIN; |
| } |
| } |
| |
| static void rk3399_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| int drv_num = (pin_num / 8); |
| |
| /* The bank0:16 and bank1:32 pins are located in PMU */ |
| if ((bank->bank_num == 0) || (bank->bank_num == 1)) |
| *regmap = info->regmap_pmu; |
| else |
| *regmap = info->regmap_base; |
| |
| *reg = bank->drv[drv_num].offset; |
| if ((bank->drv[drv_num].drv_type == DRV_TYPE_IO_1V8_3V0_AUTO) || |
| (bank->drv[drv_num].drv_type == DRV_TYPE_IO_3V3_ONLY)) |
| *bit = (pin_num % 8) * 3; |
| else |
| *bit = (pin_num % 8) * 2; |
| } |
| |
| static int rockchip_perpin_drv_list[DRV_TYPE_MAX][8] = { |
| { 2, 4, 8, 12, -1, -1, -1, -1 }, |
| { 3, 6, 9, 12, -1, -1, -1, -1 }, |
| { 5, 10, 15, 20, -1, -1, -1, -1 }, |
| { 4, 6, 8, 10, 12, 14, 16, 18 }, |
| { 4, 7, 10, 13, 16, 19, 22, 26 } |
| }; |
| |
| static int rockchip_get_drive_perpin(struct rockchip_pin_bank *bank, |
| int pin_num) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct regmap *regmap; |
| int reg, ret; |
| u32 data, temp, rmask_bits; |
| u8 bit; |
| int drv_type = bank->drv[pin_num / 8].drv_type; |
| |
| ctrl->drv_calc_reg(bank, pin_num, ®map, ®, &bit); |
| |
| switch (drv_type) { |
| case DRV_TYPE_IO_1V8_3V0_AUTO: |
| case DRV_TYPE_IO_3V3_ONLY: |
| rmask_bits = RK3399_DRV_3BITS_PER_PIN; |
| switch (bit) { |
| case 0 ... 12: |
| /* regular case, nothing to do */ |
| break; |
| case 15: |
| /* |
| * drive-strength offset is special, as it is |
| * spread over 2 registers |
| */ |
| ret = regmap_read(regmap, reg, &data); |
| if (ret) |
| return ret; |
| |
| ret = regmap_read(regmap, reg + 0x4, &temp); |
| if (ret) |
| return ret; |
| |
| /* |
| * the bit data[15] contains bit 0 of the value |
| * while temp[1:0] contains bits 2 and 1 |
| */ |
| data >>= 15; |
| temp &= 0x3; |
| temp <<= 1; |
| data |= temp; |
| |
| return rockchip_perpin_drv_list[drv_type][data]; |
| case 18 ... 21: |
| /* setting fully enclosed in the second register */ |
| reg += 4; |
| bit -= 16; |
| break; |
| default: |
| dev_err(info->dev, "unsupported bit: %d for pinctrl drive type: %d\n", |
| bit, drv_type); |
| return -EINVAL; |
| } |
| |
| break; |
| case DRV_TYPE_IO_DEFAULT: |
| case DRV_TYPE_IO_1V8_OR_3V0: |
| case DRV_TYPE_IO_1V8_ONLY: |
| rmask_bits = RK3288_DRV_BITS_PER_PIN; |
| break; |
| default: |
| dev_err(info->dev, "unsupported pinctrl drive type: %d\n", |
| drv_type); |
| return -EINVAL; |
| } |
| |
| ret = regmap_read(regmap, reg, &data); |
| if (ret) |
| return ret; |
| |
| data >>= bit; |
| data &= (1 << rmask_bits) - 1; |
| |
| return rockchip_perpin_drv_list[drv_type][data]; |
| } |
| |
| static int rockchip_set_drive_perpin(struct rockchip_pin_bank *bank, |
| int pin_num, int strength) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct regmap *regmap; |
| int reg, ret, i; |
| u32 data, rmask, rmask_bits, temp; |
| u8 bit; |
| int drv_type = bank->drv[pin_num / 8].drv_type; |
| |
| dev_dbg(info->dev, "setting drive of GPIO%d-%d to %d\n", |
| bank->bank_num, pin_num, strength); |
| |
| ctrl->drv_calc_reg(bank, pin_num, ®map, ®, &bit); |
| |
| ret = -EINVAL; |
| for (i = 0; i < ARRAY_SIZE(rockchip_perpin_drv_list[drv_type]); i++) { |
| if (rockchip_perpin_drv_list[drv_type][i] == strength) { |
| ret = i; |
| break; |
| } else if (rockchip_perpin_drv_list[drv_type][i] < 0) { |
| ret = rockchip_perpin_drv_list[drv_type][i]; |
| break; |
| } |
| } |
| |
| if (ret < 0) { |
| dev_err(info->dev, "unsupported driver strength %d\n", |
| strength); |
| return ret; |
| } |
| |
| switch (drv_type) { |
| case DRV_TYPE_IO_1V8_3V0_AUTO: |
| case DRV_TYPE_IO_3V3_ONLY: |
| rmask_bits = RK3399_DRV_3BITS_PER_PIN; |
| switch (bit) { |
| case 0 ... 12: |
| /* regular case, nothing to do */ |
| break; |
| case 15: |
| /* |
| * drive-strength offset is special, as it is spread |
| * over 2 registers, the bit data[15] contains bit 0 |
| * of the value while temp[1:0] contains bits 2 and 1 |
| */ |
| data = (ret & 0x1) << 15; |
| temp = (ret >> 0x1) & 0x3; |
| |
| rmask = BIT(15) | BIT(31); |
| data |= BIT(31); |
| ret = regmap_update_bits(regmap, reg, rmask, data); |
| if (ret) |
| return ret; |
| |
| rmask = 0x3 | (0x3 << 16); |
| temp |= (0x3 << 16); |
| reg += 0x4; |
| ret = regmap_update_bits(regmap, reg, rmask, temp); |
| |
| return ret; |
| case 18 ... 21: |
| /* setting fully enclosed in the second register */ |
| reg += 4; |
| bit -= 16; |
| break; |
| default: |
| dev_err(info->dev, "unsupported bit: %d for pinctrl drive type: %d\n", |
| bit, drv_type); |
| return -EINVAL; |
| } |
| break; |
| case DRV_TYPE_IO_DEFAULT: |
| case DRV_TYPE_IO_1V8_OR_3V0: |
| case DRV_TYPE_IO_1V8_ONLY: |
| rmask_bits = RK3288_DRV_BITS_PER_PIN; |
| break; |
| default: |
| dev_err(info->dev, "unsupported pinctrl drive type: %d\n", |
| drv_type); |
| return -EINVAL; |
| } |
| |
| /* enable the write to the equivalent lower bits */ |
| data = ((1 << rmask_bits) - 1) << (bit + 16); |
| rmask = data | (data >> 16); |
| data |= (ret << bit); |
| |
| ret = regmap_update_bits(regmap, reg, rmask, data); |
| |
| return ret; |
| } |
| |
| static int rockchip_pull_list[PULL_TYPE_MAX][4] = { |
| { |
| PIN_CONFIG_BIAS_DISABLE, |
| PIN_CONFIG_BIAS_PULL_UP, |
| PIN_CONFIG_BIAS_PULL_DOWN, |
| PIN_CONFIG_BIAS_BUS_HOLD |
| }, |
| { |
| PIN_CONFIG_BIAS_DISABLE, |
| PIN_CONFIG_BIAS_PULL_DOWN, |
| PIN_CONFIG_BIAS_DISABLE, |
| PIN_CONFIG_BIAS_PULL_UP |
| }, |
| }; |
| |
| static int rockchip_get_pull(struct rockchip_pin_bank *bank, int pin_num) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct regmap *regmap; |
| int reg, ret, pull_type; |
| u8 bit; |
| u32 data; |
| |
| /* rk3066b does support any pulls */ |
| if (ctrl->type == RK3066B) |
| return PIN_CONFIG_BIAS_DISABLE; |
| |
| ctrl->pull_calc_reg(bank, pin_num, ®map, ®, &bit); |
| |
| ret = regmap_read(regmap, reg, &data); |
| if (ret) |
| return ret; |
| |
| switch (ctrl->type) { |
| case RK2928: |
| case RK3128: |
| return !(data & BIT(bit)) |
| ? PIN_CONFIG_BIAS_PULL_PIN_DEFAULT |
| : PIN_CONFIG_BIAS_DISABLE; |
| case PX30: |
| case RV1108: |
| case RK3188: |
| case RK3288: |
| case RK3368: |
| case RK3399: |
| pull_type = bank->pull_type[pin_num / 8]; |
| data >>= bit; |
| data &= (1 << RK3188_PULL_BITS_PER_PIN) - 1; |
| |
| return rockchip_pull_list[pull_type][data]; |
| default: |
| dev_err(info->dev, "unsupported pinctrl type\n"); |
| return -EINVAL; |
| }; |
| } |
| |
| static int rockchip_set_pull(struct rockchip_pin_bank *bank, |
| int pin_num, int pull) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct regmap *regmap; |
| int reg, ret, i, pull_type; |
| u8 bit; |
| u32 data, rmask; |
| |
| dev_dbg(info->dev, "setting pull of GPIO%d-%d to %d\n", |
| bank->bank_num, pin_num, pull); |
| |
| /* rk3066b does support any pulls */ |
| if (ctrl->type == RK3066B) |
| return pull ? -EINVAL : 0; |
| |
| ctrl->pull_calc_reg(bank, pin_num, ®map, ®, &bit); |
| |
| switch (ctrl->type) { |
| case RK2928: |
| case RK3128: |
| data = BIT(bit + 16); |
| if (pull == PIN_CONFIG_BIAS_DISABLE) |
| data |= BIT(bit); |
| ret = regmap_write(regmap, reg, data); |
| break; |
| case PX30: |
| case RV1108: |
| case RK3188: |
| case RK3288: |
| case RK3368: |
| case RK3399: |
| pull_type = bank->pull_type[pin_num / 8]; |
| ret = -EINVAL; |
| for (i = 0; i < ARRAY_SIZE(rockchip_pull_list[pull_type]); |
| i++) { |
| if (rockchip_pull_list[pull_type][i] == pull) { |
| ret = i; |
| break; |
| } |
| } |
| |
| if (ret < 0) { |
| dev_err(info->dev, "unsupported pull setting %d\n", |
| pull); |
| return ret; |
| } |
| |
| /* enable the write to the equivalent lower bits */ |
| data = ((1 << RK3188_PULL_BITS_PER_PIN) - 1) << (bit + 16); |
| rmask = data | (data >> 16); |
| data |= (ret << bit); |
| |
| ret = regmap_update_bits(regmap, reg, rmask, data); |
| break; |
| default: |
| dev_err(info->dev, "unsupported pinctrl type\n"); |
| return -EINVAL; |
| } |
| |
| return ret; |
| } |
| |
| #define RK3328_SCHMITT_BITS_PER_PIN 1 |
| #define RK3328_SCHMITT_PINS_PER_REG 16 |
| #define RK3328_SCHMITT_BANK_STRIDE 8 |
| #define RK3328_SCHMITT_GRF_OFFSET 0x380 |
| |
| static int rk3328_calc_schmitt_reg_and_bit(struct rockchip_pin_bank *bank, |
| int pin_num, |
| struct regmap **regmap, |
| int *reg, u8 *bit) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| |
| *regmap = info->regmap_base; |
| *reg = RK3328_SCHMITT_GRF_OFFSET; |
| |
| *reg += bank->bank_num * RK3328_SCHMITT_BANK_STRIDE; |
| *reg += ((pin_num / RK3328_SCHMITT_PINS_PER_REG) * 4); |
| *bit = pin_num % RK3328_SCHMITT_PINS_PER_REG; |
| |
| return 0; |
| } |
| |
| static int rockchip_get_schmitt(struct rockchip_pin_bank *bank, int pin_num) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct regmap *regmap; |
| int reg, ret; |
| u8 bit; |
| u32 data; |
| |
| ret = ctrl->schmitt_calc_reg(bank, pin_num, ®map, ®, &bit); |
| if (ret) |
| return ret; |
| |
| ret = regmap_read(regmap, reg, &data); |
| if (ret) |
| return ret; |
| |
| data >>= bit; |
| return data & 0x1; |
| } |
| |
| static int rockchip_set_schmitt(struct rockchip_pin_bank *bank, |
| int pin_num, int enable) |
| { |
| struct rockchip_pinctrl *info = bank->drvdata; |
| struct rockchip_pin_ctrl *ctrl = info->ctrl; |
| struct regmap *regmap; |
| int reg, ret; |
| u8 bit; |
| u32 data, rmask; |
| |
| dev_dbg(info->dev, "setting input schmitt of GPIO%d-%d to %d\n", |
| bank->bank_num, pin_num, enable); |
| |
| ret = ctrl->schmitt_calc_reg(bank, pin_num, ®map, ®, &bit); |
| if (ret) |
| return ret; |
| |
| /* enable the write to the equivalent lower bits */ |
| data = BIT(bit + 16) | (enable << bit); |
| rmask = BIT(bit + 16) | BIT(bit); |
| |
| return regmap_update_bits(regmap, reg, rmask, data); |
| } |
| |
| /* |
| * Pinmux_ops handling |
| */ |
| |
| static int rockchip_pmx_get_funcs_count(struct pinctrl_dev *pctldev) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| |
| return info->nfunctions; |
| } |
| |
| static const char *rockchip_pmx_get_func_name(struct pinctrl_dev *pctldev, |
| unsigned selector) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| |
| return info->functions[selector].name; |
| } |
| |
| static int rockchip_pmx_get_groups(struct pinctrl_dev *pctldev, |
| unsigned selector, const char * const **groups, |
| unsigned * const num_groups) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| |
| *groups = info->functions[selector].groups; |
| *num_groups = info->functions[selector].ngroups; |
| |
| return 0; |
| } |
| |
| static int rockchip_pmx_set(struct pinctrl_dev *pctldev, unsigned selector, |
| unsigned group) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| const unsigned int *pins = info->groups[group].pins; |
| const struct rockchip_pin_config *data = info->groups[group].data; |
| struct rockchip_pin_bank *bank; |
| int cnt, ret = 0; |
| |
| dev_dbg(info->dev, "enable function %s group %s\n", |
| info->functions[selector].name, info->groups[group].name); |
| |
| /* |
| * for each pin in the pin group selected, program the corresponding |
| * pin function number in the config register. |
| */ |
| for (cnt = 0; cnt < info->groups[group].npins; cnt++) { |
| bank = pin_to_bank(info, pins[cnt]); |
| ret = rockchip_set_mux(bank, pins[cnt] - bank->pin_base, |
| data[cnt].func); |
| if (ret) |
| break; |
| } |
| |
| if (ret) { |
| /* revert the already done pin settings */ |
| for (cnt--; cnt >= 0; cnt--) |
| rockchip_set_mux(bank, pins[cnt] - bank->pin_base, 0); |
| |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int rockchip_gpio_get_direction(struct gpio_chip *chip, unsigned offset) |
| { |
| struct rockchip_pin_bank *bank = gpiochip_get_data(chip); |
| u32 data; |
| int ret; |
| |
| ret = clk_enable(bank->clk); |
| if (ret < 0) { |
| dev_err(bank->drvdata->dev, |
| "failed to enable clock for bank %s\n", bank->name); |
| return ret; |
| } |
| data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR); |
| clk_disable(bank->clk); |
| |
| return !(data & BIT(offset)); |
| } |
| |
| /* |
| * The calls to gpio_direction_output() and gpio_direction_input() |
| * leads to this function call (via the pinctrl_gpio_direction_{input|output}() |
| * function called from the gpiolib interface). |
| */ |
| static int _rockchip_pmx_gpio_set_direction(struct gpio_chip *chip, |
| int pin, bool input) |
| { |
| struct rockchip_pin_bank *bank; |
| int ret; |
| unsigned long flags; |
| u32 data; |
| |
| bank = gpiochip_get_data(chip); |
| |
| ret = rockchip_set_mux(bank, pin, RK_FUNC_GPIO); |
| if (ret < 0) |
| return ret; |
| |
| clk_enable(bank->clk); |
| raw_spin_lock_irqsave(&bank->slock, flags); |
| |
| data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR); |
| /* set bit to 1 for output, 0 for input */ |
| if (!input) |
| data |= BIT(pin); |
| else |
| data &= ~BIT(pin); |
| writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR); |
| |
| raw_spin_unlock_irqrestore(&bank->slock, flags); |
| clk_disable(bank->clk); |
| |
| return 0; |
| } |
| |
| static int rockchip_pmx_gpio_set_direction(struct pinctrl_dev *pctldev, |
| struct pinctrl_gpio_range *range, |
| unsigned offset, bool input) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| struct gpio_chip *chip; |
| int pin; |
| |
| chip = range->gc; |
| pin = offset - chip->base; |
| dev_dbg(info->dev, "gpio_direction for pin %u as %s-%d to %s\n", |
| offset, range->name, pin, input ? "input" : "output"); |
| |
| return _rockchip_pmx_gpio_set_direction(chip, offset - chip->base, |
| input); |
| } |
| |
| static const struct pinmux_ops rockchip_pmx_ops = { |
| .get_functions_count = rockchip_pmx_get_funcs_count, |
| .get_function_name = rockchip_pmx_get_func_name, |
| .get_function_groups = rockchip_pmx_get_groups, |
| .set_mux = rockchip_pmx_set, |
| .gpio_set_direction = rockchip_pmx_gpio_set_direction, |
| }; |
| |
| /* |
| * Pinconf_ops handling |
| */ |
| |
| static bool rockchip_pinconf_pull_valid(struct rockchip_pin_ctrl *ctrl, |
| enum pin_config_param pull) |
| { |
| switch (ctrl->type) { |
| case RK2928: |
| case RK3128: |
| return (pull == PIN_CONFIG_BIAS_PULL_PIN_DEFAULT || |
| pull == PIN_CONFIG_BIAS_DISABLE); |
| case RK3066B: |
| return pull ? false : true; |
| case PX30: |
| case RV1108: |
| case RK3188: |
| case RK3288: |
| case RK3368: |
| case RK3399: |
| return (pull != PIN_CONFIG_BIAS_PULL_PIN_DEFAULT); |
| } |
| |
| return false; |
| } |
| |
| static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value); |
| static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset); |
| |
| /* set the pin config settings for a specified pin */ |
| static int rockchip_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, |
| unsigned long *configs, unsigned num_configs) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| struct rockchip_pin_bank *bank = pin_to_bank(info, pin); |
| enum pin_config_param param; |
| u32 arg; |
| int i; |
| int rc; |
| |
| for (i = 0; i < num_configs; i++) { |
| param = pinconf_to_config_param(configs[i]); |
| arg = pinconf_to_config_argument(configs[i]); |
| |
| switch (param) { |
| case PIN_CONFIG_BIAS_DISABLE: |
| rc = rockchip_set_pull(bank, pin - bank->pin_base, |
| param); |
| if (rc) |
| return rc; |
| break; |
| case PIN_CONFIG_BIAS_PULL_UP: |
| case PIN_CONFIG_BIAS_PULL_DOWN: |
| case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT: |
| case PIN_CONFIG_BIAS_BUS_HOLD: |
| if (!rockchip_pinconf_pull_valid(info->ctrl, param)) |
| return -ENOTSUPP; |
| |
| if (!arg) |
| return -EINVAL; |
| |
| rc = rockchip_set_pull(bank, pin - bank->pin_base, |
| param); |
| if (rc) |
| return rc; |
| break; |
| case PIN_CONFIG_OUTPUT: |
| rockchip_gpio_set(&bank->gpio_chip, |
| pin - bank->pin_base, arg); |
| rc = _rockchip_pmx_gpio_set_direction(&bank->gpio_chip, |
| pin - bank->pin_base, false); |
| if (rc) |
| return rc; |
| break; |
| case PIN_CONFIG_DRIVE_STRENGTH: |
| /* rk3288 is the first with per-pin drive-strength */ |
| if (!info->ctrl->drv_calc_reg) |
| return -ENOTSUPP; |
| |
| rc = rockchip_set_drive_perpin(bank, |
| pin - bank->pin_base, arg); |
| if (rc < 0) |
| return rc; |
| break; |
| case PIN_CONFIG_INPUT_SCHMITT_ENABLE: |
| if (!info->ctrl->schmitt_calc_reg) |
| return -ENOTSUPP; |
| |
| rc = rockchip_set_schmitt(bank, |
| pin - bank->pin_base, arg); |
| if (rc < 0) |
| return rc; |
| break; |
| default: |
| return -ENOTSUPP; |
| break; |
| } |
| } /* for each config */ |
| |
| return 0; |
| } |
| |
| /* get the pin config settings for a specified pin */ |
| static int rockchip_pinconf_get(struct pinctrl_dev *pctldev, unsigned int pin, |
| unsigned long *config) |
| { |
| struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev); |
| struct rockchip_pin_bank *bank = pin_to_bank(info, pin); |
| enum pin_config_param param = pinconf_to_config_param(*config); |
| u16 arg; |
| int rc; |
| |
| switch (param) { |
| case PIN_CONFIG_BIAS_DISABLE: |
| if (rockchip_get_pull(bank, pin - bank->pin_base) != param) |
| return -EINVAL; |
| |
| arg = 0; |
| break; |
| case PIN_CONFIG_BIAS_PULL_UP: |
| case PIN_CONFIG_BIAS_PULL_DOWN: |
| case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT: |
| case PIN_CONFIG_BIAS_BUS_HOLD: |
| if (!rockchip_pinconf_pull_valid(info->ctrl, param)) |
| return -ENOTSUPP; |
| |
| if (rockchip_get_pull(bank, pin - bank->pin_base) != param) |
| return -EINVAL; |
| |
| arg = 1; |
| break; |
| case PIN_CONFIG_OUTPUT: |
| rc = rockchip_get_mux(bank, pin - bank->pin_base); |
| if (rc != RK_FUNC_GPIO) |
| return -EINVAL; |
| |
| rc = rockchip_gpio_get(&bank->gpio_chip, pin - bank->pin_base); |
| if (rc < 0) |
| return rc; |
| |
| arg = rc ? 1 : 0; |
| break; |
| case PIN_CONFIG_DRIVE_STRENGTH: |
| /* rk3288 is the first with per-pin drive-strength */ |
| if (!info->ctrl->drv_calc_reg) |
| return -ENOTSUPP; |
| |
| rc = rockchip_get_drive_perpin(bank, pin - bank->pin_base); |
| if (rc < 0) |
| return rc; |
| |
| arg = rc; |
| break; |
| case PIN_CONFIG_INPUT_SCHMITT_ENABLE: |
| if (!info->ctrl->schmitt_calc_reg) |
| return -ENOTSUPP; |
| |
| rc = rockchip_get_schmitt(bank, pin - bank->pin_base); |
| if (rc < 0) |
| return rc; |
| |
| arg = rc; |
| break; |
| default: |
| return -ENOTSUPP; |
| break; |
| } |
| |
| *config = pinconf_to_config_packed(param, arg); |
| |
| return 0; |
| } |
| |
| static const struct pinconf_ops rockchip_pinconf_ops = { |
| .pin_config_get = rockchip_pinconf_get, |
| .pin_config_set = rockchip_pinconf_set, |
| .is_generic = true, |
| }; |
| |
| static const struct of_device_id rockchip_bank_match[] = { |
| { .compatible = "rockchip,gpio-bank" }, |
| { .compatible = "rockchip,rk3188-gpio-bank0" }, |
| {}, |
| }; |
| |
| static void rockchip_pinctrl_child_count(struct rockchip_pinctrl *info, |
| struct device_node *np) |
| { |
| struct device_node *child; |
| |
| for_each_child_of_node(np, child) { |
| if (of_match_node(rockchip_bank_match, child)) |
| continue; |
| |
| info->nfunctions++; |
| info->ngroups += of_get_child_count(child); |
| } |
| } |
| |
| static int rockchip_pinctrl_parse_groups(struct device_node *np, |
| struct rockchip_pin_group *grp, |
| struct rockchip_pinctrl *info, |
| u32 index) |
| { |
| struct rockchip_pin_bank *bank; |
| int size; |
| const __be32 *list; |
| int num; |
| int i, j; |
| int ret; |
| |
| dev_dbg(info->dev, "group(%d): %pOFn\n", index, np); |
| |
| /* Initialise group */ |
| grp->name = np->name; |
| |
| /* |
| * the binding format is rockchip,pins = <bank pin mux CONFIG>, |
| * do sanity check and calculate pins number |
| */ |
| list = of_get_property(np, "rockchip,pins", &size); |
| /* we do not check return since it's safe node passed down */ |
| size /= sizeof(*list); |
| if (!size || size % 4) { |
| dev_err(info->dev, "wrong pins number or pins and configs should be by 4\n"); |
| return -EINVAL; |
| } |
| |
| grp->npins = size / 4; |
| |
| grp->pins = devm_kcalloc(info->dev, grp->npins, sizeof(unsigned int), |
| GFP_KERNEL); |
| grp->data = devm_kcalloc(info->dev, |
| grp->npins, |
| sizeof(struct rockchip_pin_config), |
| GFP_KERNEL); |
| if (!grp->pins || !grp->data) |
| return -ENOMEM; |
| |
| for (i = 0, j = 0; i < size; i += 4, j++) { |
| const __be32 *phandle; |
| struct device_node *np_config; |
| |
| num = be32_to_cpu(*list++); |
| bank = bank_num_to_bank(info, num); |
| if (IS_ERR(bank)) |
| return PTR_ERR(bank); |
| |
| grp->pins[j] = bank->pin_base + be32_to_cpu(*list++); |
| grp->data[j].func = be32_to_cpu(*list++); |
| |
| phandle = list++; |
| if (!phandle) |
| return -EINVAL; |
| |
| np_config = of_find_node_by_phandle(be32_to_cpup(phandle)); |
| ret = pinconf_generic_parse_dt_config(np_config, NULL, |
| &grp->data[j].configs, &grp->data[j].nconfigs); |
| if (ret) |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static int rockchip_pinctrl_parse_functions(struct device_node *np, |
| struct rockchip_pinctrl *info, |
| u32 index) |
| { |
| struct device_node *child; |
| struct rockchip_pmx_func *func; |
| struct rockchip_pin_group *grp; |
| int ret; |
| static u32 grp_index; |
| u32 i = 0; |
| |
| dev_dbg(info->dev, "parse function(%d): %pOFn\n", index, np); |
| |
| func = &info->functions[index]; |
| |
| /* Initialise function */ |
| func->name = np->name; |
| func->ngroups = of_get_child_count(np); |
| if (func->ngroups <= 0) |
| return 0; |
| |
| func->groups = devm_kcalloc(info->dev, |
| func->ngroups, sizeof(char *), GFP_KERNEL); |
| if (!func->groups) |
| return -ENOMEM; |
| |
| for_each_child_of_node(np, child) { |
| func->groups[i] = child->name; |
| grp = &info->groups[grp_index++]; |
| ret = rockchip_pinctrl_parse_groups(child, grp, info, i++); |
| if (ret) { |
| of_node_put(child); |
| return ret; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static int rockchip_pinctrl_parse_dt(struct platform_device *pdev, |
| struct rockchip_pinctrl *info) |
| { |
| struct device *dev = &pdev->dev; |
| struct device_node *np = dev->of_node; |
| struct device_node *child; |
| int ret; |
| int i; |
| |
| rockchip_pinctrl_child_count(info, np); |
| |
| dev_dbg(&pdev->dev, "nfunctions = %d\n", info->nfunctions); |
| dev_dbg(&pdev->dev, "ngroups = %d\n", info->ngroups); |
| |
| info->functions = devm_kcalloc(dev, |
| info->nfunctions, |
| sizeof(struct rockchip_pmx_func), |
| GFP_KERNEL); |
| if (!info->functions) |
| return -EINVAL; |
| |
| info->groups = devm_kcalloc(dev, |
| info->ngroups, |
| sizeof(struct rockchip_pin_group), |
| GFP_KERNEL); |
| if (!info->groups) |
| return -EINVAL; |
| |
| i = 0; |
| |
| for_each_child_of_node(np, child) { |
| if (of_match_node(rockchip_bank_match, child)) |
| continue; |
| |
| ret = rockchip_pinctrl_parse_functions(child, info, i++); |
| if (ret) { |
| dev_err(&pdev->dev, "failed to parse function\n"); |
| of_node_put(child); |
| return ret; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static int rockchip_pinctrl_register(struct platform_device *pdev, |
| struct rockchip_pinctrl *info) |
| { |
| struct pinctrl_desc *ctrldesc = &info->pctl; |
| struct pinctrl_pin_desc *pindesc, *pdesc; |
| struct rockchip_pin_bank *pin_bank; |
| int pin, bank, ret; |
| int k; |
| |
| ctrldesc->name = "rockchip-pinctrl"; |
| ctrldesc->owner = THIS_MODULE; |
| ctrldesc->pctlops = &rockchip_pctrl_ops; |
| ctrldesc->pmxops = &rockchip_pmx_ops; |
| ctrldesc->confops = &rockchip_pinconf_ops; |
| |
| pindesc = devm_kcalloc(&pdev->dev, |
| info->ctrl->nr_pins, sizeof(*pindesc), |
| GFP_KERNEL); |
| if (!pindesc) |
| return -ENOMEM; |
| |
| ctrldesc->pins = pindesc; |
| ctrldesc->npins = info->ctrl->nr_pins; |
| |
| pdesc = pindesc; |
| for (bank = 0 , k = 0; bank < info->ctrl->nr_banks; bank++) { |
| pin_bank = &info->ctrl->pin_banks[bank]; |
| for (pin = 0; pin < pin_bank->nr_pins; pin++, k++) { |
| pdesc->number = k; |
| pdesc->name = kasprintf(GFP_KERNEL, "%s-%d", |
| pin_bank->name, pin); |
| pdesc++; |
| } |
| } |
| |
| ret = rockchip_pinctrl_parse_dt(pdev, info); |
| if (ret) |
| return ret; |
| |
| info->pctl_dev = devm_pinctrl_register(&pdev->dev, ctrldesc, info); |
| if (IS_ERR(info->pctl_dev)) { |
| dev_err(&pdev->dev, "could not register pinctrl driver\n"); |
| return PTR_ERR(info->pctl_dev); |
| } |
| |
| for (bank = 0; bank < info->ctrl->nr_banks; ++bank) { |
| pin_bank = &info->ctrl->pin_banks[bank]; |
| pin_bank->grange.name = pin_bank->name; |
| pin_bank->grange.id = bank; |
| pin_bank->grange.pin_base = pin_bank->pin_base; |
| pin_bank->grange.base = pin_bank->gpio_chip.base; |
| pin_bank->grange.npins = pin_bank->gpio_chip.ngpio; |
| pin_bank->grange.gc = &pin_bank->gpio_chip; |
| pinctrl_add_gpio_range(info->pctl_dev, &pin_bank->grange); |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * GPIO handling |
| */ |
| |
| static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value) |
| { |
| struct rockchip_pin_bank *bank = gpiochip_get_data(gc); |
| void __iomem *reg = bank->reg_base + GPIO_SWPORT_DR; |
| unsigned long flags; |
| u32 data; |
| |
| clk_enable(bank->clk); |
| raw_spin_lock_irqsave(&bank->slock, flags); |
| |
| data = readl(reg); |
| data &= ~BIT(offset); |
| if (value) |
| data |= BIT(offset); |
| writel(data, reg); |
| |
| raw_spin_unlock_irqrestore(&bank->slock, flags); |
| clk_disable(bank->clk); |
| } |
| |
| /* |
| * Returns the level of the pin for input direction and setting of the DR |
| * register for output gpios. |
| */ |
| static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset) |
| { |
| struct rockchip_pin_bank *bank = gpiochip_get_data(gc); |
| u32 data; |
| |
| clk_enable(bank->clk); |
| data = readl(bank->reg_base + GPIO_EXT_PORT); |
| clk_disable(bank->clk); |
| data >>= offset; |
| data &= 1; |
| return data; |
| } |
| |
| /* |
| * gpiolib gpio_direction_input callback function. The setting of the pin |
| * mux function as 'gpio input' will be handled by the pinctrl subsystem |
| * interface. |
| */ |
| static int rockchip_gpio_direction_input(struct gpio_chip *gc, unsigned offset) |
| { |
| return pinctrl_gpio_direction_input(gc->base + offset); |
| } |
| |
| /* |
| * gpiolib gpio_direction_output callback function. The setting of the pin |
| * mux function as 'gpio output' will be handled by the pinctrl subsystem |
| * interface. |
| */ |
| static int rockchip_gpio_direction_output(struct gpio_chip *gc, |
| unsigned offset, int value) |
| { |
| rockchip_gpio_set(gc, offset, value); |
| return pinctrl_gpio_direction_output(gc->base + offset); |
| } |
| |
| static void rockchip_gpio_set_debounce(struct gpio_chip *gc, |
| unsigned int offset, bool enable) |
| { |
| struct rockchip_pin_bank *bank = gpiochip_get_data(gc); |
| void __iomem *reg = bank->reg_base + GPIO_DEBOUNCE; |
| unsigned long flags; |
| u32 data; |
| |
| clk_enable(bank->clk); |
| raw_spin_lock_irqsave(&bank->slock, flags); |
| |
| data = readl(reg); |
| if (enable) |
| data |= BIT(offset); |
| else |
| data &= ~BIT(offset); |
| writel(data, reg); |
| |
| raw_spin_unlock_irqrestore(&bank->slock, flags); |
| clk_disable(bank->clk); |
| } |
| |
| /* |
| * gpiolib set_config callback function. The setting of the pin |
| * mux function as 'gpio output' will be handled by the pinctrl subsystem |
| * interface. |
| */ |
| static int rockchip_gpio_set_config(struct gpio_chip *gc, unsigned int offset, |
| unsigned long config) |
| { |
| enum pin_config_param param = pinconf_to_config_param(config); |
| |
| switch (param) { |
| case PIN_CONFIG_INPUT_DEBOUNCE: |
| rockchip_gpio_set_debounce(gc, offset, true); |
| /* |
| * Rockchip's gpio could only support up to one period |
| * of the debounce clock(pclk), which is far away from |
| * satisftying the requirement, as pclk is usually near |
| * 100MHz shared by all peripherals. So the fact is it |
| * has crippled debounce capability could only be useful |
| * to prevent any spurious glitches from waking up the system |
| * if the gpio is conguired as wakeup interrupt source. Let's |
| * still return -ENOTSUPP as before, to make sure the caller |
| * of gpiod_set_debounce won't change its behaviour. |
| */ |
| default: |
| return -ENOTSUPP; |
| } |
| } |
| |
| /* |
| * gpiolib gpio_to_irq callback function. Creates a mapping between a GPIO pin |
| * and a virtual IRQ, if not already present. |
| */ |
| static int rockchip_gpio_to_irq(struct gpio_chip *gc, unsigned offset) |
| { |
| struct rockchip_pin_bank *bank = gpiochip_get_data(gc); |
| unsigned int virq; |
| |
| if (!bank->domain) |
| return -ENXIO; |
| |
| virq = irq_create_mapping(bank->domain, offset); |
| |
| return (virq) ? : -ENXIO; |
| } |
| |
| static const struct gpio_chip rockchip_gpiolib_chip = { |
| .request = gpiochip_generic_request, |
| .free = gpiochip_generic_free, |
| .set = rockchip_gpio_set, |
| .get = rockchip_gpio_get, |
| .get_direction = rockchip_gpio_get_direction, |
| .direction_input = rockchip_gpio_direction_input, |
| .direction_output = rockchip_gpio_direction_output, |
| .set_config = rockchip_gpio_set_config, |
| .to_irq = rockchip_gpio_to_irq, |
| .owner = THIS_MODULE, |
| }; |
| |
| /* |
| * Interrupt handling |
| */ |
| |
| static void rockchip_irq_demux(struct irq_desc *desc) |
| { |
| struct irq_chip *chip = irq_desc_get_chip(desc); |
| struct rockchip_pin_bank *bank = irq_desc_get_handler_data(desc); |
| u32 pend; |
| |
| dev_dbg(bank->drvdata->dev, "got irq for bank %s\n", bank->name); |
| |
| chained_irq_enter(chip, desc); |
| |
| pend = readl_relaxed(bank->reg_base + GPIO_INT_STATUS); |
| |
| while (pend) { |
| unsigned int irq, virq; |
| |
| irq = __ffs(pend); |
| pend &= ~BIT(irq); |
| virq = irq_linear_revmap(bank->domain, irq); |
| |
| if (!virq) { |
| dev_err(bank->drvdata->dev, "unmapped irq %d\n", irq); |
| continue; |
| } |
| |
| dev_dbg(bank->drvdata->dev, "handling irq %d\n", irq); |
| |
| /* |
| * Triggering IRQ on both rising and falling edge |
| * needs manual intervention. |
| */ |
| if (bank->toggle_edge_mode & BIT(irq)) { |
| u32 data, data_old, polarity; |
| unsigned long flags; |
| |
| data = readl_relaxed(bank->reg_base + GPIO_EXT_PORT); |
| do { |
| raw_spin_lock_irqsave(&bank->slock, flags); |
| |
| polarity = readl_relaxed(bank->reg_base + |
| GPIO_INT_POLARITY); |
| if (data & BIT(irq)) |
| polarity &= ~BIT(irq); |
| else |
| polarity |= BIT(irq); |
| writel(polarity, |
| bank->reg_base + GPIO_INT_POLARITY); |
| |
| raw_spin_unlock_irqrestore(&bank->slock, flags); |
| |
| data_old = data; |
| data = readl_relaxed(bank->reg_base + |
| GPIO_EXT_PORT); |
| } while ((data & BIT(irq)) != (data_old & BIT(irq))); |
| } |
| |
| generic_handle_irq(virq); |
| } |
| |
| chained_irq_exit(chip, desc); |
| } |
| |
| static int rockchip_irq_set_type(struct irq_data *d, unsigned int type) |
| { |
| struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); |
| struct rockchip_pin_bank *bank = gc->private; |
| u32 mask = BIT(d->hwirq); |
| u32 polarity; |
| u32 level; |
| u32 data; |
| unsigned long flags; |
| int ret; |
| |
| /* make sure the pin is configured as gpio input */ |
| ret = rockchip_set_mux(bank, d->hwirq, RK_FUNC_GPIO); |
| if (ret < 0) |
| return ret; |
| |
| clk_enable(bank->clk); |
| raw_spin_lock_irqsave(&bank->slock, flags); |
| |
| data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR); |
| data &= ~mask; |
| writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR); |
| |
| raw_spin_unlock_irqrestore(&bank->slock, flags); |
| |
| if (type & IRQ_TYPE_EDGE_BOTH) |
| irq_set_handler_locked(d, handle_edge_irq); |
| else |
| irq_set_handler_locked(d, handle_level_irq); |
| |
| raw_spin_lock_irqsave(&bank->slock, flags); |
| irq_gc_lock(gc); |
| |
| level = readl_relaxed(gc->reg_base + GPIO_INTTYPE_LEVEL); |
| polarity = readl_relaxed(gc->reg_base + GPIO_INT_POLARITY); |
| |
| switch (type) { |
| case IRQ_TYPE_EDGE_BOTH: |
| bank->toggle_edge_mode |= mask; |
| level |= mask; |
| |
| /* |
| * Determine gpio state. If 1 next interrupt should be falling |
| * otherwise rising. |
| */ |
| data = readl(bank->reg_base + GPIO_EXT_PORT); |
| if (data & mask) |
| polarity &= ~mask; |
| else |
| polarity |= mask; |
| break; |
| case IRQ_TYPE_EDGE_RISING: |
| bank->toggle_edge_mode &= ~mask; |
| level |= mask; |
| polarity |= mask; |
| break; |
| case IRQ_TYPE_EDGE_FALLING: |
| bank->toggle_edge_mode &= ~mask; |
| level |= mask; |
| polarity &= ~mask; |
| break; |
| case IRQ_TYPE_LEVEL_HIGH: |
| bank->toggle_edge_mode &= ~mask; |
| level &= ~mask; |
| polarity |= mask; |
| break; |
| case IRQ_TYPE_LEVEL_LOW: |
| bank->toggle_edge_mode &= ~mask; |
| level &= ~mask; |
| polarity &= ~mask; |
| break; |
| default: |
|