Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 1 | /* |
| 2 | * SuperH Pin Function Controller pinmux support. |
| 3 | * |
| 4 | * Copyright (C) 2012 Paul Mundt |
| 5 | * |
| 6 | * This file is subject to the terms and conditions of the GNU General Public |
| 7 | * License. See the file "COPYING" in the main directory of this archive |
| 8 | * for more details. |
| 9 | */ |
Paul Mundt | 5440711 | 2012-07-20 16:18:21 +0900 | [diff] [blame] | 10 | |
Laurent Pinchart | c6193ea | 2012-12-15 23:50:47 +0100 | [diff] [blame] | 11 | #define DRV_NAME "sh-pfc" |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 12 | |
Laurent Pinchart | 1724acf | 2012-12-15 23:50:48 +0100 | [diff] [blame] | 13 | #include <linux/device.h> |
Laurent Pinchart | 90efde2 | 2012-12-15 23:50:52 +0100 | [diff] [blame] | 14 | #include <linux/err.h> |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 15 | #include <linux/init.h> |
| 16 | #include <linux/module.h> |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 17 | #include <linux/of.h> |
Laurent Pinchart | 90efde2 | 2012-12-15 23:50:52 +0100 | [diff] [blame] | 18 | #include <linux/pinctrl/consumer.h> |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 19 | #include <linux/pinctrl/machine.h> |
Laurent Pinchart | 90efde2 | 2012-12-15 23:50:52 +0100 | [diff] [blame] | 20 | #include <linux/pinctrl/pinconf.h> |
| 21 | #include <linux/pinctrl/pinconf-generic.h> |
| 22 | #include <linux/pinctrl/pinctrl.h> |
| 23 | #include <linux/pinctrl/pinmux.h> |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 24 | #include <linux/slab.h> |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 25 | #include <linux/spinlock.h> |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 26 | |
Laurent Pinchart | f916513 | 2012-12-15 23:50:44 +0100 | [diff] [blame] | 27 | #include "core.h" |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 28 | #include "../core.h" |
| 29 | #include "../pinconf.h" |
Laurent Pinchart | f916513 | 2012-12-15 23:50:44 +0100 | [diff] [blame] | 30 | |
Laurent Pinchart | 1a0039d | 2013-03-08 17:43:54 +0100 | [diff] [blame] | 31 | struct sh_pfc_pin_config { |
| 32 | u32 type; |
| 33 | }; |
| 34 | |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 35 | struct sh_pfc_pinctrl { |
| 36 | struct pinctrl_dev *pctl; |
Laurent Pinchart | dcc427e | 2013-02-16 16:38:30 +0100 | [diff] [blame] | 37 | struct pinctrl_desc pctl_desc; |
Laurent Pinchart | dcc427e | 2013-02-16 16:38:30 +0100 | [diff] [blame] | 38 | |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 39 | struct sh_pfc *pfc; |
| 40 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 41 | struct pinctrl_pin_desc *pins; |
Laurent Pinchart | 1a0039d | 2013-03-08 17:43:54 +0100 | [diff] [blame] | 42 | struct sh_pfc_pin_config *configs; |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 43 | |
| 44 | const char *func_prop_name; |
| 45 | const char *groups_prop_name; |
| 46 | const char *pins_prop_name; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 47 | }; |
| 48 | |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 49 | static int sh_pfc_get_groups_count(struct pinctrl_dev *pctldev) |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 50 | { |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 51 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 52 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 53 | return pmx->pfc->info->nr_groups; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 54 | } |
| 55 | |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 56 | static const char *sh_pfc_get_group_name(struct pinctrl_dev *pctldev, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 57 | unsigned selector) |
| 58 | { |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 59 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 60 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 61 | return pmx->pfc->info->groups[selector].name; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 62 | } |
| 63 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 64 | static int sh_pfc_get_group_pins(struct pinctrl_dev *pctldev, unsigned selector, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 65 | const unsigned **pins, unsigned *num_pins) |
| 66 | { |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 67 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 68 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 69 | *pins = pmx->pfc->info->groups[selector].pins; |
| 70 | *num_pins = pmx->pfc->info->groups[selector].nr_pins; |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 71 | |
| 72 | return 0; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 73 | } |
| 74 | |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 75 | static void sh_pfc_pin_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s, |
| 76 | unsigned offset) |
| 77 | { |
| 78 | seq_printf(s, "%s", DRV_NAME); |
| 79 | } |
| 80 | |
Laurent Pinchart | 3a8d63d | 2013-06-19 13:26:02 +0200 | [diff] [blame] | 81 | #ifdef CONFIG_OF |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 82 | static int sh_pfc_map_add_config(struct pinctrl_map *map, |
| 83 | const char *group_or_pin, |
| 84 | enum pinctrl_map_type type, |
| 85 | unsigned long *configs, |
| 86 | unsigned int num_configs) |
| 87 | { |
| 88 | unsigned long *cfgs; |
| 89 | |
| 90 | cfgs = kmemdup(configs, num_configs * sizeof(*cfgs), |
| 91 | GFP_KERNEL); |
| 92 | if (cfgs == NULL) |
| 93 | return -ENOMEM; |
| 94 | |
| 95 | map->type = type; |
| 96 | map->data.configs.group_or_pin = group_or_pin; |
| 97 | map->data.configs.configs = cfgs; |
| 98 | map->data.configs.num_configs = num_configs; |
| 99 | |
| 100 | return 0; |
| 101 | } |
| 102 | |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 103 | static int sh_pfc_dt_subnode_to_map(struct pinctrl_dev *pctldev, |
| 104 | struct device_node *np, |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 105 | struct pinctrl_map **map, |
| 106 | unsigned int *num_maps, unsigned int *index) |
| 107 | { |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 108 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 109 | struct device *dev = pmx->pfc->dev; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 110 | struct pinctrl_map *maps = *map; |
| 111 | unsigned int nmaps = *num_maps; |
| 112 | unsigned int idx = *index; |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 113 | unsigned int num_configs; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 114 | const char *function = NULL; |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 115 | unsigned long *configs; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 116 | struct property *prop; |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 117 | unsigned int num_groups; |
| 118 | unsigned int num_pins; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 119 | const char *group; |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 120 | const char *pin; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 121 | int ret; |
| 122 | |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 123 | /* Support both the old Renesas-specific properties and the new standard |
| 124 | * properties. Mixing old and new properties isn't allowed, neither |
| 125 | * inside a subnode nor across subnodes. |
| 126 | */ |
| 127 | if (!pmx->func_prop_name) { |
| 128 | if (of_find_property(np, "groups", NULL) || |
| 129 | of_find_property(np, "pins", NULL)) { |
| 130 | pmx->func_prop_name = "function"; |
| 131 | pmx->groups_prop_name = "groups"; |
| 132 | pmx->pins_prop_name = "pins"; |
| 133 | } else { |
| 134 | pmx->func_prop_name = "renesas,function"; |
| 135 | pmx->groups_prop_name = "renesas,groups"; |
| 136 | pmx->pins_prop_name = "renesas,pins"; |
| 137 | } |
| 138 | } |
| 139 | |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 140 | /* Parse the function and configuration properties. At least a function |
| 141 | * or one configuration must be specified. |
| 142 | */ |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 143 | ret = of_property_read_string(np, pmx->func_prop_name, &function); |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 144 | if (ret < 0 && ret != -EINVAL) { |
| 145 | dev_err(dev, "Invalid function in DT\n"); |
| 146 | return ret; |
| 147 | } |
| 148 | |
Soren Brinkmann | dd4d01f | 2015-01-09 07:43:46 -0800 | [diff] [blame] | 149 | ret = pinconf_generic_parse_dt_config(np, NULL, &configs, &num_configs); |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 150 | if (ret < 0) |
| 151 | return ret; |
| 152 | |
| 153 | if (!function && num_configs == 0) { |
| 154 | dev_err(dev, |
| 155 | "DT node must contain at least a function or config\n"); |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 156 | ret = -ENODEV; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 157 | goto done; |
| 158 | } |
| 159 | |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 160 | /* Count the number of pins and groups and reallocate mappings. */ |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 161 | ret = of_property_count_strings(np, pmx->pins_prop_name); |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 162 | if (ret == -EINVAL) { |
| 163 | num_pins = 0; |
| 164 | } else if (ret < 0) { |
| 165 | dev_err(dev, "Invalid pins list in DT\n"); |
| 166 | goto done; |
| 167 | } else { |
| 168 | num_pins = ret; |
| 169 | } |
| 170 | |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 171 | ret = of_property_count_strings(np, pmx->groups_prop_name); |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 172 | if (ret == -EINVAL) { |
| 173 | num_groups = 0; |
| 174 | } else if (ret < 0) { |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 175 | dev_err(dev, "Invalid pin groups list in DT\n"); |
| 176 | goto done; |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 177 | } else { |
| 178 | num_groups = ret; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 179 | } |
| 180 | |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 181 | if (!num_pins && !num_groups) { |
| 182 | dev_err(dev, "No pin or group provided in DT node\n"); |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 183 | ret = -ENODEV; |
| 184 | goto done; |
| 185 | } |
| 186 | |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 187 | if (function) |
| 188 | nmaps += num_groups; |
| 189 | if (configs) |
| 190 | nmaps += num_pins + num_groups; |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 191 | |
| 192 | maps = krealloc(maps, sizeof(*maps) * nmaps, GFP_KERNEL); |
| 193 | if (maps == NULL) { |
| 194 | ret = -ENOMEM; |
| 195 | goto done; |
| 196 | } |
| 197 | |
| 198 | *map = maps; |
| 199 | *num_maps = nmaps; |
| 200 | |
| 201 | /* Iterate over pins and groups and create the mappings. */ |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 202 | of_property_for_each_string(np, pmx->groups_prop_name, prop, group) { |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 203 | if (function) { |
| 204 | maps[idx].type = PIN_MAP_TYPE_MUX_GROUP; |
| 205 | maps[idx].data.mux.group = group; |
| 206 | maps[idx].data.mux.function = function; |
| 207 | idx++; |
| 208 | } |
| 209 | |
| 210 | if (configs) { |
| 211 | ret = sh_pfc_map_add_config(&maps[idx], group, |
| 212 | PIN_MAP_TYPE_CONFIGS_GROUP, |
| 213 | configs, num_configs); |
| 214 | if (ret < 0) |
| 215 | goto done; |
| 216 | |
| 217 | idx++; |
| 218 | } |
| 219 | } |
| 220 | |
| 221 | if (!configs) { |
| 222 | ret = 0; |
| 223 | goto done; |
| 224 | } |
| 225 | |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 226 | of_property_for_each_string(np, pmx->pins_prop_name, prop, pin) { |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 227 | ret = sh_pfc_map_add_config(&maps[idx], pin, |
| 228 | PIN_MAP_TYPE_CONFIGS_PIN, |
| 229 | configs, num_configs); |
| 230 | if (ret < 0) |
| 231 | goto done; |
| 232 | |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 233 | idx++; |
| 234 | } |
| 235 | |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 236 | done: |
| 237 | *index = idx; |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 238 | kfree(configs); |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 239 | return ret; |
| 240 | } |
| 241 | |
| 242 | static void sh_pfc_dt_free_map(struct pinctrl_dev *pctldev, |
| 243 | struct pinctrl_map *map, unsigned num_maps) |
| 244 | { |
Laurent Pinchart | 12f3ad8 | 2013-06-17 20:50:03 +0200 | [diff] [blame] | 245 | unsigned int i; |
| 246 | |
| 247 | if (map == NULL) |
| 248 | return; |
| 249 | |
| 250 | for (i = 0; i < num_maps; ++i) { |
| 251 | if (map[i].type == PIN_MAP_TYPE_CONFIGS_GROUP || |
| 252 | map[i].type == PIN_MAP_TYPE_CONFIGS_PIN) |
| 253 | kfree(map[i].data.configs.configs); |
| 254 | } |
| 255 | |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 256 | kfree(map); |
| 257 | } |
| 258 | |
| 259 | static int sh_pfc_dt_node_to_map(struct pinctrl_dev *pctldev, |
| 260 | struct device_node *np, |
| 261 | struct pinctrl_map **map, unsigned *num_maps) |
| 262 | { |
| 263 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 264 | struct device *dev = pmx->pfc->dev; |
| 265 | struct device_node *child; |
| 266 | unsigned int index; |
| 267 | int ret; |
| 268 | |
| 269 | *map = NULL; |
| 270 | *num_maps = 0; |
| 271 | index = 0; |
| 272 | |
| 273 | for_each_child_of_node(np, child) { |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 274 | ret = sh_pfc_dt_subnode_to_map(pctldev, child, map, num_maps, |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 275 | &index); |
Julia Lawall | d0b3ed4 | 2015-12-21 17:39:46 +0100 | [diff] [blame] | 276 | if (ret < 0) { |
| 277 | of_node_put(child); |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 278 | goto done; |
Julia Lawall | d0b3ed4 | 2015-12-21 17:39:46 +0100 | [diff] [blame] | 279 | } |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 280 | } |
| 281 | |
| 282 | /* If no mapping has been found in child nodes try the config node. */ |
| 283 | if (*num_maps == 0) { |
Laurent Pinchart | 16ccaf5 | 2015-06-30 11:29:57 +0300 | [diff] [blame] | 284 | ret = sh_pfc_dt_subnode_to_map(pctldev, np, map, num_maps, |
| 285 | &index); |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 286 | if (ret < 0) |
| 287 | goto done; |
| 288 | } |
| 289 | |
| 290 | if (*num_maps) |
| 291 | return 0; |
| 292 | |
| 293 | dev_err(dev, "no mapping found in node %s\n", np->full_name); |
| 294 | ret = -EINVAL; |
| 295 | |
| 296 | done: |
| 297 | if (ret < 0) |
| 298 | sh_pfc_dt_free_map(pctldev, *map, *num_maps); |
| 299 | |
| 300 | return ret; |
| 301 | } |
Laurent Pinchart | 3a8d63d | 2013-06-19 13:26:02 +0200 | [diff] [blame] | 302 | #endif /* CONFIG_OF */ |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 303 | |
Laurent Pinchart | fe330ce | 2013-02-15 16:04:47 +0100 | [diff] [blame] | 304 | static const struct pinctrl_ops sh_pfc_pinctrl_ops = { |
Paul Mundt | e3f805e | 2012-07-17 15:48:18 +0900 | [diff] [blame] | 305 | .get_groups_count = sh_pfc_get_groups_count, |
| 306 | .get_group_name = sh_pfc_get_group_name, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 307 | .get_group_pins = sh_pfc_get_group_pins, |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 308 | .pin_dbg_show = sh_pfc_pin_dbg_show, |
Laurent Pinchart | 3a8d63d | 2013-06-19 13:26:02 +0200 | [diff] [blame] | 309 | #ifdef CONFIG_OF |
Laurent Pinchart | fe1c9a8 | 2013-06-17 20:50:02 +0200 | [diff] [blame] | 310 | .dt_node_to_map = sh_pfc_dt_node_to_map, |
| 311 | .dt_free_map = sh_pfc_dt_free_map, |
Laurent Pinchart | 3a8d63d | 2013-06-19 13:26:02 +0200 | [diff] [blame] | 312 | #endif |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 313 | }; |
| 314 | |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 315 | static int sh_pfc_get_functions_count(struct pinctrl_dev *pctldev) |
| 316 | { |
| 317 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 318 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 319 | return pmx->pfc->info->nr_functions; |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 320 | } |
| 321 | |
| 322 | static const char *sh_pfc_get_function_name(struct pinctrl_dev *pctldev, |
| 323 | unsigned selector) |
| 324 | { |
| 325 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 326 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 327 | return pmx->pfc->info->functions[selector].name; |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 328 | } |
| 329 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 330 | static int sh_pfc_get_function_groups(struct pinctrl_dev *pctldev, |
| 331 | unsigned selector, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 332 | const char * const **groups, |
| 333 | unsigned * const num_groups) |
| 334 | { |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 335 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 336 | |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 337 | *groups = pmx->pfc->info->functions[selector].groups; |
| 338 | *num_groups = pmx->pfc->info->functions[selector].nr_groups; |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 339 | |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 340 | return 0; |
| 341 | } |
| 342 | |
Linus Walleij | 03e9f0c | 2014-09-03 13:02:56 +0200 | [diff] [blame] | 343 | static int sh_pfc_func_set_mux(struct pinctrl_dev *pctldev, unsigned selector, |
| 344 | unsigned group) |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 345 | { |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 346 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 347 | struct sh_pfc *pfc = pmx->pfc; |
| 348 | const struct sh_pfc_pin_group *grp = &pfc->info->groups[group]; |
| 349 | unsigned long flags; |
| 350 | unsigned int i; |
Laurent Pinchart | b705c05 | 2013-03-10 16:38:23 +0100 | [diff] [blame] | 351 | int ret = 0; |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 352 | |
| 353 | spin_lock_irqsave(&pfc->lock, flags); |
| 354 | |
| 355 | for (i = 0; i < grp->nr_pins; ++i) { |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 356 | int idx = sh_pfc_get_pin_index(pfc, grp->pins[i]); |
| 357 | struct sh_pfc_pin_config *cfg = &pmx->configs[idx]; |
| 358 | |
| 359 | if (cfg->type != PINMUX_TYPE_NONE) { |
| 360 | ret = -EBUSY; |
| 361 | goto done; |
| 362 | } |
| 363 | } |
| 364 | |
| 365 | for (i = 0; i < grp->nr_pins; ++i) { |
Laurent Pinchart | b705c05 | 2013-03-10 16:38:23 +0100 | [diff] [blame] | 366 | ret = sh_pfc_config_mux(pfc, grp->mux[i], PINMUX_TYPE_FUNCTION); |
| 367 | if (ret < 0) |
| 368 | break; |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 369 | } |
| 370 | |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 371 | done: |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 372 | spin_unlock_irqrestore(&pfc->lock, flags); |
| 373 | return ret; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 374 | } |
| 375 | |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 376 | static int sh_pfc_gpio_request_enable(struct pinctrl_dev *pctldev, |
| 377 | struct pinctrl_gpio_range *range, |
| 378 | unsigned offset) |
| 379 | { |
| 380 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 381 | struct sh_pfc *pfc = pmx->pfc; |
Laurent Pinchart | 1a0039d | 2013-03-08 17:43:54 +0100 | [diff] [blame] | 382 | int idx = sh_pfc_get_pin_index(pfc, offset); |
| 383 | struct sh_pfc_pin_config *cfg = &pmx->configs[idx]; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 384 | unsigned long flags; |
Laurent Pinchart | 1a0039d | 2013-03-08 17:43:54 +0100 | [diff] [blame] | 385 | int ret; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 386 | |
| 387 | spin_lock_irqsave(&pfc->lock, flags); |
| 388 | |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 389 | if (cfg->type != PINMUX_TYPE_NONE) { |
Laurent Pinchart | 9a643c9 | 2013-03-10 18:00:02 +0100 | [diff] [blame] | 390 | dev_err(pfc->dev, |
| 391 | "Pin %u is busy, can't configure it as GPIO.\n", |
| 392 | offset); |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 393 | ret = -EBUSY; |
| 394 | goto done; |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 395 | } |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 396 | |
Laurent Pinchart | e3c47051 | 2013-03-10 17:30:25 +0100 | [diff] [blame] | 397 | if (!pfc->gpio) { |
| 398 | /* If GPIOs are handled externally the pin mux type need to be |
| 399 | * set to GPIO here. |
| 400 | */ |
| 401 | const struct sh_pfc_pin *pin = &pfc->info->pins[idx]; |
| 402 | |
| 403 | ret = sh_pfc_config_mux(pfc, pin->enum_id, PINMUX_TYPE_GPIO); |
| 404 | if (ret < 0) |
| 405 | goto done; |
| 406 | } |
| 407 | |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 408 | cfg->type = PINMUX_TYPE_GPIO; |
| 409 | |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 410 | ret = 0; |
| 411 | |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 412 | done: |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 413 | spin_unlock_irqrestore(&pfc->lock, flags); |
| 414 | |
| 415 | return ret; |
| 416 | } |
| 417 | |
| 418 | static void sh_pfc_gpio_disable_free(struct pinctrl_dev *pctldev, |
| 419 | struct pinctrl_gpio_range *range, |
| 420 | unsigned offset) |
| 421 | { |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 422 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 423 | struct sh_pfc *pfc = pmx->pfc; |
| 424 | int idx = sh_pfc_get_pin_index(pfc, offset); |
| 425 | struct sh_pfc_pin_config *cfg = &pmx->configs[idx]; |
| 426 | unsigned long flags; |
| 427 | |
| 428 | spin_lock_irqsave(&pfc->lock, flags); |
| 429 | cfg->type = PINMUX_TYPE_NONE; |
| 430 | spin_unlock_irqrestore(&pfc->lock, flags); |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 431 | } |
| 432 | |
| 433 | static int sh_pfc_gpio_set_direction(struct pinctrl_dev *pctldev, |
| 434 | struct pinctrl_gpio_range *range, |
| 435 | unsigned offset, bool input) |
| 436 | { |
| 437 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 438 | struct sh_pfc *pfc = pmx->pfc; |
| 439 | int new_type = input ? PINMUX_TYPE_INPUT : PINMUX_TYPE_OUTPUT; |
| 440 | int idx = sh_pfc_get_pin_index(pfc, offset); |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 441 | const struct sh_pfc_pin *pin = &pfc->info->pins[idx]; |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 442 | struct sh_pfc_pin_config *cfg = &pmx->configs[idx]; |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 443 | unsigned long flags; |
Laurent Pinchart | 6dc9b45 | 2013-03-13 18:18:30 +0100 | [diff] [blame] | 444 | unsigned int dir; |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 445 | int ret; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 446 | |
Laurent Pinchart | 6dc9b45 | 2013-03-13 18:18:30 +0100 | [diff] [blame] | 447 | /* Check if the requested direction is supported by the pin. Not all SoC |
| 448 | * provide pin config data, so perform the check conditionally. |
| 449 | */ |
| 450 | if (pin->configs) { |
| 451 | dir = input ? SH_PFC_PIN_CFG_INPUT : SH_PFC_PIN_CFG_OUTPUT; |
| 452 | if (!(pin->configs & dir)) |
| 453 | return -EINVAL; |
| 454 | } |
| 455 | |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 456 | spin_lock_irqsave(&pfc->lock, flags); |
| 457 | |
Laurent Pinchart | 9fddc4a | 2013-03-10 17:25:29 +0100 | [diff] [blame] | 458 | ret = sh_pfc_config_mux(pfc, pin->enum_id, new_type); |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 459 | if (ret < 0) |
| 460 | goto done; |
| 461 | |
| 462 | cfg->type = new_type; |
| 463 | |
| 464 | done: |
| 465 | spin_unlock_irqrestore(&pfc->lock, flags); |
Laurent Pinchart | 0d00f00 | 2013-03-10 16:55:19 +0100 | [diff] [blame] | 466 | return ret; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 467 | } |
| 468 | |
Laurent Pinchart | fe330ce | 2013-02-15 16:04:47 +0100 | [diff] [blame] | 469 | static const struct pinmux_ops sh_pfc_pinmux_ops = { |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 470 | .get_functions_count = sh_pfc_get_functions_count, |
| 471 | .get_function_name = sh_pfc_get_function_name, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 472 | .get_function_groups = sh_pfc_get_function_groups, |
Linus Walleij | 03e9f0c | 2014-09-03 13:02:56 +0200 | [diff] [blame] | 473 | .set_mux = sh_pfc_func_set_mux, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 474 | .gpio_request_enable = sh_pfc_gpio_request_enable, |
| 475 | .gpio_disable_free = sh_pfc_gpio_disable_free, |
| 476 | .gpio_set_direction = sh_pfc_gpio_set_direction, |
| 477 | }; |
| 478 | |
Laurent Pinchart | 3caa7d8 | 2016-03-23 16:06:00 +0200 | [diff] [blame] | 479 | static u32 sh_pfc_pinconf_find_drive_strength_reg(struct sh_pfc *pfc, |
| 480 | unsigned int pin, unsigned int *offset, unsigned int *size) |
| 481 | { |
| 482 | const struct pinmux_drive_reg_field *field; |
| 483 | const struct pinmux_drive_reg *reg; |
| 484 | unsigned int i; |
| 485 | |
| 486 | for (reg = pfc->info->drive_regs; reg->reg; ++reg) { |
| 487 | for (i = 0; i < ARRAY_SIZE(reg->fields); ++i) { |
| 488 | field = ®->fields[i]; |
| 489 | |
| 490 | if (field->size && field->pin == pin) { |
| 491 | *offset = field->offset; |
| 492 | *size = field->size; |
| 493 | |
| 494 | return reg->reg; |
| 495 | } |
| 496 | } |
| 497 | } |
| 498 | |
| 499 | return 0; |
| 500 | } |
| 501 | |
| 502 | static int sh_pfc_pinconf_get_drive_strength(struct sh_pfc *pfc, |
| 503 | unsigned int pin) |
| 504 | { |
| 505 | unsigned long flags; |
| 506 | unsigned int offset; |
| 507 | unsigned int size; |
| 508 | u32 reg; |
| 509 | u32 val; |
| 510 | |
| 511 | reg = sh_pfc_pinconf_find_drive_strength_reg(pfc, pin, &offset, &size); |
| 512 | if (!reg) |
| 513 | return -EINVAL; |
| 514 | |
| 515 | spin_lock_irqsave(&pfc->lock, flags); |
| 516 | val = sh_pfc_read_reg(pfc, reg, 32); |
| 517 | spin_unlock_irqrestore(&pfc->lock, flags); |
| 518 | |
| 519 | val = (val >> offset) & GENMASK(size - 1, 0); |
| 520 | |
| 521 | /* Convert the value to mA based on a full drive strength value of 24mA. |
| 522 | * We can make the full value configurable later if needed. |
| 523 | */ |
| 524 | return (val + 1) * (size == 2 ? 6 : 3); |
| 525 | } |
| 526 | |
| 527 | static int sh_pfc_pinconf_set_drive_strength(struct sh_pfc *pfc, |
| 528 | unsigned int pin, u16 strength) |
| 529 | { |
| 530 | unsigned long flags; |
| 531 | unsigned int offset; |
| 532 | unsigned int size; |
| 533 | unsigned int step; |
| 534 | u32 reg; |
| 535 | u32 val; |
| 536 | |
| 537 | reg = sh_pfc_pinconf_find_drive_strength_reg(pfc, pin, &offset, &size); |
| 538 | if (!reg) |
| 539 | return -EINVAL; |
| 540 | |
| 541 | step = size == 2 ? 6 : 3; |
| 542 | |
| 543 | if (strength < step || strength > 24) |
| 544 | return -EINVAL; |
| 545 | |
| 546 | /* Convert the value from mA based on a full drive strength value of |
| 547 | * 24mA. We can make the full value configurable later if needed. |
| 548 | */ |
| 549 | strength = strength / step - 1; |
| 550 | |
| 551 | spin_lock_irqsave(&pfc->lock, flags); |
| 552 | |
| 553 | val = sh_pfc_read_reg(pfc, reg, 32); |
| 554 | val &= ~GENMASK(offset + size - 1, offset); |
| 555 | val |= strength << offset; |
| 556 | |
| 557 | sh_pfc_write_reg(pfc, reg, 32, val); |
| 558 | |
| 559 | spin_unlock_irqrestore(&pfc->lock, flags); |
| 560 | |
| 561 | return 0; |
| 562 | } |
| 563 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 564 | /* Check whether the requested parameter is supported for a pin. */ |
| 565 | static bool sh_pfc_pinconf_validate(struct sh_pfc *pfc, unsigned int _pin, |
| 566 | enum pin_config_param param) |
| 567 | { |
| 568 | int idx = sh_pfc_get_pin_index(pfc, _pin); |
| 569 | const struct sh_pfc_pin *pin = &pfc->info->pins[idx]; |
| 570 | |
| 571 | switch (param) { |
| 572 | case PIN_CONFIG_BIAS_DISABLE: |
| 573 | return true; |
| 574 | |
| 575 | case PIN_CONFIG_BIAS_PULL_UP: |
| 576 | return pin->configs & SH_PFC_PIN_CFG_PULL_UP; |
| 577 | |
| 578 | case PIN_CONFIG_BIAS_PULL_DOWN: |
| 579 | return pin->configs & SH_PFC_PIN_CFG_PULL_DOWN; |
| 580 | |
Laurent Pinchart | 3caa7d8 | 2016-03-23 16:06:00 +0200 | [diff] [blame] | 581 | case PIN_CONFIG_DRIVE_STRENGTH: |
| 582 | return pin->configs & SH_PFC_PIN_CFG_DRIVE_STRENGTH; |
| 583 | |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 584 | case PIN_CONFIG_POWER_SOURCE: |
| 585 | return pin->configs & SH_PFC_PIN_CFG_IO_VOLTAGE; |
| 586 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 587 | default: |
| 588 | return false; |
| 589 | } |
| 590 | } |
| 591 | |
Laurent Pinchart | 934cb02 | 2013-02-14 22:35:09 +0100 | [diff] [blame] | 592 | static int sh_pfc_pinconf_get(struct pinctrl_dev *pctldev, unsigned _pin, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 593 | unsigned long *config) |
| 594 | { |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 595 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 596 | struct sh_pfc *pfc = pmx->pfc; |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 597 | enum pin_config_param param = pinconf_to_config_param(*config); |
| 598 | unsigned long flags; |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 599 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 600 | if (!sh_pfc_pinconf_validate(pfc, _pin, param)) |
| 601 | return -ENOTSUPP; |
| 602 | |
| 603 | switch (param) { |
| 604 | case PIN_CONFIG_BIAS_DISABLE: |
| 605 | case PIN_CONFIG_BIAS_PULL_UP: |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 606 | case PIN_CONFIG_BIAS_PULL_DOWN: { |
| 607 | unsigned int bias; |
| 608 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 609 | if (!pfc->info->ops || !pfc->info->ops->get_bias) |
| 610 | return -ENOTSUPP; |
| 611 | |
| 612 | spin_lock_irqsave(&pfc->lock, flags); |
| 613 | bias = pfc->info->ops->get_bias(pfc, _pin); |
| 614 | spin_unlock_irqrestore(&pfc->lock, flags); |
| 615 | |
| 616 | if (bias != param) |
| 617 | return -EINVAL; |
| 618 | |
| 619 | *config = 0; |
| 620 | break; |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 621 | } |
| 622 | |
Laurent Pinchart | 3caa7d8 | 2016-03-23 16:06:00 +0200 | [diff] [blame] | 623 | case PIN_CONFIG_DRIVE_STRENGTH: { |
| 624 | int ret; |
| 625 | |
| 626 | ret = sh_pfc_pinconf_get_drive_strength(pfc, _pin); |
| 627 | if (ret < 0) |
| 628 | return ret; |
| 629 | |
| 630 | *config = ret; |
| 631 | break; |
| 632 | } |
| 633 | |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 634 | case PIN_CONFIG_POWER_SOURCE: { |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 635 | u32 pocctrl, val; |
| 636 | int bit; |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 637 | |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 638 | if (!pfc->info->ops || !pfc->info->ops->pin_to_pocctrl) |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 639 | return -ENOTSUPP; |
| 640 | |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 641 | bit = pfc->info->ops->pin_to_pocctrl(pfc, _pin, &pocctrl); |
| 642 | if (WARN(bit < 0, "invalid pin %#x", _pin)) |
| 643 | return bit; |
| 644 | |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 645 | spin_lock_irqsave(&pfc->lock, flags); |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 646 | val = sh_pfc_read_reg(pfc, pocctrl, 32); |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 647 | spin_unlock_irqrestore(&pfc->lock, flags); |
| 648 | |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 649 | *config = (val & BIT(bit)) ? 3300 : 1800; |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 650 | break; |
| 651 | } |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 652 | |
| 653 | default: |
| 654 | return -ENOTSUPP; |
| 655 | } |
Paul Mundt | d93a891 | 2012-07-11 17:17:10 +0900 | [diff] [blame] | 656 | |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 657 | return 0; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 658 | } |
| 659 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 660 | static int sh_pfc_pinconf_set(struct pinctrl_dev *pctldev, unsigned _pin, |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 661 | unsigned long *configs, unsigned num_configs) |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 662 | { |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 663 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 664 | struct sh_pfc *pfc = pmx->pfc; |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 665 | enum pin_config_param param; |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 666 | unsigned long flags; |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 667 | unsigned int i; |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 668 | |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 669 | for (i = 0; i < num_configs; i++) { |
| 670 | param = pinconf_to_config_param(configs[i]); |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 671 | |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 672 | if (!sh_pfc_pinconf_validate(pfc, _pin, param)) |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 673 | return -ENOTSUPP; |
| 674 | |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 675 | switch (param) { |
| 676 | case PIN_CONFIG_BIAS_PULL_UP: |
| 677 | case PIN_CONFIG_BIAS_PULL_DOWN: |
| 678 | case PIN_CONFIG_BIAS_DISABLE: |
| 679 | if (!pfc->info->ops || !pfc->info->ops->set_bias) |
| 680 | return -ENOTSUPP; |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 681 | |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 682 | spin_lock_irqsave(&pfc->lock, flags); |
| 683 | pfc->info->ops->set_bias(pfc, _pin, param); |
| 684 | spin_unlock_irqrestore(&pfc->lock, flags); |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 685 | |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 686 | break; |
| 687 | |
Laurent Pinchart | 3caa7d8 | 2016-03-23 16:06:00 +0200 | [diff] [blame] | 688 | case PIN_CONFIG_DRIVE_STRENGTH: { |
| 689 | unsigned int arg = |
| 690 | pinconf_to_config_argument(configs[i]); |
| 691 | int ret; |
| 692 | |
| 693 | ret = sh_pfc_pinconf_set_drive_strength(pfc, _pin, arg); |
| 694 | if (ret < 0) |
| 695 | return ret; |
| 696 | |
| 697 | break; |
| 698 | } |
| 699 | |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 700 | case PIN_CONFIG_POWER_SOURCE: { |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 701 | unsigned int mV = pinconf_to_config_argument(configs[i]); |
| 702 | u32 pocctrl, val; |
| 703 | int bit; |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 704 | |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 705 | if (!pfc->info->ops || !pfc->info->ops->pin_to_pocctrl) |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 706 | return -ENOTSUPP; |
| 707 | |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 708 | bit = pfc->info->ops->pin_to_pocctrl(pfc, _pin, &pocctrl); |
| 709 | if (WARN(bit < 0, "invalid pin %#x", _pin)) |
| 710 | return bit; |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 711 | |
Wolfram Sang | 8775306 | 2016-06-06 18:08:25 +0200 | [diff] [blame] | 712 | if (mV != 1800 && mV != 3300) |
| 713 | return -EINVAL; |
| 714 | |
| 715 | spin_lock_irqsave(&pfc->lock, flags); |
| 716 | val = sh_pfc_read_reg(pfc, pocctrl, 32); |
| 717 | if (mV == 3300) |
| 718 | val |= BIT(bit); |
| 719 | else |
| 720 | val &= ~BIT(bit); |
| 721 | sh_pfc_write_reg(pfc, pocctrl, 32, val); |
| 722 | spin_unlock_irqrestore(&pfc->lock, flags); |
Ben Hutchings | 5b9eaa5 | 2015-06-30 17:53:59 +0100 | [diff] [blame] | 723 | |
| 724 | break; |
| 725 | } |
| 726 | |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 727 | default: |
| 728 | return -ENOTSUPP; |
| 729 | } |
| 730 | } /* for each config */ |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 731 | |
| 732 | return 0; |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 733 | } |
| 734 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 735 | static int sh_pfc_pinconf_group_set(struct pinctrl_dev *pctldev, unsigned group, |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 736 | unsigned long *configs, |
| 737 | unsigned num_configs) |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 738 | { |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 739 | struct sh_pfc_pinctrl *pmx = pinctrl_dev_get_drvdata(pctldev); |
| 740 | const unsigned int *pins; |
| 741 | unsigned int num_pins; |
| 742 | unsigned int i; |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 743 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 744 | pins = pmx->pfc->info->groups[group].pins; |
| 745 | num_pins = pmx->pfc->info->groups[group].nr_pins; |
Paul Mundt | fdd85ec | 2012-07-20 16:39:09 +0900 | [diff] [blame] | 746 | |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 747 | for (i = 0; i < num_pins; ++i) |
Sherman Yin | 03b054e | 2013-08-27 11:32:12 -0700 | [diff] [blame] | 748 | sh_pfc_pinconf_set(pctldev, pins[i], configs, num_configs); |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 749 | |
| 750 | return 0; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 751 | } |
| 752 | |
Laurent Pinchart | fe330ce | 2013-02-15 16:04:47 +0100 | [diff] [blame] | 753 | static const struct pinconf_ops sh_pfc_pinconf_ops = { |
Laurent Pinchart | c58d9c1 | 2013-03-10 16:44:02 +0100 | [diff] [blame] | 754 | .is_generic = true, |
| 755 | .pin_config_get = sh_pfc_pinconf_get, |
| 756 | .pin_config_set = sh_pfc_pinconf_set, |
| 757 | .pin_config_group_set = sh_pfc_pinconf_group_set, |
| 758 | .pin_config_config_dbg_show = pinconf_generic_dump_config, |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 759 | }; |
| 760 | |
Laurent Pinchart | 63d5738 | 2013-02-15 01:33:38 +0100 | [diff] [blame] | 761 | /* PFC ranges -> pinctrl pin descs */ |
| 762 | static int sh_pfc_map_pins(struct sh_pfc *pfc, struct sh_pfc_pinctrl *pmx) |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 763 | { |
Laurent Pinchart | 63d5738 | 2013-02-15 01:33:38 +0100 | [diff] [blame] | 764 | unsigned int i; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 765 | |
Laurent Pinchart | acac8ed | 2013-07-15 18:38:30 +0200 | [diff] [blame] | 766 | /* Allocate and initialize the pins and configs arrays. */ |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 767 | pmx->pins = devm_kzalloc(pfc->dev, |
| 768 | sizeof(*pmx->pins) * pfc->info->nr_pins, |
Laurent Pinchart | 1724acf | 2012-12-15 23:50:48 +0100 | [diff] [blame] | 769 | GFP_KERNEL); |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 770 | if (unlikely(!pmx->pins)) |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 771 | return -ENOMEM; |
Laurent Pinchart | 63d5738 | 2013-02-15 01:33:38 +0100 | [diff] [blame] | 772 | |
Laurent Pinchart | 1a0039d | 2013-03-08 17:43:54 +0100 | [diff] [blame] | 773 | pmx->configs = devm_kzalloc(pfc->dev, |
| 774 | sizeof(*pmx->configs) * pfc->info->nr_pins, |
| 775 | GFP_KERNEL); |
| 776 | if (unlikely(!pmx->configs)) |
| 777 | return -ENOMEM; |
| 778 | |
Laurent Pinchart | acac8ed | 2013-07-15 18:38:30 +0200 | [diff] [blame] | 779 | for (i = 0; i < pfc->info->nr_pins; ++i) { |
| 780 | const struct sh_pfc_pin *info = &pfc->info->pins[i]; |
| 781 | struct sh_pfc_pin_config *cfg = &pmx->configs[i]; |
| 782 | struct pinctrl_pin_desc *pin = &pmx->pins[i]; |
Laurent Pinchart | 63d5738 | 2013-02-15 01:33:38 +0100 | [diff] [blame] | 783 | |
Laurent Pinchart | acac8ed | 2013-07-15 18:38:30 +0200 | [diff] [blame] | 784 | /* If the pin number is equal to -1 all pins are considered */ |
| 785 | pin->number = info->pin != (u16)-1 ? info->pin : i; |
| 786 | pin->name = info->name; |
| 787 | cfg->type = PINMUX_TYPE_NONE; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 788 | } |
| 789 | |
Laurent Pinchart | acac8ed | 2013-07-15 18:38:30 +0200 | [diff] [blame] | 790 | return 0; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 791 | } |
| 792 | |
Laurent Pinchart | c6193ea | 2012-12-15 23:50:47 +0100 | [diff] [blame] | 793 | int sh_pfc_register_pinctrl(struct sh_pfc *pfc) |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 794 | { |
Laurent Pinchart | c6193ea | 2012-12-15 23:50:47 +0100 | [diff] [blame] | 795 | struct sh_pfc_pinctrl *pmx; |
Laurent Pinchart | acac8ed | 2013-07-15 18:38:30 +0200 | [diff] [blame] | 796 | int ret; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 797 | |
Laurent Pinchart | 1724acf | 2012-12-15 23:50:48 +0100 | [diff] [blame] | 798 | pmx = devm_kzalloc(pfc->dev, sizeof(*pmx), GFP_KERNEL); |
Laurent Pinchart | c6193ea | 2012-12-15 23:50:47 +0100 | [diff] [blame] | 799 | if (unlikely(!pmx)) |
| 800 | return -ENOMEM; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 801 | |
Laurent Pinchart | c6193ea | 2012-12-15 23:50:47 +0100 | [diff] [blame] | 802 | pmx->pfc = pfc; |
Laurent Pinchart | c6193ea | 2012-12-15 23:50:47 +0100 | [diff] [blame] | 803 | |
Laurent Pinchart | acac8ed | 2013-07-15 18:38:30 +0200 | [diff] [blame] | 804 | ret = sh_pfc_map_pins(pfc, pmx); |
| 805 | if (ret < 0) |
| 806 | return ret; |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 807 | |
Laurent Pinchart | dcc427e | 2013-02-16 16:38:30 +0100 | [diff] [blame] | 808 | pmx->pctl_desc.name = DRV_NAME; |
| 809 | pmx->pctl_desc.owner = THIS_MODULE; |
| 810 | pmx->pctl_desc.pctlops = &sh_pfc_pinctrl_ops; |
| 811 | pmx->pctl_desc.pmxops = &sh_pfc_pinmux_ops; |
| 812 | pmx->pctl_desc.confops = &sh_pfc_pinconf_ops; |
Laurent Pinchart | 3d8d9f1 | 2013-01-03 14:33:13 +0100 | [diff] [blame] | 813 | pmx->pctl_desc.pins = pmx->pins; |
Laurent Pinchart | 63d5738 | 2013-02-15 01:33:38 +0100 | [diff] [blame] | 814 | pmx->pctl_desc.npins = pfc->info->nr_pins; |
Laurent Pinchart | dcc427e | 2013-02-16 16:38:30 +0100 | [diff] [blame] | 815 | |
Laxman Dewangan | 67ec8d7 | 2016-02-28 14:37:47 +0530 | [diff] [blame] | 816 | pmx->pctl = devm_pinctrl_register(pfc->dev, &pmx->pctl_desc, pmx); |
Wei Yongjun | f7973d8 | 2016-07-06 12:03:32 +0000 | [diff] [blame] | 817 | return PTR_ERR_OR_ZERO(pmx->pctl); |
Paul Mundt | ca5481c6 | 2012-07-10 12:08:14 +0900 | [diff] [blame] | 818 | } |