Lines Matching refs:sfp
216 static inline unsigned int starfive_pin_to_gpio(const struct starfive_pinctrl *sfp, in starfive_pin_to_gpio() argument
219 return pin - sfp->gpios.pin_base; in starfive_pin_to_gpio()
222 static inline unsigned int starfive_gpio_to_pin(const struct starfive_pinctrl *sfp, in starfive_gpio_to_pin() argument
225 return sfp->gpios.pin_base + gpio; in starfive_gpio_to_pin()
456 struct starfive_pinctrl *sfp = pinctrl_dev_get_drvdata(pctldev); in starfive_pin_dbg_show() local
457 unsigned int gpio = starfive_pin_to_gpio(sfp, pin); in starfive_pin_dbg_show()
464 reg = sfp->base + GPON_DOUT_CFG + 8 * gpio; in starfive_pin_dbg_show()
481 struct starfive_pinctrl *sfp = pinctrl_dev_get_drvdata(pctldev); in starfive_dt_node_to_map() local
482 struct device *dev = sfp->gc.parent; in starfive_dt_node_to_map()
529 mutex_lock(&sfp->mutex); in starfive_dt_node_to_map()
562 pins[i] = starfive_gpio_to_pin(sfp, gpio); in starfive_dt_node_to_map()
623 mutex_unlock(&sfp->mutex); in starfive_dt_node_to_map()
630 mutex_unlock(&sfp->mutex); in starfive_dt_node_to_map()
646 struct starfive_pinctrl *sfp = pinctrl_dev_get_drvdata(pctldev); in starfive_set_mux() local
647 struct device *dev = sfp->gc.parent; in starfive_set_mux()
671 reg_dout = sfp->base + GPON_DOUT_CFG + 8 * gpio; in starfive_set_mux()
672 reg_doen = sfp->base + GPON_DOEN_CFG + 8 * gpio; in starfive_set_mux()
674 reg_din = sfp->base + GPI_CFG_OFFSET + 4 * din; in starfive_set_mux()
678 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_set_mux()
683 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_set_mux()
697 static u16 starfive_padctl_get(struct starfive_pinctrl *sfp, in starfive_padctl_get() argument
700 void __iomem *reg = sfp->padctl + 4 * (pin / 2); in starfive_padctl_get()
706 static void starfive_padctl_rmw(struct starfive_pinctrl *sfp, in starfive_padctl_rmw() argument
710 void __iomem *reg = sfp->padctl + 4 * (pin / 2); in starfive_padctl_rmw()
716 dev_dbg(sfp->gc.parent, "padctl_rmw(%u, 0x%03x, 0x%03x)\n", pin, _mask, _value); in starfive_padctl_rmw()
718 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_padctl_rmw()
721 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_padctl_rmw()
744 struct starfive_pinctrl *sfp = pinctrl_dev_get_drvdata(pctldev); in starfive_pinconf_get() local
746 u16 value = starfive_padctl_get(sfp, pin); in starfive_pinconf_get()
808 struct starfive_pinctrl *sfp = pinctrl_dev_get_drvdata(pctldev); in starfive_pinconf_group_set() local
880 starfive_padctl_rmw(sfp, group->pins[i], mask, value); in starfive_pinconf_group_set()
889 struct starfive_pinctrl *sfp = pinctrl_dev_get_drvdata(pctldev); in starfive_pinconf_dbg_show() local
890 u16 value = starfive_padctl_get(sfp, pin); in starfive_pinconf_dbg_show()
931 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_get_direction() local
932 void __iomem *doen = sfp->base + GPON_DOEN_CFG + 8 * gpio; in starfive_gpio_get_direction()
943 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_direction_input() local
944 void __iomem *doen = sfp->base + GPON_DOEN_CFG + 8 * gpio; in starfive_gpio_direction_input()
948 starfive_padctl_rmw(sfp, starfive_gpio_to_pin(sfp, gpio), in starfive_gpio_direction_input()
952 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_gpio_direction_input()
954 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_gpio_direction_input()
961 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_direction_output() local
962 void __iomem *dout = sfp->base + GPON_DOUT_CFG + 8 * gpio; in starfive_gpio_direction_output()
963 void __iomem *doen = sfp->base + GPON_DOEN_CFG + 8 * gpio; in starfive_gpio_direction_output()
966 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_gpio_direction_output()
969 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_gpio_direction_output()
972 starfive_padctl_rmw(sfp, starfive_gpio_to_pin(sfp, gpio), in starfive_gpio_direction_output()
981 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_get() local
982 void __iomem *din = sfp->base + GPIODIN + 4 * (gpio / 32); in starfive_gpio_get()
990 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_set() local
991 void __iomem *dout = sfp->base + GPON_DOUT_CFG + 8 * gpio; in starfive_gpio_set()
994 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_gpio_set()
996 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_gpio_set()
1002 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_set_config() local
1038 starfive_padctl_rmw(sfp, starfive_gpio_to_pin(sfp, gpio), mask, value); in starfive_gpio_set_config()
1044 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_add_pin_ranges() local
1046 sfp->gpios.name = sfp->gc.label; in starfive_gpio_add_pin_ranges()
1047 sfp->gpios.base = sfp->gc.base; in starfive_gpio_add_pin_ranges()
1052 sfp->gpios.npins = NR_GPIOS; in starfive_gpio_add_pin_ranges()
1053 sfp->gpios.gc = &sfp->gc; in starfive_gpio_add_pin_ranges()
1054 pinctrl_add_gpio_range(sfp->pctl, &sfp->gpios); in starfive_gpio_add_pin_ranges()
1060 struct starfive_pinctrl *sfp = starfive_from_irq_data(d); in starfive_irq_ack() local
1062 void __iomem *ic = sfp->base + GPIOIC + 4 * (gpio / 32); in starfive_irq_ack()
1066 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_irq_ack()
1068 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_irq_ack()
1073 struct starfive_pinctrl *sfp = starfive_from_irq_data(d); in starfive_irq_mask() local
1075 void __iomem *ie = sfp->base + GPIOIE + 4 * (gpio / 32); in starfive_irq_mask()
1080 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_irq_mask()
1083 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_irq_mask()
1085 gpiochip_disable_irq(&sfp->gc, gpio); in starfive_irq_mask()
1090 struct starfive_pinctrl *sfp = starfive_from_irq_data(d); in starfive_irq_mask_ack() local
1092 void __iomem *ie = sfp->base + GPIOIE + 4 * (gpio / 32); in starfive_irq_mask_ack()
1093 void __iomem *ic = sfp->base + GPIOIC + 4 * (gpio / 32); in starfive_irq_mask_ack()
1098 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_irq_mask_ack()
1102 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_irq_mask_ack()
1107 struct starfive_pinctrl *sfp = starfive_from_irq_data(d); in starfive_irq_unmask() local
1109 void __iomem *ie = sfp->base + GPIOIE + 4 * (gpio / 32); in starfive_irq_unmask()
1114 gpiochip_enable_irq(&sfp->gc, gpio); in starfive_irq_unmask()
1116 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_irq_unmask()
1119 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_irq_unmask()
1124 struct starfive_pinctrl *sfp = starfive_from_irq_data(d); in starfive_irq_set_type() local
1126 void __iomem *base = sfp->base + 4 * (gpio / 32); in starfive_irq_set_type()
1166 raw_spin_lock_irqsave(&sfp->lock, flags); in starfive_irq_set_type()
1173 raw_spin_unlock_irqrestore(&sfp->lock, flags); in starfive_irq_set_type()
1190 struct starfive_pinctrl *sfp = starfive_from_irq_desc(desc); in starfive_gpio_irq_handler() local
1197 mis = readl_relaxed(sfp->base + GPIOMIS + 0); in starfive_gpio_irq_handler()
1199 generic_handle_domain_irq(sfp->gc.irq.domain, pin); in starfive_gpio_irq_handler()
1201 mis = readl_relaxed(sfp->base + GPIOMIS + 4); in starfive_gpio_irq_handler()
1203 generic_handle_domain_irq(sfp->gc.irq.domain, pin + 32); in starfive_gpio_irq_handler()
1210 struct starfive_pinctrl *sfp = container_of(gc, struct starfive_pinctrl, gc); in starfive_gpio_init_hw() local
1213 writel(0, sfp->base + GPIOIE + 0); in starfive_gpio_init_hw()
1214 writel(0, sfp->base + GPIOIE + 4); in starfive_gpio_init_hw()
1216 writel(~0U, sfp->base + GPIOIC + 0); in starfive_gpio_init_hw()
1217 writel(~0U, sfp->base + GPIOIC + 4); in starfive_gpio_init_hw()
1219 writel(1, sfp->base + GPIOEN); in starfive_gpio_init_hw()
1231 struct starfive_pinctrl *sfp; in starfive_probe() local
1237 sfp = devm_kzalloc(dev, sizeof(*sfp), GFP_KERNEL); in starfive_probe()
1238 if (!sfp) in starfive_probe()
1241 sfp->base = devm_platform_ioremap_resource_byname(pdev, "gpio"); in starfive_probe()
1242 if (IS_ERR(sfp->base)) in starfive_probe()
1243 return PTR_ERR(sfp->base); in starfive_probe()
1245 sfp->padctl = devm_platform_ioremap_resource_byname(pdev, "padctl"); in starfive_probe()
1246 if (IS_ERR(sfp->padctl)) in starfive_probe()
1247 return PTR_ERR(sfp->padctl); in starfive_probe()
1274 platform_set_drvdata(pdev, sfp); in starfive_probe()
1275 sfp->gc.parent = dev; in starfive_probe()
1276 raw_spin_lock_init(&sfp->lock); in starfive_probe()
1277 mutex_init(&sfp->mutex); in starfive_probe()
1279 ret = devm_pinctrl_register_and_init(dev, &starfive_desc, sfp, &sfp->pctl); in starfive_probe()
1286 writel(value, sfp->padctl + IO_PADSHARE_SEL); in starfive_probe()
1289 value = readl(sfp->padctl + IO_PADSHARE_SEL); in starfive_probe()
1292 sfp->gpios.pin_base = PAD_INVALID_GPIO; in starfive_probe()
1295 sfp->gpios.pin_base = PAD_GPIO(0); in starfive_probe()
1298 sfp->gpios.pin_base = PAD_FUNC_SHARE(72); in starfive_probe()
1301 sfp->gpios.pin_base = PAD_FUNC_SHARE(70); in starfive_probe()
1304 sfp->gpios.pin_base = PAD_FUNC_SHARE(0); in starfive_probe()
1310 sfp->gc.label = dev_name(dev); in starfive_probe()
1311 sfp->gc.owner = THIS_MODULE; in starfive_probe()
1312 sfp->gc.request = starfive_gpio_request; in starfive_probe()
1313 sfp->gc.free = starfive_gpio_free; in starfive_probe()
1314 sfp->gc.get_direction = starfive_gpio_get_direction; in starfive_probe()
1315 sfp->gc.direction_input = starfive_gpio_direction_input; in starfive_probe()
1316 sfp->gc.direction_output = starfive_gpio_direction_output; in starfive_probe()
1317 sfp->gc.get = starfive_gpio_get; in starfive_probe()
1318 sfp->gc.set = starfive_gpio_set; in starfive_probe()
1319 sfp->gc.set_config = starfive_gpio_set_config; in starfive_probe()
1320 sfp->gc.add_pin_ranges = starfive_gpio_add_pin_ranges; in starfive_probe()
1321 sfp->gc.base = -1; in starfive_probe()
1322 sfp->gc.ngpio = NR_GPIOS; in starfive_probe()
1324 gpio_irq_chip_set_chip(&sfp->gc.irq, &starfive_irq_chip); in starfive_probe()
1325 sfp->gc.irq.parent_handler = starfive_gpio_irq_handler; in starfive_probe()
1326 sfp->gc.irq.num_parents = 1; in starfive_probe()
1327 sfp->gc.irq.parents = devm_kcalloc(dev, sfp->gc.irq.num_parents, in starfive_probe()
1328 sizeof(*sfp->gc.irq.parents), GFP_KERNEL); in starfive_probe()
1329 if (!sfp->gc.irq.parents) in starfive_probe()
1331 sfp->gc.irq.default_type = IRQ_TYPE_NONE; in starfive_probe()
1332 sfp->gc.irq.handler = handle_bad_irq; in starfive_probe()
1333 sfp->gc.irq.init_hw = starfive_gpio_init_hw; in starfive_probe()
1338 sfp->gc.irq.parents[0] = ret; in starfive_probe()
1340 ret = devm_gpiochip_add_data(dev, &sfp->gc, sfp); in starfive_probe()
1344 irq_domain_set_pm_device(sfp->gc.irq.domain, dev); in starfive_probe()
1347 return pinctrl_enable(sfp->pctl); in starfive_probe()