drivers/gpio/atmel_pio4.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Atmel PIO4 device driver
   4  *
   5  * Copyright (C) 2015 Atmel Corporation
   6  *               Wenyou.Yang <wenyou.yang@atmel.com>
   7  */
   8 #include <common.h>
   9 #include <clk.h>
  10 #include <dm.h>
  11 #include <fdtdec.h>
  12 #include <malloc.h>
  13 #include <asm/arch/hardware.h>
  14 #include <asm/gpio.h>
  15 #include <linux/bitops.h>
  16 #include <mach/gpio.h>
  17 #include <mach/atmel_pio4.h>
  18
  19 DECLARE_GLOBAL_DATA_PTR;
  20
  21 static struct atmel_pio4_port *atmel_pio4_port_base(u32 port)
  22 {
  23         struct atmel_pio4_port *base = NULL;
  24
  25         switch (port) {
  26         case AT91_PIO_PORTA:
  27                 base = (struct atmel_pio4_port *)ATMEL_BASE_PIOA;
  28                 break;
  29         case AT91_PIO_PORTB:
  30                 base = (struct atmel_pio4_port *)ATMEL_BASE_PIOB;
  31                 break;
  32         case AT91_PIO_PORTC:
  33                 base = (struct atmel_pio4_port *)ATMEL_BASE_PIOC;
  34                 break;
  35         case AT91_PIO_PORTD:
  36                 base = (struct atmel_pio4_port *)ATMEL_BASE_PIOD;
  37                 break;
  38         default:
  39                 printf("Error: Atmel PIO4: Failed to get PIO base of port#%d!\n",
  40                        port);
  41                 break;
  42         }
  43
  44         return base;
  45 }
  46
  47 static int atmel_pio4_config_io_func(u32 port, u32 pin,
  48                                      u32 func, u32 config)
  49 {
  50         struct atmel_pio4_port *port_base;
  51         u32 reg, mask;
  52
  53         if (pin >= ATMEL_PIO_NPINS_PER_BANK)
  54                 return -EINVAL;
  55
  56         port_base = atmel_pio4_port_base(port);
  57         if (!port_base)
  58                 return -EINVAL;
  59
  60         mask = 1 << pin;
  61         reg = func;
  62         reg |= config;
  63
  64         writel(mask, &port_base->mskr);
  65         writel(reg, &port_base->cfgr);
  66
  67         return 0;
  68 }
  69
  70 int atmel_pio4_set_gpio(u32 port, u32 pin, u32 config)
  71 {
  72         return atmel_pio4_config_io_func(port, pin,
  73                                          ATMEL_PIO_CFGR_FUNC_GPIO,
  74                                          config);
  75 }
  76
  77 int atmel_pio4_set_a_periph(u32 port, u32 pin, u32 config)
  78 {
  79         return atmel_pio4_config_io_func(port, pin,
  80                                          ATMEL_PIO_CFGR_FUNC_PERIPH_A,
  81                                          config);
  82 }
  83
  84 int atmel_pio4_set_b_periph(u32 port, u32 pin, u32 config)
  85 {
  86         return atmel_pio4_config_io_func(port, pin,
  87                                          ATMEL_PIO_CFGR_FUNC_PERIPH_B,
  88                                          config);
  89 }
  90
  91 int atmel_pio4_set_c_periph(u32 port, u32 pin, u32 config)
  92 {
  93         return atmel_pio4_config_io_func(port, pin,
  94                                          ATMEL_PIO_CFGR_FUNC_PERIPH_C,
  95                                          config);
  96 }
  97
  98 int atmel_pio4_set_d_periph(u32 port, u32 pin, u32 config)
  99 {
 100         return atmel_pio4_config_io_func(port, pin,
 101                                          ATMEL_PIO_CFGR_FUNC_PERIPH_D,
 102                                          config);
 103 }
 104
 105 int atmel_pio4_set_e_periph(u32 port, u32 pin, u32 config)
 106 {
 107         return atmel_pio4_config_io_func(port, pin,
 108                                          ATMEL_PIO_CFGR_FUNC_PERIPH_E,
 109                                          config);
 110 }
 111
 112 int atmel_pio4_set_f_periph(u32 port, u32 pin, u32 config)
 113 {
 114         return atmel_pio4_config_io_func(port, pin,
 115                                          ATMEL_PIO_CFGR_FUNC_PERIPH_F,
 116                                          config);
 117 }
 118
 119 int atmel_pio4_set_g_periph(u32 port, u32 pin, u32 config)
 120 {
 121         return atmel_pio4_config_io_func(port, pin,
 122                                          ATMEL_PIO_CFGR_FUNC_PERIPH_G,
 123                                          config);
 124 }
 125
 126 int atmel_pio4_set_pio_output(u32 port, u32 pin, u32 value)
 127 {
 128         struct atmel_pio4_port *port_base;
 129         u32 reg, mask;
 130
 131         if (pin >= ATMEL_PIO_NPINS_PER_BANK)
 132                 return -EINVAL;
 133
 134         port_base = atmel_pio4_port_base(port);
 135         if (!port_base)
 136                 return -EINVAL;
 137
 138         mask = 0x01 << pin;
 139         reg = ATMEL_PIO_CFGR_FUNC_GPIO | ATMEL_PIO_DIR_MASK;
 140
 141         writel(mask, &port_base->mskr);
 142         writel(reg, &port_base->cfgr);
 143
 144         if (value)
 145                 writel(mask, &port_base->sodr);
 146         else
 147                 writel(mask, &port_base->codr);
 148
 149         return 0;
 150 }
 151
 152 int atmel_pio4_get_pio_input(u32 port, u32 pin)
 153 {
 154         struct atmel_pio4_port *port_base;
 155         u32 reg, mask;
 156
 157         if (pin >= ATMEL_PIO_NPINS_PER_BANK)
 158                 return -EINVAL;
 159
 160         port_base = atmel_pio4_port_base(port);
 161         if (!port_base)
 162                 return -EINVAL;
 163
 164         mask = 0x01 << pin;
 165         reg = ATMEL_PIO_CFGR_FUNC_GPIO;
 166
 167         writel(mask, &port_base->mskr);
 168         writel(reg, &port_base->cfgr);
 169
 170         return (readl(&port_base->pdsr) & mask) ? 1 : 0;
 171 }
 172
 173 #if CONFIG_IS_ENABLED(DM_GPIO)
 174
 175 struct atmel_pioctrl_data {
 176         u32 nbanks;
 177 };
 178
 179 struct atmel_pio4_platdata {
 180         struct atmel_pio4_port *reg_base;
 181 };
 182
 183 static struct atmel_pio4_port *atmel_pio4_bank_base(struct udevice *dev,
 184                                                     u32 bank)
 185 {
 186         struct atmel_pio4_platdata *plat = dev_get_platdata(dev);
 187         struct atmel_pio4_port *port_base =
 188                         (struct atmel_pio4_port *)((u32)plat->reg_base +
 189                         ATMEL_PIO_BANK_OFFSET * bank);
 190
 191         return port_base;
 192 }
 193
 194 static int atmel_pio4_direction_input(struct udevice *dev, unsigned offset)
 195 {
 196         u32 bank = ATMEL_PIO_BANK(offset);
 197         u32 line = ATMEL_PIO_LINE(offset);
 198         struct atmel_pio4_port *port_base = atmel_pio4_bank_base(dev, bank);
 199         u32 mask = BIT(line);
 200
 201         writel(mask, &port_base->mskr);
 202
 203         clrbits_le32(&port_base->cfgr,
 204                      ATMEL_PIO_CFGR_FUNC_MASK | ATMEL_PIO_DIR_MASK);
 205
 206         return 0;
 207 }
 208
 209 static int atmel_pio4_direction_output(struct udevice *dev,
 210                                        unsigned offset, int value)
 211 {
 212         u32 bank = ATMEL_PIO_BANK(offset);
 213         u32 line = ATMEL_PIO_LINE(offset);
 214         struct atmel_pio4_port *port_base = atmel_pio4_bank_base(dev, bank);
 215         u32 mask = BIT(line);
 216
 217         writel(mask, &port_base->mskr);
 218
 219         clrsetbits_le32(&port_base->cfgr,
 220                         ATMEL_PIO_CFGR_FUNC_MASK, ATMEL_PIO_DIR_MASK);
 221
 222         if (value)
 223                 writel(mask, &port_base->sodr);
 224         else
 225                 writel(mask, &port_base->codr);
 226
 227         return 0;
 228 }
 229
 230 static int atmel_pio4_get_value(struct udevice *dev, unsigned offset)
 231 {
 232         u32 bank = ATMEL_PIO_BANK(offset);
 233         u32 line = ATMEL_PIO_LINE(offset);
 234         struct atmel_pio4_port *port_base = atmel_pio4_bank_base(dev, bank);
 235         u32 mask = BIT(line);
 236
 237         return (readl(&port_base->pdsr) & mask) ? 1 : 0;
 238 }
 239
 240 static int atmel_pio4_set_value(struct udevice *dev,
 241                                 unsigned offset, int value)
 242 {
 243         u32 bank = ATMEL_PIO_BANK(offset);
 244         u32 line = ATMEL_PIO_LINE(offset);
 245         struct atmel_pio4_port *port_base = atmel_pio4_bank_base(dev, bank);
 246         u32 mask = BIT(line);
 247
 248         if (value)
 249                 writel(mask, &port_base->sodr);
 250         else
 251                 writel(mask, &port_base->codr);
 252
 253         return 0;
 254 }
 255
 256 static int atmel_pio4_get_function(struct udevice *dev, unsigned offset)
 257 {
 258         u32 bank = ATMEL_PIO_BANK(offset);
 259         u32 line = ATMEL_PIO_LINE(offset);
 260         struct atmel_pio4_port *port_base = atmel_pio4_bank_base(dev, bank);
 261         u32 mask = BIT(line);
 262
 263         writel(mask, &port_base->mskr);
 264
 265         return (readl(&port_base->cfgr) &
 266                 ATMEL_PIO_DIR_MASK) ? GPIOF_OUTPUT : GPIOF_INPUT;
 267 }
 268
 269 static const struct dm_gpio_ops atmel_pio4_ops = {
 270         .direction_input        = atmel_pio4_direction_input,
 271         .direction_output       = atmel_pio4_direction_output,
 272         .get_value              = atmel_pio4_get_value,
 273         .set_value              = atmel_pio4_set_value,
 274         .get_function           = atmel_pio4_get_function,
 275 };
 276
 277 static int atmel_pio4_bind(struct udevice *dev)
 278 {
 279         return dm_scan_fdt_dev(dev);
 280 }
 281
 282 static int atmel_pio4_probe(struct udevice *dev)
 283 {
 284         struct atmel_pio4_platdata *plat = dev_get_platdata(dev);
 285         struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 286         struct atmel_pioctrl_data *pioctrl_data;
 287         struct clk clk;
 288         fdt_addr_t addr_base;
 289         u32 nbanks;
 290         int ret;
 291
 292         ret = clk_get_by_index(dev, 0, &clk);
 293         if (ret)
 294                 return ret;
 295
 296         ret = clk_enable(&clk);
 297         if (ret)
 298                 return ret;
 299
 300         clk_free(&clk);
 301
 302         addr_base = dev_read_addr(dev);
 303         if (addr_base == FDT_ADDR_T_NONE)
 304                 return -EINVAL;
 305
 306         plat->reg_base = (struct atmel_pio4_port *)addr_base;
 307
 308         pioctrl_data = (struct atmel_pioctrl_data *)dev_get_driver_data(dev);
 309         nbanks = pioctrl_data->nbanks;
 310
 311         uc_priv->bank_name = fdt_get_name(gd->fdt_blob, dev_of_offset(dev),
 312                                           NULL);
 313         uc_priv->gpio_count = nbanks * ATMEL_PIO_NPINS_PER_BANK;
 314
 315         return 0;
 316 }
 317
 318 /*
 319  * The number of banks can be different from a SoC to another one.
 320  * We can have up to 16 banks.
 321  */
 322 static const struct atmel_pioctrl_data atmel_sama5d2_pioctrl_data = {
 323         .nbanks = 4,
 324 };
 325
 326 static const struct udevice_id atmel_pio4_ids[] = {
 327         {
 328                 .compatible = "atmel,sama5d2-gpio",
 329                 .data = (ulong)&atmel_sama5d2_pioctrl_data,
 330         },
 331         {}
 332 };
 333
 334 U_BOOT_DRIVER(gpio_atmel_pio4) = {
 335         .name   = "gpio_atmel_pio4",
 336         .id     = UCLASS_GPIO,
 337         .ops    = &atmel_pio4_ops,
 338         .probe  = atmel_pio4_probe,
 339         .bind   = atmel_pio4_bind,
 340         .of_match = atmel_pio4_ids,
 341         .platdata_auto_alloc_size = sizeof(struct atmel_pio4_platdata),
 342 };
 343
 344 #endif