drivers/pinctrl/visconti/pinctrl-common.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2020 TOSHIBA CORPORATION
   4  * Copyright (c) 2020 Toshiba Electronic Devices & Storage Corporation
   5  * Copyright (c) 2020 Nobuhiro Iwamatsu <nobuhiro1.iwamatsu@toshiba.co.jp>
   6  */
   7
   8 #include <linux/init.h>
   9 #include <linux/of.h>
  10 #include <linux/io.h>
  11 #include <linux/platform_device.h>
  12 #include <linux/pinctrl/pinctrl.h>
  13 #include <linux/pinctrl/pinmux.h>
  14 #include <linux/pinctrl/pinconf.h>
  15 #include <linux/pinctrl/pinconf-generic.h>
  16 #include "pinctrl-common.h"
  17 #include "../core.h"
  18 #include "../pinconf.h"
  19 #include "../pinctrl-utils.h"
  20
  21 #define DSEL_MASK GENMASK(3, 0)
  22
  23 /* private data */
  24 struct visconti_pinctrl {
  25         void __iomem *base;
  26         struct device *dev;
  27         struct pinctrl_dev *pctl;
  28         struct pinctrl_desc pctl_desc;
  29
  30         const struct visconti_pinctrl_devdata  *devdata;
  31
  32         spinlock_t lock; /* protect pinctrl register */
  33 };
  34
  35 /* pinconf */
  36 static int visconti_pin_config_set(struct pinctrl_dev *pctldev,
  37                                   unsigned int _pin,
  38                                   unsigned long *configs,
  39                                   unsigned int num_configs)
  40 {
  41         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
  42         const struct visconti_desc_pin *pin = &priv->devdata->pins[_pin];
  43         enum pin_config_param param;
  44         unsigned int arg;
  45         int i, ret = 0;
  46         unsigned int val, set_val, pude_val;
  47         unsigned long flags;
  48
  49         dev_dbg(priv->dev, "%s: pin = %d (%s)\n", __func__, _pin, pin->pin.name);
  50
  51         spin_lock_irqsave(&priv->lock, flags);
  52
  53         for (i = 0; i < num_configs; i++) {
  54                 set_val = 0;
  55                 pude_val = 0;
  56
  57                 param = pinconf_to_config_param(configs[i]);
  58                 switch (param) {
  59                 case PIN_CONFIG_BIAS_PULL_UP:
  60                         set_val = 1;
  61                         fallthrough;
  62                 case PIN_CONFIG_BIAS_PULL_DOWN:
  63                         /* update pudsel setting */
  64                         val = readl(priv->base + pin->pudsel_offset);
  65                         val &= ~BIT(pin->pud_shift);
  66                         val |= set_val << pin->pud_shift;
  67                         writel(val, priv->base + pin->pudsel_offset);
  68                         pude_val = 1;
  69                         fallthrough;
  70                 case PIN_CONFIG_BIAS_DISABLE:
  71                         /* update pude setting */
  72                         val = readl(priv->base + pin->pude_offset);
  73                         val &= ~BIT(pin->pud_shift);
  74                         val |= pude_val << pin->pud_shift;
  75                         writel(val, priv->base + pin->pude_offset);
  76                         dev_dbg(priv->dev, "BIAS(%d): off = 0x%x val = 0x%x\n",
  77                                 param, pin->pude_offset, val);
  78                         break;
  79
  80                 case PIN_CONFIG_DRIVE_STRENGTH:
  81                         arg = pinconf_to_config_argument(configs[i]);
  82                         dev_dbg(priv->dev, "DRV_STR arg = %d\n", arg);
  83                         switch (arg) {
  84                         case 2:
  85                         case 4:
  86                         case 8:
  87                         case 16:
  88                         case 24:
  89                         case 32:
  90                                 /*
  91                                  * I/O drive capacity setting:
  92                                  * 2mA: 0
  93                                  * 4mA: 1
  94                                  * 8mA: 3
  95                                  * 16mA: 7
  96                                  * 24mA: 11
  97                                  * 32mA: 15
  98                                  */
  99                                 set_val = DIV_ROUND_CLOSEST(arg, 2) - 1;
 100                                 break;
 101                         default:
 102                                 ret = -EINVAL;
 103                                 goto err;
 104                         }
 105                         /* update drive setting */
 106                         val = readl(priv->base + pin->dsel_offset);
 107                         val &= ~(DSEL_MASK << pin->dsel_shift);
 108                         val |= set_val << pin->dsel_shift;
 109                         writel(val, priv->base + pin->dsel_offset);
 110                         break;
 111
 112                 default:
 113                         ret = -EOPNOTSUPP;
 114                         goto err;
 115                 }
 116         }
 117 err:
 118         spin_unlock_irqrestore(&priv->lock, flags);
 119         return ret;
 120 }
 121
 122 static int visconti_pin_config_group_set(struct pinctrl_dev *pctldev,
 123                                         unsigned int selector,
 124                                         unsigned long *configs,
 125                                         unsigned int num_configs)
 126 {
 127         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 128         const unsigned int *pins;
 129         unsigned int num_pins;
 130         int i, ret;
 131
 132         pins = priv->devdata->groups[selector].pins;
 133         num_pins = priv->devdata->groups[selector].nr_pins;
 134
 135         dev_dbg(priv->dev, "%s: select = %d, n_pin = %d, n_config = %d\n",
 136                 __func__, selector, num_pins, num_configs);
 137
 138         for (i = 0; i < num_pins; i++) {
 139                 ret = visconti_pin_config_set(pctldev, pins[i],
 140                                              configs, num_configs);
 141                 if (ret)
 142                         return ret;
 143         }
 144
 145         return 0;
 146 }
 147 static const struct pinconf_ops visconti_pinconf_ops = {
 148         .is_generic                     = true,
 149         .pin_config_set                 = visconti_pin_config_set,
 150         .pin_config_group_set           = visconti_pin_config_group_set,
 151         .pin_config_config_dbg_show     = pinconf_generic_dump_config,
 152 };
 153
 154 /* pinctrl */
 155 static int visconti_get_groups_count(struct pinctrl_dev *pctldev)
 156 {
 157         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 158
 159         return priv->devdata->nr_groups;
 160 }
 161
 162 static const char *visconti_get_group_name(struct pinctrl_dev *pctldev,
 163                                               unsigned int selector)
 164 {
 165         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 166
 167         return priv->devdata->groups[selector].name;
 168 }
 169
 170 static int visconti_get_group_pins(struct pinctrl_dev *pctldev,
 171                                       unsigned int selector,
 172                                       const unsigned int **pins,
 173                                       unsigned int *num_pins)
 174 {
 175         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 176
 177         *pins = priv->devdata->groups[selector].pins;
 178         *num_pins = priv->devdata->groups[selector].nr_pins;
 179
 180         return 0;
 181 }
 182
 183 static const struct pinctrl_ops visconti_pinctrl_ops = {
 184         .get_groups_count       = visconti_get_groups_count,
 185         .get_group_name         = visconti_get_group_name,
 186         .get_group_pins         = visconti_get_group_pins,
 187         .dt_node_to_map         = pinconf_generic_dt_node_to_map_group,
 188         .dt_free_map            = pinctrl_utils_free_map,
 189 };
 190
 191 /* pinmux */
 192 static int visconti_get_functions_count(struct pinctrl_dev *pctldev)
 193 {
 194         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 195
 196         return priv->devdata->nr_functions;
 197 }
 198
 199 static const char *visconti_get_function_name(struct pinctrl_dev *pctldev,
 200                                              unsigned int selector)
 201 {
 202         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 203
 204         return priv->devdata->functions[selector].name;
 205 }
 206
 207 static int visconti_get_function_groups(struct pinctrl_dev *pctldev,
 208                                        unsigned int selector,
 209                                        const char * const **groups,
 210                                        unsigned * const num_groups)
 211 {
 212         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 213
 214         *groups = priv->devdata->functions[selector].groups;
 215         *num_groups = priv->devdata->functions[selector].nr_groups;
 216
 217         return 0;
 218 }
 219
 220 static int visconti_set_mux(struct pinctrl_dev *pctldev,
 221                            unsigned int function, unsigned int group)
 222 {
 223         struct visconti_pinctrl *priv = pinctrl_dev_get_drvdata(pctldev);
 224         const struct visconti_pin_function *func = &priv->devdata->functions[function];
 225         const struct visconti_pin_group *grp = &priv->devdata->groups[group];
 226         const struct visconti_mux *mux = &grp->mux;
 227         unsigned int val;
 228         unsigned long flags;
 229
 230         dev_dbg(priv->dev, "%s: function = %d(%s) group = %d(%s)\n", __func__,
 231                 function, func->name, group, grp->name);
 232
 233         spin_lock_irqsave(&priv->lock, flags);
 234
 235         /* update mux */
 236         val = readl(priv->base + mux->offset);
 237         val &= ~mux->mask;
 238         val |= mux->val;
 239         writel(val, priv->base + mux->offset);
 240
 241         spin_unlock_irqrestore(&priv->lock, flags);
 242
 243         dev_dbg(priv->dev, "[%x]: 0x%x\n", mux->offset, val);
 244
 245         return 0;
 246 }
 247
 248 static const struct pinmux_ops visconti_pinmux_ops = {
 249         .get_functions_count    = visconti_get_functions_count,
 250         .get_function_name      = visconti_get_function_name,
 251         .get_function_groups    = visconti_get_function_groups,
 252         .set_mux                = visconti_set_mux,
 253         .strict                 = true,
 254 };
 255
 256 int visconti_pinctrl_probe(struct platform_device *pdev,
 257                           const struct visconti_pinctrl_devdata *devdata)
 258 {
 259         struct device *dev = &pdev->dev;
 260         struct visconti_pinctrl *priv;
 261         struct pinctrl_pin_desc *pins;
 262         int i, ret;
 263
 264         priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 265         if (!priv)
 266                 return -ENOMEM;
 267
 268         priv->dev = dev;
 269         priv->devdata = devdata;
 270         spin_lock_init(&priv->lock);
 271
 272         priv->base = devm_platform_ioremap_resource(pdev, 0);
 273         if (IS_ERR(priv->base)) {
 274                 dev_err(dev, "unable to map I/O space\n");
 275                 return PTR_ERR(priv->base);
 276         }
 277
 278         pins = devm_kcalloc(dev, devdata->nr_pins,
 279                             sizeof(*pins), GFP_KERNEL);
 280         if (!pins)
 281                 return -ENOMEM;
 282
 283         for (i = 0; i < devdata->nr_pins; i++)
 284                 pins[i] = devdata->pins[i].pin;
 285
 286         priv->pctl_desc.name = dev_name(dev);
 287         priv->pctl_desc.owner = THIS_MODULE;
 288         priv->pctl_desc.pins = pins;
 289         priv->pctl_desc.npins = devdata->nr_pins;
 290         priv->pctl_desc.confops = &visconti_pinconf_ops;
 291         priv->pctl_desc.pctlops = &visconti_pinctrl_ops;
 292         priv->pctl_desc.pmxops = &visconti_pinmux_ops;
 293
 294         ret = devm_pinctrl_register_and_init(dev, &priv->pctl_desc,
 295                                              priv, &priv->pctl);
 296         if (ret) {
 297                 dev_err(dev, "couldn't register pinctrl: %d\n", ret);
 298                 return ret;
 299         }
 300
 301         if (devdata->unlock)
 302                 devdata->unlock(priv->base);
 303
 304         return pinctrl_enable(priv->pctl);
 305 }