1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (C) 2017 Álvaro Fernández Rojas <noltari@gmail.com> 4 * 5 * Derived from linux/arch/mips/bcm63xx/gpio.c: 6 * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> 7 * Copyright (C) 2008-2011 Florian Fainelli <florian@openwrt.org> 8 */ 9 10 #include <common.h> 11 #include <dm.h> 12 #include <errno.h> 13 #include <asm/gpio.h> 14 #include <asm/io.h> 15 16 struct bcm6345_gpio_priv { 17 void __iomem *reg_dirout; 18 void __iomem *reg_data; 19 }; 20 21 static int bcm6345_gpio_get_value(struct udevice *dev, unsigned offset) 22 { 23 struct bcm6345_gpio_priv *priv = dev_get_priv(dev); 24 25 return !!(readl_be(priv->reg_data) & BIT(offset)); 26 } 27 28 static int bcm6345_gpio_set_value(struct udevice *dev, unsigned offset, 29 int value) 30 { 31 struct bcm6345_gpio_priv *priv = dev_get_priv(dev); 32 33 if (value) 34 setbits_be32(priv->reg_data, BIT(offset)); 35 else 36 clrbits_be32(priv->reg_data, BIT(offset)); 37 38 return 0; 39 } 40 41 static int bcm6345_gpio_set_direction(void __iomem *dirout, unsigned offset, 42 bool input) 43 { 44 if (input) 45 clrbits_be32(dirout, BIT(offset)); 46 else 47 setbits_be32(dirout, BIT(offset)); 48 49 return 0; 50 } 51 52 static int bcm6345_gpio_direction_input(struct udevice *dev, unsigned offset) 53 { 54 struct bcm6345_gpio_priv *priv = dev_get_priv(dev); 55 56 return bcm6345_gpio_set_direction(priv->reg_dirout, offset, 1); 57 } 58 59 static int bcm6345_gpio_direction_output(struct udevice *dev, unsigned offset, 60 int value) 61 { 62 struct bcm6345_gpio_priv *priv = dev_get_priv(dev); 63 64 bcm6345_gpio_set_value(dev, offset, value); 65 66 return bcm6345_gpio_set_direction(priv->reg_dirout, offset, 0); 67 } 68 69 static int bcm6345_gpio_get_function(struct udevice *dev, unsigned offset) 70 { 71 struct bcm6345_gpio_priv *priv = dev_get_priv(dev); 72 73 if (readl_be(priv->reg_dirout) & BIT(offset)) 74 return GPIOF_OUTPUT; 75 else 76 return GPIOF_INPUT; 77 } 78 79 static const struct dm_gpio_ops bcm6345_gpio_ops = { 80 .direction_input = bcm6345_gpio_direction_input, 81 .direction_output = bcm6345_gpio_direction_output, 82 .get_value = bcm6345_gpio_get_value, 83 .set_value = bcm6345_gpio_set_value, 84 .get_function = bcm6345_gpio_get_function, 85 }; 86 87 static int bcm6345_gpio_probe(struct udevice *dev) 88 { 89 struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev); 90 struct bcm6345_gpio_priv *priv = dev_get_priv(dev); 91 92 priv->reg_dirout = dev_remap_addr_index(dev, 0); 93 if (!priv->reg_dirout) 94 return -EINVAL; 95 96 priv->reg_data = dev_remap_addr_index(dev, 1); 97 if (!priv->reg_data) 98 return -EINVAL; 99 100 uc_priv->gpio_count = dev_read_u32_default(dev, "ngpios", 32); 101 uc_priv->bank_name = dev->name; 102 103 return 0; 104 } 105 106 static const struct udevice_id bcm6345_gpio_ids[] = { 107 { .compatible = "brcm,bcm6345-gpio" }, 108 { /* sentinel */ } 109 }; 110 111 U_BOOT_DRIVER(bcm6345_gpio) = { 112 .name = "bcm6345-gpio", 113 .id = UCLASS_GPIO, 114 .of_match = bcm6345_gpio_ids, 115 .ops = &bcm6345_gpio_ops, 116 .priv_auto_alloc_size = sizeof(struct bcm6345_gpio_priv), 117 .probe = bcm6345_gpio_probe, 118 }; 119