pinctrl-imx.c 20 KB

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