pinctrl-imx.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776
  1. /*
  2. * Core driver for the imx pin controller
  3. *
  4. * Copyright (C) 2012 Freescale Semiconductor, Inc.
  5. * Copyright (C) 2012 Linaro Ltd.
  6. *
  7. * Author: Dong Aisheng <dong.aisheng@linaro.org>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. */
  14. #include <linux/err.h>
  15. #include <linux/init.h>
  16. #include <linux/io.h>
  17. #include <linux/mfd/syscon.h>
  18. #include <linux/of.h>
  19. #include <linux/of_device.h>
  20. #include <linux/of_address.h>
  21. #include <linux/pinctrl/machine.h>
  22. #include <linux/pinctrl/pinconf.h>
  23. #include <linux/pinctrl/pinctrl.h>
  24. #include <linux/pinctrl/pinmux.h>
  25. #include <linux/slab.h>
  26. #include <linux/regmap.h>
  27. #include "../core.h"
  28. #include "../pinconf.h"
  29. #include "../pinmux.h"
  30. #include "pinctrl-imx.h"
  31. /* The bits in CONFIG cell defined in binding doc*/
  32. #define IMX_NO_PAD_CTL 0x80000000 /* no pin config need */
  33. #define IMX_PAD_SION 0x40000000 /* set SION */
  34. static inline const struct group_desc *imx_pinctrl_find_group_by_name(
  35. struct pinctrl_dev *pctldev,
  36. const char *name)
  37. {
  38. const struct group_desc *grp = NULL;
  39. int i;
  40. for (i = 0; i < pctldev->num_groups; i++) {
  41. grp = pinctrl_generic_get_group(pctldev, i);
  42. if (grp && !strcmp(grp->name, name))
  43. break;
  44. }
  45. return grp;
  46. }
  47. static void imx_pin_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s,
  48. unsigned offset)
  49. {
  50. seq_printf(s, "%s", dev_name(pctldev->dev));
  51. }
  52. static int imx_dt_node_to_map(struct pinctrl_dev *pctldev,
  53. struct device_node *np,
  54. struct pinctrl_map **map, unsigned *num_maps)
  55. {
  56. struct imx_pinctrl *ipctl = pinctrl_dev_get_drvdata(pctldev);
  57. const struct group_desc *grp;
  58. struct pinctrl_map *new_map;
  59. struct device_node *parent;
  60. int map_num = 1;
  61. int i, j;
  62. /*
  63. * first find the group of this node and check if we need create
  64. * config maps for pins
  65. */
  66. grp = imx_pinctrl_find_group_by_name(pctldev, np->name);
  67. if (!grp) {
  68. dev_err(ipctl->dev, "unable to find group for node %s\n",
  69. np->name);
  70. return -EINVAL;
  71. }
  72. for (i = 0; i < grp->num_pins; i++) {
  73. struct imx_pin *pin = &((struct imx_pin *)(grp->data))[i];
  74. if (!(pin->config & IMX_NO_PAD_CTL))
  75. map_num++;
  76. }
  77. new_map = kmalloc(sizeof(struct pinctrl_map) * map_num, GFP_KERNEL);
  78. if (!new_map)
  79. return -ENOMEM;
  80. *map = new_map;
  81. *num_maps = map_num;
  82. /* create mux map */
  83. parent = of_get_parent(np);
  84. if (!parent) {
  85. kfree(new_map);
  86. return -EINVAL;
  87. }
  88. new_map[0].type = PIN_MAP_TYPE_MUX_GROUP;
  89. new_map[0].data.mux.function = parent->name;
  90. new_map[0].data.mux.group = np->name;
  91. of_node_put(parent);
  92. /* create config map */
  93. new_map++;
  94. for (i = j = 0; i < grp->num_pins; i++) {
  95. struct imx_pin *pin = &((struct imx_pin *)(grp->data))[i];
  96. if (!(pin->config & IMX_NO_PAD_CTL)) {
  97. new_map[j].type = PIN_MAP_TYPE_CONFIGS_PIN;
  98. new_map[j].data.configs.group_or_pin =
  99. pin_get_name(pctldev, pin->pin);
  100. new_map[j].data.configs.configs = &pin->config;
  101. new_map[j].data.configs.num_configs = 1;
  102. j++;
  103. }
  104. }
  105. dev_dbg(pctldev->dev, "maps: function %s group %s num %d\n",
  106. (*map)->data.mux.function, (*map)->data.mux.group, map_num);
  107. return 0;
  108. }
  109. static void imx_dt_free_map(struct pinctrl_dev *pctldev,
  110. struct pinctrl_map *map, unsigned num_maps)
  111. {
  112. kfree(map);
  113. }
  114. static const struct pinctrl_ops imx_pctrl_ops = {
  115. .get_groups_count = pinctrl_generic_get_group_count,
  116. .get_group_name = pinctrl_generic_get_group_name,
  117. .get_group_pins = pinctrl_generic_get_group_pins,
  118. .pin_dbg_show = imx_pin_dbg_show,
  119. .dt_node_to_map = imx_dt_node_to_map,
  120. .dt_free_map = imx_dt_free_map,
  121. };
  122. static int imx_pmx_set(struct pinctrl_dev *pctldev, unsigned selector,
  123. unsigned group)
  124. {
  125. struct imx_pinctrl *ipctl = pinctrl_dev_get_drvdata(pctldev);
  126. const struct imx_pinctrl_soc_info *info = ipctl->info;
  127. const struct imx_pin_reg *pin_reg;
  128. unsigned int npins, pin_id;
  129. int i;
  130. struct group_desc *grp = NULL;
  131. struct function_desc *func = NULL;
  132. /*
  133. * Configure the mux mode for each pin in the group for a specific
  134. * function.
  135. */
  136. grp = pinctrl_generic_get_group(pctldev, group);
  137. if (!grp)
  138. return -EINVAL;
  139. func = pinmux_generic_get_function(pctldev, selector);
  140. if (!func)
  141. return -EINVAL;
  142. npins = grp->num_pins;
  143. dev_dbg(ipctl->dev, "enable function %s group %s\n",
  144. func->name, grp->name);
  145. for (i = 0; i < npins; i++) {
  146. struct imx_pin *pin = &((struct imx_pin *)(grp->data))[i];
  147. pin_id = pin->pin;
  148. pin_reg = &ipctl->pin_regs[pin_id];
  149. if (pin_reg->mux_reg == -1) {
  150. dev_dbg(ipctl->dev, "Pin(%s) does not support mux function\n",
  151. info->pins[pin_id].name);
  152. continue;
  153. }
  154. if (info->flags & SHARE_MUX_CONF_REG) {
  155. u32 reg;
  156. reg = readl(ipctl->base + pin_reg->mux_reg);
  157. reg &= ~info->mux_mask;
  158. reg |= (pin->mux_mode << info->mux_shift);
  159. writel(reg, ipctl->base + pin_reg->mux_reg);
  160. dev_dbg(ipctl->dev, "write: offset 0x%x val 0x%x\n",
  161. pin_reg->mux_reg, reg);
  162. } else {
  163. writel(pin->mux_mode, ipctl->base + pin_reg->mux_reg);
  164. dev_dbg(ipctl->dev, "write: offset 0x%x val 0x%x\n",
  165. pin_reg->mux_reg, pin->mux_mode);
  166. }
  167. /*
  168. * If the select input value begins with 0xff, it's a quirky
  169. * select input and the value should be interpreted as below.
  170. * 31 23 15 7 0
  171. * | 0xff | shift | width | select |
  172. * It's used to work around the problem that the select
  173. * input for some pin is not implemented in the select
  174. * input register but in some general purpose register.
  175. * We encode the select input value, width and shift of
  176. * the bit field into input_val cell of pin function ID
  177. * in device tree, and then decode them here for setting
  178. * up the select input bits in general purpose register.
  179. */
  180. if (pin->input_val >> 24 == 0xff) {
  181. u32 val = pin->input_val;
  182. u8 select = val & 0xff;
  183. u8 width = (val >> 8) & 0xff;
  184. u8 shift = (val >> 16) & 0xff;
  185. u32 mask = ((1 << width) - 1) << shift;
  186. /*
  187. * The input_reg[i] here is actually some IOMUXC general
  188. * purpose register, not regular select input register.
  189. */
  190. val = readl(ipctl->base + pin->input_reg);
  191. val &= ~mask;
  192. val |= select << shift;
  193. writel(val, ipctl->base + pin->input_reg);
  194. } else if (pin->input_reg) {
  195. /*
  196. * Regular select input register can never be at offset
  197. * 0, and we only print register value for regular case.
  198. */
  199. if (ipctl->input_sel_base)
  200. writel(pin->input_val, ipctl->input_sel_base +
  201. pin->input_reg);
  202. else
  203. writel(pin->input_val, ipctl->base +
  204. pin->input_reg);
  205. dev_dbg(ipctl->dev,
  206. "==>select_input: offset 0x%x val 0x%x\n",
  207. pin->input_reg, pin->input_val);
  208. }
  209. }
  210. return 0;
  211. }
  212. struct pinmux_ops imx_pmx_ops = {
  213. .get_functions_count = pinmux_generic_get_function_count,
  214. .get_function_name = pinmux_generic_get_function_name,
  215. .get_function_groups = pinmux_generic_get_function_groups,
  216. .set_mux = imx_pmx_set,
  217. };
  218. /* decode generic config into raw register values */
  219. static u32 imx_pinconf_decode_generic_config(struct imx_pinctrl *ipctl,
  220. unsigned long *configs,
  221. unsigned int num_configs)
  222. {
  223. const struct imx_pinctrl_soc_info *info = ipctl->info;
  224. const struct imx_cfg_params_decode *decode;
  225. enum pin_config_param param;
  226. u32 raw_config = 0;
  227. u32 param_val;
  228. int i, j;
  229. WARN_ON(num_configs > info->num_decodes);
  230. for (i = 0; i < num_configs; i++) {
  231. param = pinconf_to_config_param(configs[i]);
  232. param_val = pinconf_to_config_argument(configs[i]);
  233. decode = info->decodes;
  234. for (j = 0; j < info->num_decodes; j++) {
  235. if (param == decode->param) {
  236. if (decode->invert)
  237. param_val = !param_val;
  238. raw_config |= (param_val << decode->shift)
  239. & decode->mask;
  240. break;
  241. }
  242. decode++;
  243. }
  244. }
  245. if (info->fixup)
  246. info->fixup(configs, num_configs, &raw_config);
  247. return raw_config;
  248. }
  249. static u32 imx_pinconf_parse_generic_config(struct device_node *np,
  250. struct imx_pinctrl *ipctl)
  251. {
  252. const struct imx_pinctrl_soc_info *info = ipctl->info;
  253. struct pinctrl_dev *pctl = ipctl->pctl;
  254. unsigned int num_configs;
  255. unsigned long *configs;
  256. int ret;
  257. if (!info->generic_pinconf)
  258. return 0;
  259. ret = pinconf_generic_parse_dt_config(np, pctl, &configs,
  260. &num_configs);
  261. if (ret)
  262. return 0;
  263. return imx_pinconf_decode_generic_config(ipctl, configs, num_configs);
  264. }
  265. static int imx_pinconf_get(struct pinctrl_dev *pctldev,
  266. unsigned pin_id, unsigned long *config)
  267. {
  268. struct imx_pinctrl *ipctl = pinctrl_dev_get_drvdata(pctldev);
  269. const struct imx_pinctrl_soc_info *info = ipctl->info;
  270. const struct imx_pin_reg *pin_reg = &ipctl->pin_regs[pin_id];
  271. if (pin_reg->conf_reg == -1) {
  272. dev_err(ipctl->dev, "Pin(%s) does not support config function\n",
  273. info->pins[pin_id].name);
  274. return -EINVAL;
  275. }
  276. *config = readl(ipctl->base + pin_reg->conf_reg);
  277. if (info->flags & SHARE_MUX_CONF_REG)
  278. *config &= ~info->mux_mask;
  279. return 0;
  280. }
  281. static int imx_pinconf_set(struct pinctrl_dev *pctldev,
  282. unsigned pin_id, unsigned long *configs,
  283. unsigned num_configs)
  284. {
  285. struct imx_pinctrl *ipctl = pinctrl_dev_get_drvdata(pctldev);
  286. const struct imx_pinctrl_soc_info *info = ipctl->info;
  287. const struct imx_pin_reg *pin_reg = &ipctl->pin_regs[pin_id];
  288. int i;
  289. if (pin_reg->conf_reg == -1) {
  290. dev_err(ipctl->dev, "Pin(%s) does not support config function\n",
  291. info->pins[pin_id].name);
  292. return -EINVAL;
  293. }
  294. dev_dbg(ipctl->dev, "pinconf set pin %s\n",
  295. info->pins[pin_id].name);
  296. for (i = 0; i < num_configs; i++) {
  297. if (info->flags & SHARE_MUX_CONF_REG) {
  298. u32 reg;
  299. reg = readl(ipctl->base + pin_reg->conf_reg);
  300. reg &= info->mux_mask;
  301. reg |= configs[i];
  302. writel(reg, ipctl->base + pin_reg->conf_reg);
  303. dev_dbg(ipctl->dev, "write: offset 0x%x val 0x%x\n",
  304. pin_reg->conf_reg, reg);
  305. } else {
  306. writel(configs[i], ipctl->base + pin_reg->conf_reg);
  307. dev_dbg(ipctl->dev, "write: offset 0x%x val 0x%lx\n",
  308. pin_reg->conf_reg, configs[i]);
  309. }
  310. } /* for each config */
  311. return 0;
  312. }
  313. static void imx_pinconf_dbg_show(struct pinctrl_dev *pctldev,
  314. struct seq_file *s, unsigned pin_id)
  315. {
  316. struct imx_pinctrl *ipctl = pinctrl_dev_get_drvdata(pctldev);
  317. const struct imx_pin_reg *pin_reg = &ipctl->pin_regs[pin_id];
  318. unsigned long config;
  319. if (!pin_reg || pin_reg->conf_reg == -1) {
  320. seq_printf(s, "N/A");
  321. return;
  322. }
  323. config = readl(ipctl->base + pin_reg->conf_reg);
  324. seq_printf(s, "0x%lx", config);
  325. }
  326. static void imx_pinconf_group_dbg_show(struct pinctrl_dev *pctldev,
  327. struct seq_file *s, unsigned group)
  328. {
  329. struct group_desc *grp;
  330. unsigned long config;
  331. const char *name;
  332. int i, ret;
  333. if (group > pctldev->num_groups)
  334. return;
  335. seq_printf(s, "\n");
  336. grp = pinctrl_generic_get_group(pctldev, group);
  337. if (!grp)
  338. return;
  339. for (i = 0; i < grp->num_pins; i++) {
  340. struct imx_pin *pin = &((struct imx_pin *)(grp->data))[i];
  341. name = pin_get_name(pctldev, pin->pin);
  342. ret = imx_pinconf_get(pctldev, pin->pin, &config);
  343. if (ret)
  344. return;
  345. seq_printf(s, " %s: 0x%lx\n", name, config);
  346. }
  347. }
  348. static const struct pinconf_ops imx_pinconf_ops = {
  349. .pin_config_get = imx_pinconf_get,
  350. .pin_config_set = imx_pinconf_set,
  351. .pin_config_dbg_show = imx_pinconf_dbg_show,
  352. .pin_config_group_dbg_show = imx_pinconf_group_dbg_show,
  353. };
  354. /*
  355. * Each pin represented in fsl,pins consists of 5 u32 PIN_FUNC_ID and
  356. * 1 u32 CONFIG, so 24 types in total for each pin.
  357. */
  358. #define FSL_PIN_SIZE 24
  359. #define SHARE_FSL_PIN_SIZE 20
  360. static int imx_pinctrl_parse_groups(struct device_node *np,
  361. struct group_desc *grp,
  362. struct imx_pinctrl *ipctl,
  363. u32 index)
  364. {
  365. const struct imx_pinctrl_soc_info *info = ipctl->info;
  366. int size, pin_size;
  367. const __be32 *list;
  368. int i;
  369. u32 config;
  370. dev_dbg(ipctl->dev, "group(%d): %s\n", index, np->name);
  371. if (info->flags & SHARE_MUX_CONF_REG)
  372. pin_size = SHARE_FSL_PIN_SIZE;
  373. else
  374. pin_size = FSL_PIN_SIZE;
  375. if (info->generic_pinconf)
  376. pin_size -= 4;
  377. /* Initialise group */
  378. grp->name = np->name;
  379. /*
  380. * the binding format is fsl,pins = <PIN_FUNC_ID CONFIG ...>,
  381. * do sanity check and calculate pins number
  382. *
  383. * First try legacy 'fsl,pins' property, then fall back to the
  384. * generic 'pinmux'.
  385. *
  386. * Note: for generic 'pinmux' case, there's no CONFIG part in
  387. * the binding format.
  388. */
  389. list = of_get_property(np, "fsl,pins", &size);
  390. if (!list) {
  391. list = of_get_property(np, "pinmux", &size);
  392. if (!list) {
  393. dev_err(ipctl->dev,
  394. "no fsl,pins and pins property in node %pOF\n", np);
  395. return -EINVAL;
  396. }
  397. }
  398. /* we do not check return since it's safe node passed down */
  399. if (!size || size % pin_size) {
  400. dev_err(ipctl->dev, "Invalid fsl,pins or pins property in node %pOF\n", np);
  401. return -EINVAL;
  402. }
  403. /* first try to parse the generic pin config */
  404. config = imx_pinconf_parse_generic_config(np, ipctl);
  405. grp->num_pins = size / pin_size;
  406. grp->data = devm_kzalloc(ipctl->dev, grp->num_pins *
  407. sizeof(struct imx_pin), GFP_KERNEL);
  408. grp->pins = devm_kzalloc(ipctl->dev, grp->num_pins *
  409. sizeof(unsigned int), GFP_KERNEL);
  410. if (!grp->pins || !grp->data)
  411. return -ENOMEM;
  412. for (i = 0; i < grp->num_pins; i++) {
  413. u32 mux_reg = be32_to_cpu(*list++);
  414. u32 conf_reg;
  415. unsigned int pin_id;
  416. struct imx_pin_reg *pin_reg;
  417. struct imx_pin *pin = &((struct imx_pin *)(grp->data))[i];
  418. if (!(info->flags & ZERO_OFFSET_VALID) && !mux_reg)
  419. mux_reg = -1;
  420. if (info->flags & SHARE_MUX_CONF_REG) {
  421. conf_reg = mux_reg;
  422. } else {
  423. conf_reg = be32_to_cpu(*list++);
  424. if (!conf_reg)
  425. conf_reg = -1;
  426. }
  427. pin_id = (mux_reg != -1) ? mux_reg / 4 : conf_reg / 4;
  428. pin_reg = &ipctl->pin_regs[pin_id];
  429. pin->pin = pin_id;
  430. grp->pins[i] = pin_id;
  431. pin_reg->mux_reg = mux_reg;
  432. pin_reg->conf_reg = conf_reg;
  433. pin->input_reg = be32_to_cpu(*list++);
  434. pin->mux_mode = be32_to_cpu(*list++);
  435. pin->input_val = be32_to_cpu(*list++);
  436. if (info->generic_pinconf) {
  437. /* generic pin config decoded */
  438. pin->config = config;
  439. } else {
  440. /* legacy pin config read from devicetree */
  441. config = be32_to_cpu(*list++);
  442. /* SION bit is in mux register */
  443. if (config & IMX_PAD_SION)
  444. pin->mux_mode |= IOMUXC_CONFIG_SION;
  445. pin->config = config & ~IMX_PAD_SION;
  446. }
  447. dev_dbg(ipctl->dev, "%s: 0x%x 0x%08lx", info->pins[pin_id].name,
  448. pin->mux_mode, pin->config);
  449. }
  450. return 0;
  451. }
  452. static int imx_pinctrl_parse_functions(struct device_node *np,
  453. struct imx_pinctrl *ipctl,
  454. u32 index)
  455. {
  456. struct pinctrl_dev *pctl = ipctl->pctl;
  457. struct device_node *child;
  458. struct function_desc *func;
  459. struct group_desc *grp;
  460. u32 i = 0;
  461. dev_dbg(pctl->dev, "parse function(%d): %s\n", index, np->name);
  462. func = pinmux_generic_get_function(pctl, index);
  463. if (!func)
  464. return -EINVAL;
  465. /* Initialise function */
  466. func->name = np->name;
  467. func->num_group_names = of_get_child_count(np);
  468. if (func->num_group_names == 0) {
  469. dev_err(ipctl->dev, "no groups defined in %pOF\n", np);
  470. return -EINVAL;
  471. }
  472. func->group_names = devm_kcalloc(ipctl->dev, func->num_group_names,
  473. sizeof(char *), GFP_KERNEL);
  474. if (!func->group_names)
  475. return -ENOMEM;
  476. for_each_child_of_node(np, child) {
  477. func->group_names[i] = child->name;
  478. grp = devm_kzalloc(ipctl->dev, sizeof(struct group_desc),
  479. GFP_KERNEL);
  480. if (!grp)
  481. return -ENOMEM;
  482. mutex_lock(&ipctl->mutex);
  483. radix_tree_insert(&pctl->pin_group_tree,
  484. ipctl->group_index++, grp);
  485. mutex_unlock(&ipctl->mutex);
  486. imx_pinctrl_parse_groups(child, grp, ipctl, i++);
  487. }
  488. return 0;
  489. }
  490. /*
  491. * Check if the DT contains pins in the direct child nodes. This indicates the
  492. * newer DT format to store pins. This function returns true if the first found
  493. * fsl,pins property is in a child of np. Otherwise false is returned.
  494. */
  495. static bool imx_pinctrl_dt_is_flat_functions(struct device_node *np)
  496. {
  497. struct device_node *function_np;
  498. struct device_node *pinctrl_np;
  499. for_each_child_of_node(np, function_np) {
  500. if (of_property_read_bool(function_np, "fsl,pins"))
  501. return true;
  502. for_each_child_of_node(function_np, pinctrl_np) {
  503. if (of_property_read_bool(pinctrl_np, "fsl,pins"))
  504. return false;
  505. }
  506. }
  507. return true;
  508. }
  509. static int imx_pinctrl_probe_dt(struct platform_device *pdev,
  510. struct imx_pinctrl *ipctl)
  511. {
  512. struct device_node *np = pdev->dev.of_node;
  513. struct device_node *child;
  514. struct pinctrl_dev *pctl = ipctl->pctl;
  515. u32 nfuncs = 0;
  516. u32 i = 0;
  517. bool flat_funcs;
  518. if (!np)
  519. return -ENODEV;
  520. flat_funcs = imx_pinctrl_dt_is_flat_functions(np);
  521. if (flat_funcs) {
  522. nfuncs = 1;
  523. } else {
  524. nfuncs = of_get_child_count(np);
  525. if (nfuncs <= 0) {
  526. dev_err(&pdev->dev, "no functions defined\n");
  527. return -EINVAL;
  528. }
  529. }
  530. for (i = 0; i < nfuncs; i++) {
  531. struct function_desc *function;
  532. function = devm_kzalloc(&pdev->dev, sizeof(*function),
  533. GFP_KERNEL);
  534. if (!function)
  535. return -ENOMEM;
  536. mutex_lock(&ipctl->mutex);
  537. radix_tree_insert(&pctl->pin_function_tree, i, function);
  538. mutex_unlock(&ipctl->mutex);
  539. }
  540. pctl->num_functions = nfuncs;
  541. ipctl->group_index = 0;
  542. if (flat_funcs) {
  543. pctl->num_groups = of_get_child_count(np);
  544. } else {
  545. pctl->num_groups = 0;
  546. for_each_child_of_node(np, child)
  547. pctl->num_groups += of_get_child_count(child);
  548. }
  549. if (flat_funcs) {
  550. imx_pinctrl_parse_functions(np, ipctl, 0);
  551. } else {
  552. i = 0;
  553. for_each_child_of_node(np, child)
  554. imx_pinctrl_parse_functions(child, ipctl, i++);
  555. }
  556. return 0;
  557. }
  558. /*
  559. * imx_free_resources() - free memory used by this driver
  560. * @info: info driver instance
  561. */
  562. static void imx_free_resources(struct imx_pinctrl *ipctl)
  563. {
  564. if (ipctl->pctl)
  565. pinctrl_unregister(ipctl->pctl);
  566. }
  567. int imx_pinctrl_probe(struct platform_device *pdev,
  568. const struct imx_pinctrl_soc_info *info)
  569. {
  570. struct regmap_config config = { .name = "gpr" };
  571. struct device_node *dev_np = pdev->dev.of_node;
  572. struct pinctrl_desc *imx_pinctrl_desc;
  573. struct device_node *np;
  574. struct imx_pinctrl *ipctl;
  575. struct resource *res;
  576. struct regmap *gpr;
  577. int ret, i;
  578. if (!info || !info->pins || !info->npins) {
  579. dev_err(&pdev->dev, "wrong pinctrl info\n");
  580. return -EINVAL;
  581. }
  582. if (info->gpr_compatible) {
  583. gpr = syscon_regmap_lookup_by_compatible(info->gpr_compatible);
  584. if (!IS_ERR(gpr))
  585. regmap_attach_dev(&pdev->dev, gpr, &config);
  586. }
  587. /* Create state holders etc for this driver */
  588. ipctl = devm_kzalloc(&pdev->dev, sizeof(*ipctl), GFP_KERNEL);
  589. if (!ipctl)
  590. return -ENOMEM;
  591. ipctl->pin_regs = devm_kmalloc(&pdev->dev, sizeof(*ipctl->pin_regs) *
  592. info->npins, GFP_KERNEL);
  593. if (!ipctl->pin_regs)
  594. return -ENOMEM;
  595. for (i = 0; i < info->npins; i++) {
  596. ipctl->pin_regs[i].mux_reg = -1;
  597. ipctl->pin_regs[i].conf_reg = -1;
  598. }
  599. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  600. ipctl->base = devm_ioremap_resource(&pdev->dev, res);
  601. if (IS_ERR(ipctl->base))
  602. return PTR_ERR(ipctl->base);
  603. if (of_property_read_bool(dev_np, "fsl,input-sel")) {
  604. np = of_parse_phandle(dev_np, "fsl,input-sel", 0);
  605. if (!np) {
  606. dev_err(&pdev->dev, "iomuxc fsl,input-sel property not found\n");
  607. return -EINVAL;
  608. }
  609. ipctl->input_sel_base = of_iomap(np, 0);
  610. of_node_put(np);
  611. if (!ipctl->input_sel_base) {
  612. dev_err(&pdev->dev,
  613. "iomuxc input select base address not found\n");
  614. return -ENOMEM;
  615. }
  616. }
  617. imx_pinctrl_desc = devm_kzalloc(&pdev->dev, sizeof(*imx_pinctrl_desc),
  618. GFP_KERNEL);
  619. if (!imx_pinctrl_desc)
  620. return -ENOMEM;
  621. imx_pinctrl_desc->name = dev_name(&pdev->dev);
  622. imx_pinctrl_desc->pins = info->pins;
  623. imx_pinctrl_desc->npins = info->npins;
  624. imx_pinctrl_desc->pctlops = &imx_pctrl_ops;
  625. imx_pinctrl_desc->pmxops = &imx_pmx_ops;
  626. imx_pinctrl_desc->confops = &imx_pinconf_ops;
  627. imx_pinctrl_desc->owner = THIS_MODULE;
  628. /* for generic pinconf */
  629. imx_pinctrl_desc->custom_params = info->custom_params;
  630. imx_pinctrl_desc->num_custom_params = info->num_custom_params;
  631. /* platform specific callback */
  632. imx_pmx_ops.gpio_set_direction = info->gpio_set_direction;
  633. mutex_init(&ipctl->mutex);
  634. ipctl->info = info;
  635. ipctl->dev = &pdev->dev;
  636. platform_set_drvdata(pdev, ipctl);
  637. ret = devm_pinctrl_register_and_init(&pdev->dev,
  638. imx_pinctrl_desc, ipctl,
  639. &ipctl->pctl);
  640. if (ret) {
  641. dev_err(&pdev->dev, "could not register IMX pinctrl driver\n");
  642. goto free;
  643. }
  644. ret = imx_pinctrl_probe_dt(pdev, ipctl);
  645. if (ret) {
  646. dev_err(&pdev->dev, "fail to probe dt properties\n");
  647. goto free;
  648. }
  649. dev_info(&pdev->dev, "initialized IMX pinctrl driver\n");
  650. return pinctrl_enable(ipctl->pctl);
  651. free:
  652. imx_free_resources(ipctl);
  653. return ret;
  654. }