pinctrl-rockchip.c 39 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570
  1. /*
  2. * Pinctrl driver for Rockchip SoCs
  3. *
  4. * Copyright (c) 2013 MundoReader S.L.
  5. * Author: Heiko Stuebner <heiko@sntech.de>
  6. *
  7. * With some ideas taken from pinctrl-samsung:
  8. * Copyright (c) 2012 Samsung Electronics Co., Ltd.
  9. * http://www.samsung.com
  10. * Copyright (c) 2012 Linaro Ltd
  11. * http://www.linaro.org
  12. *
  13. * and pinctrl-at91:
  14. * Copyright (C) 2011-2012 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
  15. *
  16. * This program is free software; you can redistribute it and/or modify
  17. * it under the terms of the GNU General Public License version 2 as published
  18. * by the Free Software Foundation.
  19. *
  20. * This program is distributed in the hope that it will be useful,
  21. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  22. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  23. * GNU General Public License for more details.
  24. */
  25. #include <linux/module.h>
  26. #include <linux/platform_device.h>
  27. #include <linux/io.h>
  28. #include <linux/bitops.h>
  29. #include <linux/gpio.h>
  30. #include <linux/of_address.h>
  31. #include <linux/of_irq.h>
  32. #include <linux/pinctrl/machine.h>
  33. #include <linux/pinctrl/pinconf.h>
  34. #include <linux/pinctrl/pinctrl.h>
  35. #include <linux/pinctrl/pinmux.h>
  36. #include <linux/pinctrl/pinconf-generic.h>
  37. #include <linux/irqchip/chained_irq.h>
  38. #include <linux/clk.h>
  39. #include <dt-bindings/pinctrl/rockchip.h>
  40. #include "core.h"
  41. #include "pinconf.h"
  42. /* GPIO control registers */
  43. #define GPIO_SWPORT_DR 0x00
  44. #define GPIO_SWPORT_DDR 0x04
  45. #define GPIO_INTEN 0x30
  46. #define GPIO_INTMASK 0x34
  47. #define GPIO_INTTYPE_LEVEL 0x38
  48. #define GPIO_INT_POLARITY 0x3c
  49. #define GPIO_INT_STATUS 0x40
  50. #define GPIO_INT_RAWSTATUS 0x44
  51. #define GPIO_DEBOUNCE 0x48
  52. #define GPIO_PORTS_EOI 0x4c
  53. #define GPIO_EXT_PORT 0x50
  54. #define GPIO_LS_SYNC 0x60
  55. enum rockchip_pinctrl_type {
  56. RK2928,
  57. RK3066B,
  58. RK3188,
  59. };
  60. enum rockchip_pin_bank_type {
  61. COMMON_BANK,
  62. RK3188_BANK0,
  63. };
  64. /**
  65. * @reg_base: register base of the gpio bank
  66. * @reg_pull: optional separate register for additional pull settings
  67. * @clk: clock of the gpio bank
  68. * @irq: interrupt of the gpio bank
  69. * @pin_base: first pin number
  70. * @nr_pins: number of pins in this bank
  71. * @name: name of the bank
  72. * @bank_num: number of the bank, to account for holes
  73. * @valid: are all necessary informations present
  74. * @of_node: dt node of this bank
  75. * @drvdata: common pinctrl basedata
  76. * @domain: irqdomain of the gpio bank
  77. * @gpio_chip: gpiolib chip
  78. * @grange: gpio range
  79. * @slock: spinlock for the gpio bank
  80. */
  81. struct rockchip_pin_bank {
  82. void __iomem *reg_base;
  83. void __iomem *reg_pull;
  84. struct clk *clk;
  85. int irq;
  86. u32 pin_base;
  87. u8 nr_pins;
  88. char *name;
  89. u8 bank_num;
  90. enum rockchip_pin_bank_type bank_type;
  91. bool valid;
  92. struct device_node *of_node;
  93. struct rockchip_pinctrl *drvdata;
  94. struct irq_domain *domain;
  95. struct gpio_chip gpio_chip;
  96. struct pinctrl_gpio_range grange;
  97. spinlock_t slock;
  98. u32 toggle_edge_mode;
  99. };
  100. #define PIN_BANK(id, pins, label) \
  101. { \
  102. .bank_num = id, \
  103. .nr_pins = pins, \
  104. .name = label, \
  105. }
  106. /**
  107. */
  108. struct rockchip_pin_ctrl {
  109. struct rockchip_pin_bank *pin_banks;
  110. u32 nr_banks;
  111. u32 nr_pins;
  112. char *label;
  113. enum rockchip_pinctrl_type type;
  114. int mux_offset;
  115. void (*pull_calc_reg)(struct rockchip_pin_bank *bank, int pin_num,
  116. void __iomem **reg, u8 *bit);
  117. };
  118. struct rockchip_pin_config {
  119. unsigned int func;
  120. unsigned long *configs;
  121. unsigned int nconfigs;
  122. };
  123. /**
  124. * struct rockchip_pin_group: represent group of pins of a pinmux function.
  125. * @name: name of the pin group, used to lookup the group.
  126. * @pins: the pins included in this group.
  127. * @npins: number of pins included in this group.
  128. * @func: the mux function number to be programmed when selected.
  129. * @configs: the config values to be set for each pin
  130. * @nconfigs: number of configs for each pin
  131. */
  132. struct rockchip_pin_group {
  133. const char *name;
  134. unsigned int npins;
  135. unsigned int *pins;
  136. struct rockchip_pin_config *data;
  137. };
  138. /**
  139. * struct rockchip_pmx_func: represent a pin function.
  140. * @name: name of the pin function, used to lookup the function.
  141. * @groups: one or more names of pin groups that provide this function.
  142. * @num_groups: number of groups included in @groups.
  143. */
  144. struct rockchip_pmx_func {
  145. const char *name;
  146. const char **groups;
  147. u8 ngroups;
  148. };
  149. struct rockchip_pinctrl {
  150. void __iomem *reg_base;
  151. void __iomem *reg_pull;
  152. struct device *dev;
  153. struct rockchip_pin_ctrl *ctrl;
  154. struct pinctrl_desc pctl;
  155. struct pinctrl_dev *pctl_dev;
  156. struct rockchip_pin_group *groups;
  157. unsigned int ngroups;
  158. struct rockchip_pmx_func *functions;
  159. unsigned int nfunctions;
  160. };
  161. static inline struct rockchip_pin_bank *gc_to_pin_bank(struct gpio_chip *gc)
  162. {
  163. return container_of(gc, struct rockchip_pin_bank, gpio_chip);
  164. }
  165. static const inline struct rockchip_pin_group *pinctrl_name_to_group(
  166. const struct rockchip_pinctrl *info,
  167. const char *name)
  168. {
  169. int i;
  170. for (i = 0; i < info->ngroups; i++) {
  171. if (!strcmp(info->groups[i].name, name))
  172. return &info->groups[i];
  173. }
  174. return NULL;
  175. }
  176. /*
  177. * given a pin number that is local to a pin controller, find out the pin bank
  178. * and the register base of the pin bank.
  179. */
  180. static struct rockchip_pin_bank *pin_to_bank(struct rockchip_pinctrl *info,
  181. unsigned pin)
  182. {
  183. struct rockchip_pin_bank *b = info->ctrl->pin_banks;
  184. while (pin >= (b->pin_base + b->nr_pins))
  185. b++;
  186. return b;
  187. }
  188. static struct rockchip_pin_bank *bank_num_to_bank(
  189. struct rockchip_pinctrl *info,
  190. unsigned num)
  191. {
  192. struct rockchip_pin_bank *b = info->ctrl->pin_banks;
  193. int i;
  194. for (i = 0; i < info->ctrl->nr_banks; i++, b++) {
  195. if (b->bank_num == num)
  196. return b;
  197. }
  198. return ERR_PTR(-EINVAL);
  199. }
  200. /*
  201. * Pinctrl_ops handling
  202. */
  203. static int rockchip_get_groups_count(struct pinctrl_dev *pctldev)
  204. {
  205. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  206. return info->ngroups;
  207. }
  208. static const char *rockchip_get_group_name(struct pinctrl_dev *pctldev,
  209. unsigned selector)
  210. {
  211. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  212. return info->groups[selector].name;
  213. }
  214. static int rockchip_get_group_pins(struct pinctrl_dev *pctldev,
  215. unsigned selector, const unsigned **pins,
  216. unsigned *npins)
  217. {
  218. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  219. if (selector >= info->ngroups)
  220. return -EINVAL;
  221. *pins = info->groups[selector].pins;
  222. *npins = info->groups[selector].npins;
  223. return 0;
  224. }
  225. static int rockchip_dt_node_to_map(struct pinctrl_dev *pctldev,
  226. struct device_node *np,
  227. struct pinctrl_map **map, unsigned *num_maps)
  228. {
  229. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  230. const struct rockchip_pin_group *grp;
  231. struct pinctrl_map *new_map;
  232. struct device_node *parent;
  233. int map_num = 1;
  234. int i;
  235. /*
  236. * first find the group of this node and check if we need to create
  237. * config maps for pins
  238. */
  239. grp = pinctrl_name_to_group(info, np->name);
  240. if (!grp) {
  241. dev_err(info->dev, "unable to find group for node %s\n",
  242. np->name);
  243. return -EINVAL;
  244. }
  245. map_num += grp->npins;
  246. new_map = devm_kzalloc(pctldev->dev, sizeof(*new_map) * map_num,
  247. GFP_KERNEL);
  248. if (!new_map)
  249. return -ENOMEM;
  250. *map = new_map;
  251. *num_maps = map_num;
  252. /* create mux map */
  253. parent = of_get_parent(np);
  254. if (!parent) {
  255. devm_kfree(pctldev->dev, new_map);
  256. return -EINVAL;
  257. }
  258. new_map[0].type = PIN_MAP_TYPE_MUX_GROUP;
  259. new_map[0].data.mux.function = parent->name;
  260. new_map[0].data.mux.group = np->name;
  261. of_node_put(parent);
  262. /* create config map */
  263. new_map++;
  264. for (i = 0; i < grp->npins; i++) {
  265. new_map[i].type = PIN_MAP_TYPE_CONFIGS_PIN;
  266. new_map[i].data.configs.group_or_pin =
  267. pin_get_name(pctldev, grp->pins[i]);
  268. new_map[i].data.configs.configs = grp->data[i].configs;
  269. new_map[i].data.configs.num_configs = grp->data[i].nconfigs;
  270. }
  271. dev_dbg(pctldev->dev, "maps: function %s group %s num %d\n",
  272. (*map)->data.mux.function, (*map)->data.mux.group, map_num);
  273. return 0;
  274. }
  275. static void rockchip_dt_free_map(struct pinctrl_dev *pctldev,
  276. struct pinctrl_map *map, unsigned num_maps)
  277. {
  278. }
  279. static const struct pinctrl_ops rockchip_pctrl_ops = {
  280. .get_groups_count = rockchip_get_groups_count,
  281. .get_group_name = rockchip_get_group_name,
  282. .get_group_pins = rockchip_get_group_pins,
  283. .dt_node_to_map = rockchip_dt_node_to_map,
  284. .dt_free_map = rockchip_dt_free_map,
  285. };
  286. /*
  287. * Hardware access
  288. */
  289. /*
  290. * Set a new mux function for a pin.
  291. *
  292. * The register is divided into the upper and lower 16 bit. When changing
  293. * a value, the previous register value is not read and changed. Instead
  294. * it seems the changed bits are marked in the upper 16 bit, while the
  295. * changed value gets set in the same offset in the lower 16 bit.
  296. * All pin settings seem to be 2 bit wide in both the upper and lower
  297. * parts.
  298. * @bank: pin bank to change
  299. * @pin: pin to change
  300. * @mux: new mux function to set
  301. */
  302. static void rockchip_set_mux(struct rockchip_pin_bank *bank, int pin, int mux)
  303. {
  304. struct rockchip_pinctrl *info = bank->drvdata;
  305. void __iomem *reg = info->reg_base + info->ctrl->mux_offset;
  306. unsigned long flags;
  307. u8 bit;
  308. u32 data;
  309. dev_dbg(info->dev, "setting mux of GPIO%d-%d to %d\n",
  310. bank->bank_num, pin, mux);
  311. /* get basic quadrupel of mux registers and the correct reg inside */
  312. reg += bank->bank_num * 0x10;
  313. reg += (pin / 8) * 4;
  314. bit = (pin % 8) * 2;
  315. spin_lock_irqsave(&bank->slock, flags);
  316. data = (3 << (bit + 16));
  317. data |= (mux & 3) << bit;
  318. writel(data, reg);
  319. spin_unlock_irqrestore(&bank->slock, flags);
  320. }
  321. #define RK2928_PULL_OFFSET 0x118
  322. #define RK2928_PULL_PINS_PER_REG 16
  323. #define RK2928_PULL_BANK_STRIDE 8
  324. static void rk2928_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
  325. int pin_num, void __iomem **reg, u8 *bit)
  326. {
  327. struct rockchip_pinctrl *info = bank->drvdata;
  328. *reg = info->reg_base + RK2928_PULL_OFFSET;
  329. *reg += bank->bank_num * RK2928_PULL_BANK_STRIDE;
  330. *reg += (pin_num / RK2928_PULL_PINS_PER_REG) * 4;
  331. *bit = pin_num % RK2928_PULL_PINS_PER_REG;
  332. };
  333. #define RK3188_PULL_BITS_PER_PIN 2
  334. #define RK3188_PULL_PINS_PER_REG 8
  335. #define RK3188_PULL_BANK_STRIDE 16
  336. static void rk3188_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
  337. int pin_num, void __iomem **reg, u8 *bit)
  338. {
  339. struct rockchip_pinctrl *info = bank->drvdata;
  340. /* The first 12 pins of the first bank are located elsewhere */
  341. if (bank->bank_type == RK3188_BANK0 && pin_num < 12) {
  342. *reg = bank->reg_pull +
  343. ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  344. *bit = pin_num % RK3188_PULL_PINS_PER_REG;
  345. *bit *= RK3188_PULL_BITS_PER_PIN;
  346. } else {
  347. *reg = info->reg_pull - 4;
  348. *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE;
  349. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  350. /*
  351. * The bits in these registers have an inverse ordering
  352. * with the lowest pin being in bits 15:14 and the highest
  353. * pin in bits 1:0
  354. */
  355. *bit = 7 - (pin_num % RK3188_PULL_PINS_PER_REG);
  356. *bit *= RK3188_PULL_BITS_PER_PIN;
  357. }
  358. }
  359. static int rockchip_get_pull(struct rockchip_pin_bank *bank, int pin_num)
  360. {
  361. struct rockchip_pinctrl *info = bank->drvdata;
  362. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  363. void __iomem *reg;
  364. u8 bit;
  365. u32 data;
  366. /* rk3066b does support any pulls */
  367. if (ctrl->type == RK3066B)
  368. return PIN_CONFIG_BIAS_DISABLE;
  369. ctrl->pull_calc_reg(bank, pin_num, &reg, &bit);
  370. switch (ctrl->type) {
  371. case RK2928:
  372. return !(readl_relaxed(reg) & BIT(bit))
  373. ? PIN_CONFIG_BIAS_PULL_PIN_DEFAULT
  374. : PIN_CONFIG_BIAS_DISABLE;
  375. case RK3188:
  376. data = readl_relaxed(reg) >> bit;
  377. data &= (1 << RK3188_PULL_BITS_PER_PIN) - 1;
  378. switch (data) {
  379. case 0:
  380. return PIN_CONFIG_BIAS_DISABLE;
  381. case 1:
  382. return PIN_CONFIG_BIAS_PULL_UP;
  383. case 2:
  384. return PIN_CONFIG_BIAS_PULL_DOWN;
  385. case 3:
  386. return PIN_CONFIG_BIAS_BUS_HOLD;
  387. }
  388. dev_err(info->dev, "unknown pull setting\n");
  389. return -EIO;
  390. default:
  391. dev_err(info->dev, "unsupported pinctrl type\n");
  392. return -EINVAL;
  393. };
  394. }
  395. static int rockchip_set_pull(struct rockchip_pin_bank *bank,
  396. int pin_num, int pull)
  397. {
  398. struct rockchip_pinctrl *info = bank->drvdata;
  399. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  400. void __iomem *reg;
  401. unsigned long flags;
  402. u8 bit;
  403. u32 data;
  404. dev_dbg(info->dev, "setting pull of GPIO%d-%d to %d\n",
  405. bank->bank_num, pin_num, pull);
  406. /* rk3066b does support any pulls */
  407. if (ctrl->type == RK3066B)
  408. return pull ? -EINVAL : 0;
  409. ctrl->pull_calc_reg(bank, pin_num, &reg, &bit);
  410. switch (ctrl->type) {
  411. case RK2928:
  412. spin_lock_irqsave(&bank->slock, flags);
  413. data = BIT(bit + 16);
  414. if (pull == PIN_CONFIG_BIAS_DISABLE)
  415. data |= BIT(bit);
  416. writel(data, reg);
  417. spin_unlock_irqrestore(&bank->slock, flags);
  418. break;
  419. case RK3188:
  420. spin_lock_irqsave(&bank->slock, flags);
  421. /* enable the write to the equivalent lower bits */
  422. data = ((1 << RK3188_PULL_BITS_PER_PIN) - 1) << (bit + 16);
  423. switch (pull) {
  424. case PIN_CONFIG_BIAS_DISABLE:
  425. break;
  426. case PIN_CONFIG_BIAS_PULL_UP:
  427. data |= (1 << bit);
  428. break;
  429. case PIN_CONFIG_BIAS_PULL_DOWN:
  430. data |= (2 << bit);
  431. break;
  432. case PIN_CONFIG_BIAS_BUS_HOLD:
  433. data |= (3 << bit);
  434. break;
  435. default:
  436. dev_err(info->dev, "unsupported pull setting %d\n",
  437. pull);
  438. return -EINVAL;
  439. }
  440. writel(data, reg);
  441. spin_unlock_irqrestore(&bank->slock, flags);
  442. break;
  443. default:
  444. dev_err(info->dev, "unsupported pinctrl type\n");
  445. return -EINVAL;
  446. }
  447. return 0;
  448. }
  449. /*
  450. * Pinmux_ops handling
  451. */
  452. static int rockchip_pmx_get_funcs_count(struct pinctrl_dev *pctldev)
  453. {
  454. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  455. return info->nfunctions;
  456. }
  457. static const char *rockchip_pmx_get_func_name(struct pinctrl_dev *pctldev,
  458. unsigned selector)
  459. {
  460. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  461. return info->functions[selector].name;
  462. }
  463. static int rockchip_pmx_get_groups(struct pinctrl_dev *pctldev,
  464. unsigned selector, const char * const **groups,
  465. unsigned * const num_groups)
  466. {
  467. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  468. *groups = info->functions[selector].groups;
  469. *num_groups = info->functions[selector].ngroups;
  470. return 0;
  471. }
  472. static int rockchip_pmx_enable(struct pinctrl_dev *pctldev, unsigned selector,
  473. unsigned group)
  474. {
  475. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  476. const unsigned int *pins = info->groups[group].pins;
  477. const struct rockchip_pin_config *data = info->groups[group].data;
  478. struct rockchip_pin_bank *bank;
  479. int cnt;
  480. dev_dbg(info->dev, "enable function %s group %s\n",
  481. info->functions[selector].name, info->groups[group].name);
  482. /*
  483. * for each pin in the pin group selected, program the correspoding pin
  484. * pin function number in the config register.
  485. */
  486. for (cnt = 0; cnt < info->groups[group].npins; cnt++) {
  487. bank = pin_to_bank(info, pins[cnt]);
  488. rockchip_set_mux(bank, pins[cnt] - bank->pin_base,
  489. data[cnt].func);
  490. }
  491. return 0;
  492. }
  493. static void rockchip_pmx_disable(struct pinctrl_dev *pctldev,
  494. unsigned selector, unsigned group)
  495. {
  496. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  497. const unsigned int *pins = info->groups[group].pins;
  498. struct rockchip_pin_bank *bank;
  499. int cnt;
  500. dev_dbg(info->dev, "disable function %s group %s\n",
  501. info->functions[selector].name, info->groups[group].name);
  502. for (cnt = 0; cnt < info->groups[group].npins; cnt++) {
  503. bank = pin_to_bank(info, pins[cnt]);
  504. rockchip_set_mux(bank, pins[cnt] - bank->pin_base, 0);
  505. }
  506. }
  507. /*
  508. * The calls to gpio_direction_output() and gpio_direction_input()
  509. * leads to this function call (via the pinctrl_gpio_direction_{input|output}()
  510. * function called from the gpiolib interface).
  511. */
  512. static int rockchip_pmx_gpio_set_direction(struct pinctrl_dev *pctldev,
  513. struct pinctrl_gpio_range *range,
  514. unsigned offset, bool input)
  515. {
  516. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  517. struct rockchip_pin_bank *bank;
  518. struct gpio_chip *chip;
  519. int pin;
  520. u32 data;
  521. chip = range->gc;
  522. bank = gc_to_pin_bank(chip);
  523. pin = offset - chip->base;
  524. dev_dbg(info->dev, "gpio_direction for pin %u as %s-%d to %s\n",
  525. offset, range->name, pin, input ? "input" : "output");
  526. rockchip_set_mux(bank, pin, RK_FUNC_GPIO);
  527. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  528. /* set bit to 1 for output, 0 for input */
  529. if (!input)
  530. data |= BIT(pin);
  531. else
  532. data &= ~BIT(pin);
  533. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  534. return 0;
  535. }
  536. static const struct pinmux_ops rockchip_pmx_ops = {
  537. .get_functions_count = rockchip_pmx_get_funcs_count,
  538. .get_function_name = rockchip_pmx_get_func_name,
  539. .get_function_groups = rockchip_pmx_get_groups,
  540. .enable = rockchip_pmx_enable,
  541. .disable = rockchip_pmx_disable,
  542. .gpio_set_direction = rockchip_pmx_gpio_set_direction,
  543. };
  544. /*
  545. * Pinconf_ops handling
  546. */
  547. static bool rockchip_pinconf_pull_valid(struct rockchip_pin_ctrl *ctrl,
  548. enum pin_config_param pull)
  549. {
  550. switch (ctrl->type) {
  551. case RK2928:
  552. return (pull == PIN_CONFIG_BIAS_PULL_PIN_DEFAULT ||
  553. pull == PIN_CONFIG_BIAS_DISABLE);
  554. case RK3066B:
  555. return pull ? false : true;
  556. case RK3188:
  557. return (pull != PIN_CONFIG_BIAS_PULL_PIN_DEFAULT);
  558. }
  559. return false;
  560. }
  561. /* set the pin config settings for a specified pin */
  562. static int rockchip_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
  563. unsigned long *configs, unsigned num_configs)
  564. {
  565. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  566. struct rockchip_pin_bank *bank = pin_to_bank(info, pin);
  567. enum pin_config_param param;
  568. u16 arg;
  569. int i;
  570. int rc;
  571. for (i = 0; i < num_configs; i++) {
  572. param = pinconf_to_config_param(configs[i]);
  573. arg = pinconf_to_config_argument(configs[i]);
  574. switch (param) {
  575. case PIN_CONFIG_BIAS_DISABLE:
  576. rc = rockchip_set_pull(bank, pin - bank->pin_base,
  577. param);
  578. if (rc)
  579. return rc;
  580. break;
  581. case PIN_CONFIG_BIAS_PULL_UP:
  582. case PIN_CONFIG_BIAS_PULL_DOWN:
  583. case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
  584. case PIN_CONFIG_BIAS_BUS_HOLD:
  585. if (!rockchip_pinconf_pull_valid(info->ctrl, param))
  586. return -ENOTSUPP;
  587. if (!arg)
  588. return -EINVAL;
  589. rc = rockchip_set_pull(bank, pin - bank->pin_base,
  590. param);
  591. if (rc)
  592. return rc;
  593. break;
  594. default:
  595. return -ENOTSUPP;
  596. break;
  597. }
  598. } /* for each config */
  599. return 0;
  600. }
  601. /* get the pin config settings for a specified pin */
  602. static int rockchip_pinconf_get(struct pinctrl_dev *pctldev, unsigned int pin,
  603. unsigned long *config)
  604. {
  605. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  606. struct rockchip_pin_bank *bank = pin_to_bank(info, pin);
  607. enum pin_config_param param = pinconf_to_config_param(*config);
  608. switch (param) {
  609. case PIN_CONFIG_BIAS_DISABLE:
  610. if (rockchip_get_pull(bank, pin - bank->pin_base) != param)
  611. return -EINVAL;
  612. *config = 0;
  613. break;
  614. case PIN_CONFIG_BIAS_PULL_UP:
  615. case PIN_CONFIG_BIAS_PULL_DOWN:
  616. case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
  617. case PIN_CONFIG_BIAS_BUS_HOLD:
  618. if (!rockchip_pinconf_pull_valid(info->ctrl, param))
  619. return -ENOTSUPP;
  620. if (rockchip_get_pull(bank, pin - bank->pin_base) != param)
  621. return -EINVAL;
  622. *config = 1;
  623. break;
  624. default:
  625. return -ENOTSUPP;
  626. break;
  627. }
  628. return 0;
  629. }
  630. static const struct pinconf_ops rockchip_pinconf_ops = {
  631. .pin_config_get = rockchip_pinconf_get,
  632. .pin_config_set = rockchip_pinconf_set,
  633. };
  634. static const struct of_device_id rockchip_bank_match[] = {
  635. { .compatible = "rockchip,gpio-bank" },
  636. { .compatible = "rockchip,rk3188-gpio-bank0" },
  637. {},
  638. };
  639. static void rockchip_pinctrl_child_count(struct rockchip_pinctrl *info,
  640. struct device_node *np)
  641. {
  642. struct device_node *child;
  643. for_each_child_of_node(np, child) {
  644. if (of_match_node(rockchip_bank_match, child))
  645. continue;
  646. info->nfunctions++;
  647. info->ngroups += of_get_child_count(child);
  648. }
  649. }
  650. static int rockchip_pinctrl_parse_groups(struct device_node *np,
  651. struct rockchip_pin_group *grp,
  652. struct rockchip_pinctrl *info,
  653. u32 index)
  654. {
  655. struct rockchip_pin_bank *bank;
  656. int size;
  657. const __be32 *list;
  658. int num;
  659. int i, j;
  660. int ret;
  661. dev_dbg(info->dev, "group(%d): %s\n", index, np->name);
  662. /* Initialise group */
  663. grp->name = np->name;
  664. /*
  665. * the binding format is rockchip,pins = <bank pin mux CONFIG>,
  666. * do sanity check and calculate pins number
  667. */
  668. list = of_get_property(np, "rockchip,pins", &size);
  669. /* we do not check return since it's safe node passed down */
  670. size /= sizeof(*list);
  671. if (!size || size % 4) {
  672. dev_err(info->dev, "wrong pins number or pins and configs should be by 4\n");
  673. return -EINVAL;
  674. }
  675. grp->npins = size / 4;
  676. grp->pins = devm_kzalloc(info->dev, grp->npins * sizeof(unsigned int),
  677. GFP_KERNEL);
  678. grp->data = devm_kzalloc(info->dev, grp->npins *
  679. sizeof(struct rockchip_pin_config),
  680. GFP_KERNEL);
  681. if (!grp->pins || !grp->data)
  682. return -ENOMEM;
  683. for (i = 0, j = 0; i < size; i += 4, j++) {
  684. const __be32 *phandle;
  685. struct device_node *np_config;
  686. num = be32_to_cpu(*list++);
  687. bank = bank_num_to_bank(info, num);
  688. if (IS_ERR(bank))
  689. return PTR_ERR(bank);
  690. grp->pins[j] = bank->pin_base + be32_to_cpu(*list++);
  691. grp->data[j].func = be32_to_cpu(*list++);
  692. phandle = list++;
  693. if (!phandle)
  694. return -EINVAL;
  695. np_config = of_find_node_by_phandle(be32_to_cpup(phandle));
  696. ret = pinconf_generic_parse_dt_config(np_config,
  697. &grp->data[j].configs, &grp->data[j].nconfigs);
  698. if (ret)
  699. return ret;
  700. }
  701. return 0;
  702. }
  703. static int rockchip_pinctrl_parse_functions(struct device_node *np,
  704. struct rockchip_pinctrl *info,
  705. u32 index)
  706. {
  707. struct device_node *child;
  708. struct rockchip_pmx_func *func;
  709. struct rockchip_pin_group *grp;
  710. int ret;
  711. static u32 grp_index;
  712. u32 i = 0;
  713. dev_dbg(info->dev, "parse function(%d): %s\n", index, np->name);
  714. func = &info->functions[index];
  715. /* Initialise function */
  716. func->name = np->name;
  717. func->ngroups = of_get_child_count(np);
  718. if (func->ngroups <= 0)
  719. return 0;
  720. func->groups = devm_kzalloc(info->dev,
  721. func->ngroups * sizeof(char *), GFP_KERNEL);
  722. if (!func->groups)
  723. return -ENOMEM;
  724. for_each_child_of_node(np, child) {
  725. func->groups[i] = child->name;
  726. grp = &info->groups[grp_index++];
  727. ret = rockchip_pinctrl_parse_groups(child, grp, info, i++);
  728. if (ret)
  729. return ret;
  730. }
  731. return 0;
  732. }
  733. static int rockchip_pinctrl_parse_dt(struct platform_device *pdev,
  734. struct rockchip_pinctrl *info)
  735. {
  736. struct device *dev = &pdev->dev;
  737. struct device_node *np = dev->of_node;
  738. struct device_node *child;
  739. int ret;
  740. int i;
  741. rockchip_pinctrl_child_count(info, np);
  742. dev_dbg(&pdev->dev, "nfunctions = %d\n", info->nfunctions);
  743. dev_dbg(&pdev->dev, "ngroups = %d\n", info->ngroups);
  744. info->functions = devm_kzalloc(dev, info->nfunctions *
  745. sizeof(struct rockchip_pmx_func),
  746. GFP_KERNEL);
  747. if (!info->functions) {
  748. dev_err(dev, "failed to allocate memory for function list\n");
  749. return -EINVAL;
  750. }
  751. info->groups = devm_kzalloc(dev, info->ngroups *
  752. sizeof(struct rockchip_pin_group),
  753. GFP_KERNEL);
  754. if (!info->groups) {
  755. dev_err(dev, "failed allocate memory for ping group list\n");
  756. return -EINVAL;
  757. }
  758. i = 0;
  759. for_each_child_of_node(np, child) {
  760. if (of_match_node(rockchip_bank_match, child))
  761. continue;
  762. ret = rockchip_pinctrl_parse_functions(child, info, i++);
  763. if (ret) {
  764. dev_err(&pdev->dev, "failed to parse function\n");
  765. return ret;
  766. }
  767. }
  768. return 0;
  769. }
  770. static int rockchip_pinctrl_register(struct platform_device *pdev,
  771. struct rockchip_pinctrl *info)
  772. {
  773. struct pinctrl_desc *ctrldesc = &info->pctl;
  774. struct pinctrl_pin_desc *pindesc, *pdesc;
  775. struct rockchip_pin_bank *pin_bank;
  776. int pin, bank, ret;
  777. int k;
  778. ctrldesc->name = "rockchip-pinctrl";
  779. ctrldesc->owner = THIS_MODULE;
  780. ctrldesc->pctlops = &rockchip_pctrl_ops;
  781. ctrldesc->pmxops = &rockchip_pmx_ops;
  782. ctrldesc->confops = &rockchip_pinconf_ops;
  783. pindesc = devm_kzalloc(&pdev->dev, sizeof(*pindesc) *
  784. info->ctrl->nr_pins, GFP_KERNEL);
  785. if (!pindesc) {
  786. dev_err(&pdev->dev, "mem alloc for pin descriptors failed\n");
  787. return -ENOMEM;
  788. }
  789. ctrldesc->pins = pindesc;
  790. ctrldesc->npins = info->ctrl->nr_pins;
  791. pdesc = pindesc;
  792. for (bank = 0 , k = 0; bank < info->ctrl->nr_banks; bank++) {
  793. pin_bank = &info->ctrl->pin_banks[bank];
  794. for (pin = 0; pin < pin_bank->nr_pins; pin++, k++) {
  795. pdesc->number = k;
  796. pdesc->name = kasprintf(GFP_KERNEL, "%s-%d",
  797. pin_bank->name, pin);
  798. pdesc++;
  799. }
  800. }
  801. info->pctl_dev = pinctrl_register(ctrldesc, &pdev->dev, info);
  802. if (!info->pctl_dev) {
  803. dev_err(&pdev->dev, "could not register pinctrl driver\n");
  804. return -EINVAL;
  805. }
  806. for (bank = 0; bank < info->ctrl->nr_banks; ++bank) {
  807. pin_bank = &info->ctrl->pin_banks[bank];
  808. pin_bank->grange.name = pin_bank->name;
  809. pin_bank->grange.id = bank;
  810. pin_bank->grange.pin_base = pin_bank->pin_base;
  811. pin_bank->grange.base = pin_bank->gpio_chip.base;
  812. pin_bank->grange.npins = pin_bank->gpio_chip.ngpio;
  813. pin_bank->grange.gc = &pin_bank->gpio_chip;
  814. pinctrl_add_gpio_range(info->pctl_dev, &pin_bank->grange);
  815. }
  816. ret = rockchip_pinctrl_parse_dt(pdev, info);
  817. if (ret) {
  818. pinctrl_unregister(info->pctl_dev);
  819. return ret;
  820. }
  821. return 0;
  822. }
  823. /*
  824. * GPIO handling
  825. */
  826. static int rockchip_gpio_request(struct gpio_chip *chip, unsigned offset)
  827. {
  828. return pinctrl_request_gpio(chip->base + offset);
  829. }
  830. static void rockchip_gpio_free(struct gpio_chip *chip, unsigned offset)
  831. {
  832. pinctrl_free_gpio(chip->base + offset);
  833. }
  834. static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value)
  835. {
  836. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  837. void __iomem *reg = bank->reg_base + GPIO_SWPORT_DR;
  838. unsigned long flags;
  839. u32 data;
  840. spin_lock_irqsave(&bank->slock, flags);
  841. data = readl(reg);
  842. data &= ~BIT(offset);
  843. if (value)
  844. data |= BIT(offset);
  845. writel(data, reg);
  846. spin_unlock_irqrestore(&bank->slock, flags);
  847. }
  848. /*
  849. * Returns the level of the pin for input direction and setting of the DR
  850. * register for output gpios.
  851. */
  852. static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset)
  853. {
  854. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  855. u32 data;
  856. data = readl(bank->reg_base + GPIO_EXT_PORT);
  857. data >>= offset;
  858. data &= 1;
  859. return data;
  860. }
  861. /*
  862. * gpiolib gpio_direction_input callback function. The setting of the pin
  863. * mux function as 'gpio input' will be handled by the pinctrl susbsystem
  864. * interface.
  865. */
  866. static int rockchip_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
  867. {
  868. return pinctrl_gpio_direction_input(gc->base + offset);
  869. }
  870. /*
  871. * gpiolib gpio_direction_output callback function. The setting of the pin
  872. * mux function as 'gpio output' will be handled by the pinctrl susbsystem
  873. * interface.
  874. */
  875. static int rockchip_gpio_direction_output(struct gpio_chip *gc,
  876. unsigned offset, int value)
  877. {
  878. rockchip_gpio_set(gc, offset, value);
  879. return pinctrl_gpio_direction_output(gc->base + offset);
  880. }
  881. /*
  882. * gpiolib gpio_to_irq callback function. Creates a mapping between a GPIO pin
  883. * and a virtual IRQ, if not already present.
  884. */
  885. static int rockchip_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
  886. {
  887. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  888. unsigned int virq;
  889. if (!bank->domain)
  890. return -ENXIO;
  891. virq = irq_create_mapping(bank->domain, offset);
  892. return (virq) ? : -ENXIO;
  893. }
  894. static const struct gpio_chip rockchip_gpiolib_chip = {
  895. .request = rockchip_gpio_request,
  896. .free = rockchip_gpio_free,
  897. .set = rockchip_gpio_set,
  898. .get = rockchip_gpio_get,
  899. .direction_input = rockchip_gpio_direction_input,
  900. .direction_output = rockchip_gpio_direction_output,
  901. .to_irq = rockchip_gpio_to_irq,
  902. .owner = THIS_MODULE,
  903. };
  904. /*
  905. * Interrupt handling
  906. */
  907. static void rockchip_irq_demux(unsigned int irq, struct irq_desc *desc)
  908. {
  909. struct irq_chip *chip = irq_get_chip(irq);
  910. struct rockchip_pin_bank *bank = irq_get_handler_data(irq);
  911. u32 polarity = 0, data = 0;
  912. u32 pend;
  913. bool edge_changed = false;
  914. dev_dbg(bank->drvdata->dev, "got irq for bank %s\n", bank->name);
  915. chained_irq_enter(chip, desc);
  916. pend = readl_relaxed(bank->reg_base + GPIO_INT_STATUS);
  917. if (bank->toggle_edge_mode) {
  918. polarity = readl_relaxed(bank->reg_base +
  919. GPIO_INT_POLARITY);
  920. data = readl_relaxed(bank->reg_base + GPIO_EXT_PORT);
  921. }
  922. while (pend) {
  923. unsigned int virq;
  924. irq = __ffs(pend);
  925. pend &= ~BIT(irq);
  926. virq = irq_linear_revmap(bank->domain, irq);
  927. if (!virq) {
  928. dev_err(bank->drvdata->dev, "unmapped irq %d\n", irq);
  929. continue;
  930. }
  931. dev_dbg(bank->drvdata->dev, "handling irq %d\n", irq);
  932. /*
  933. * Triggering IRQ on both rising and falling edge
  934. * needs manual intervention.
  935. */
  936. if (bank->toggle_edge_mode & BIT(irq)) {
  937. if (data & BIT(irq))
  938. polarity &= ~BIT(irq);
  939. else
  940. polarity |= BIT(irq);
  941. edge_changed = true;
  942. }
  943. generic_handle_irq(virq);
  944. }
  945. if (bank->toggle_edge_mode && edge_changed) {
  946. /* Interrupt params should only be set with ints disabled */
  947. data = readl_relaxed(bank->reg_base + GPIO_INTEN);
  948. writel_relaxed(0, bank->reg_base + GPIO_INTEN);
  949. writel(polarity, bank->reg_base + GPIO_INT_POLARITY);
  950. writel(data, bank->reg_base + GPIO_INTEN);
  951. }
  952. chained_irq_exit(chip, desc);
  953. }
  954. static int rockchip_irq_set_type(struct irq_data *d, unsigned int type)
  955. {
  956. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  957. struct rockchip_pin_bank *bank = gc->private;
  958. u32 mask = BIT(d->hwirq);
  959. u32 polarity;
  960. u32 level;
  961. u32 data;
  962. /* make sure the pin is configured as gpio input */
  963. rockchip_set_mux(bank, d->hwirq, RK_FUNC_GPIO);
  964. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  965. data &= ~mask;
  966. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  967. if (type & IRQ_TYPE_EDGE_BOTH)
  968. __irq_set_handler_locked(d->irq, handle_edge_irq);
  969. else
  970. __irq_set_handler_locked(d->irq, handle_level_irq);
  971. irq_gc_lock(gc);
  972. level = readl_relaxed(gc->reg_base + GPIO_INTTYPE_LEVEL);
  973. polarity = readl_relaxed(gc->reg_base + GPIO_INT_POLARITY);
  974. switch (type) {
  975. case IRQ_TYPE_EDGE_BOTH:
  976. bank->toggle_edge_mode |= mask;
  977. level |= mask;
  978. /*
  979. * Determine gpio state. If 1 next interrupt should be falling
  980. * otherwise rising.
  981. */
  982. data = readl(bank->reg_base + GPIO_EXT_PORT);
  983. if (data & mask)
  984. polarity &= ~mask;
  985. else
  986. polarity |= mask;
  987. break;
  988. case IRQ_TYPE_EDGE_RISING:
  989. bank->toggle_edge_mode &= ~mask;
  990. level |= mask;
  991. polarity |= mask;
  992. break;
  993. case IRQ_TYPE_EDGE_FALLING:
  994. bank->toggle_edge_mode &= ~mask;
  995. level |= mask;
  996. polarity &= ~mask;
  997. break;
  998. case IRQ_TYPE_LEVEL_HIGH:
  999. bank->toggle_edge_mode &= ~mask;
  1000. level &= ~mask;
  1001. polarity |= mask;
  1002. break;
  1003. case IRQ_TYPE_LEVEL_LOW:
  1004. bank->toggle_edge_mode &= ~mask;
  1005. level &= ~mask;
  1006. polarity &= ~mask;
  1007. break;
  1008. default:
  1009. irq_gc_unlock(gc);
  1010. return -EINVAL;
  1011. }
  1012. writel_relaxed(level, gc->reg_base + GPIO_INTTYPE_LEVEL);
  1013. writel_relaxed(polarity, gc->reg_base + GPIO_INT_POLARITY);
  1014. irq_gc_unlock(gc);
  1015. return 0;
  1016. }
  1017. static int rockchip_interrupts_register(struct platform_device *pdev,
  1018. struct rockchip_pinctrl *info)
  1019. {
  1020. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1021. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1022. unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN;
  1023. struct irq_chip_generic *gc;
  1024. int ret;
  1025. int i;
  1026. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1027. if (!bank->valid) {
  1028. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1029. bank->name);
  1030. continue;
  1031. }
  1032. bank->domain = irq_domain_add_linear(bank->of_node, 32,
  1033. &irq_generic_chip_ops, NULL);
  1034. if (!bank->domain) {
  1035. dev_warn(&pdev->dev, "could not initialize irq domain for bank %s\n",
  1036. bank->name);
  1037. continue;
  1038. }
  1039. ret = irq_alloc_domain_generic_chips(bank->domain, 32, 1,
  1040. "rockchip_gpio_irq", handle_level_irq,
  1041. clr, 0, IRQ_GC_INIT_MASK_CACHE);
  1042. if (ret) {
  1043. dev_err(&pdev->dev, "could not alloc generic chips for bank %s\n",
  1044. bank->name);
  1045. irq_domain_remove(bank->domain);
  1046. continue;
  1047. }
  1048. gc = irq_get_domain_generic_chip(bank->domain, 0);
  1049. gc->reg_base = bank->reg_base;
  1050. gc->private = bank;
  1051. gc->chip_types[0].regs.mask = GPIO_INTEN;
  1052. gc->chip_types[0].regs.ack = GPIO_PORTS_EOI;
  1053. gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
  1054. gc->chip_types[0].chip.irq_mask = irq_gc_mask_clr_bit;
  1055. gc->chip_types[0].chip.irq_unmask = irq_gc_mask_set_bit;
  1056. gc->chip_types[0].chip.irq_set_wake = irq_gc_set_wake;
  1057. gc->chip_types[0].chip.irq_set_type = rockchip_irq_set_type;
  1058. irq_set_handler_data(bank->irq, bank);
  1059. irq_set_chained_handler(bank->irq, rockchip_irq_demux);
  1060. }
  1061. return 0;
  1062. }
  1063. static int rockchip_gpiolib_register(struct platform_device *pdev,
  1064. struct rockchip_pinctrl *info)
  1065. {
  1066. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1067. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1068. struct gpio_chip *gc;
  1069. int ret;
  1070. int i;
  1071. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1072. if (!bank->valid) {
  1073. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1074. bank->name);
  1075. continue;
  1076. }
  1077. bank->gpio_chip = rockchip_gpiolib_chip;
  1078. gc = &bank->gpio_chip;
  1079. gc->base = bank->pin_base;
  1080. gc->ngpio = bank->nr_pins;
  1081. gc->dev = &pdev->dev;
  1082. gc->of_node = bank->of_node;
  1083. gc->label = bank->name;
  1084. ret = gpiochip_add(gc);
  1085. if (ret) {
  1086. dev_err(&pdev->dev, "failed to register gpio_chip %s, error code: %d\n",
  1087. gc->label, ret);
  1088. goto fail;
  1089. }
  1090. }
  1091. rockchip_interrupts_register(pdev, info);
  1092. return 0;
  1093. fail:
  1094. for (--i, --bank; i >= 0; --i, --bank) {
  1095. if (!bank->valid)
  1096. continue;
  1097. if (gpiochip_remove(&bank->gpio_chip))
  1098. dev_err(&pdev->dev, "gpio chip %s remove failed\n",
  1099. bank->gpio_chip.label);
  1100. }
  1101. return ret;
  1102. }
  1103. static int rockchip_gpiolib_unregister(struct platform_device *pdev,
  1104. struct rockchip_pinctrl *info)
  1105. {
  1106. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1107. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1108. int ret = 0;
  1109. int i;
  1110. for (i = 0; !ret && i < ctrl->nr_banks; ++i, ++bank) {
  1111. if (!bank->valid)
  1112. continue;
  1113. ret = gpiochip_remove(&bank->gpio_chip);
  1114. }
  1115. if (ret)
  1116. dev_err(&pdev->dev, "gpio chip remove failed\n");
  1117. return ret;
  1118. }
  1119. static int rockchip_get_bank_data(struct rockchip_pin_bank *bank,
  1120. struct device *dev)
  1121. {
  1122. struct resource res;
  1123. if (of_address_to_resource(bank->of_node, 0, &res)) {
  1124. dev_err(dev, "cannot find IO resource for bank\n");
  1125. return -ENOENT;
  1126. }
  1127. bank->reg_base = devm_ioremap_resource(dev, &res);
  1128. if (IS_ERR(bank->reg_base))
  1129. return PTR_ERR(bank->reg_base);
  1130. /*
  1131. * special case, where parts of the pull setting-registers are
  1132. * part of the PMU register space
  1133. */
  1134. if (of_device_is_compatible(bank->of_node,
  1135. "rockchip,rk3188-gpio-bank0")) {
  1136. bank->bank_type = RK3188_BANK0;
  1137. if (of_address_to_resource(bank->of_node, 1, &res)) {
  1138. dev_err(dev, "cannot find IO resource for bank\n");
  1139. return -ENOENT;
  1140. }
  1141. bank->reg_pull = devm_ioremap_resource(dev, &res);
  1142. if (IS_ERR(bank->reg_pull))
  1143. return PTR_ERR(bank->reg_pull);
  1144. } else {
  1145. bank->bank_type = COMMON_BANK;
  1146. }
  1147. bank->irq = irq_of_parse_and_map(bank->of_node, 0);
  1148. bank->clk = of_clk_get(bank->of_node, 0);
  1149. if (IS_ERR(bank->clk))
  1150. return PTR_ERR(bank->clk);
  1151. return clk_prepare_enable(bank->clk);
  1152. }
  1153. static const struct of_device_id rockchip_pinctrl_dt_match[];
  1154. /* retrieve the soc specific data */
  1155. static struct rockchip_pin_ctrl *rockchip_pinctrl_get_soc_data(
  1156. struct rockchip_pinctrl *d,
  1157. struct platform_device *pdev)
  1158. {
  1159. const struct of_device_id *match;
  1160. struct device_node *node = pdev->dev.of_node;
  1161. struct device_node *np;
  1162. struct rockchip_pin_ctrl *ctrl;
  1163. struct rockchip_pin_bank *bank;
  1164. int i;
  1165. match = of_match_node(rockchip_pinctrl_dt_match, node);
  1166. ctrl = (struct rockchip_pin_ctrl *)match->data;
  1167. for_each_child_of_node(node, np) {
  1168. if (!of_find_property(np, "gpio-controller", NULL))
  1169. continue;
  1170. bank = ctrl->pin_banks;
  1171. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1172. if (!strcmp(bank->name, np->name)) {
  1173. bank->of_node = np;
  1174. if (!rockchip_get_bank_data(bank, &pdev->dev))
  1175. bank->valid = true;
  1176. break;
  1177. }
  1178. }
  1179. }
  1180. bank = ctrl->pin_banks;
  1181. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1182. spin_lock_init(&bank->slock);
  1183. bank->drvdata = d;
  1184. bank->pin_base = ctrl->nr_pins;
  1185. ctrl->nr_pins += bank->nr_pins;
  1186. }
  1187. return ctrl;
  1188. }
  1189. static int rockchip_pinctrl_probe(struct platform_device *pdev)
  1190. {
  1191. struct rockchip_pinctrl *info;
  1192. struct device *dev = &pdev->dev;
  1193. struct rockchip_pin_ctrl *ctrl;
  1194. struct resource *res;
  1195. int ret;
  1196. if (!dev->of_node) {
  1197. dev_err(dev, "device tree node not found\n");
  1198. return -ENODEV;
  1199. }
  1200. info = devm_kzalloc(dev, sizeof(struct rockchip_pinctrl), GFP_KERNEL);
  1201. if (!info)
  1202. return -ENOMEM;
  1203. ctrl = rockchip_pinctrl_get_soc_data(info, pdev);
  1204. if (!ctrl) {
  1205. dev_err(dev, "driver data not available\n");
  1206. return -EINVAL;
  1207. }
  1208. info->ctrl = ctrl;
  1209. info->dev = dev;
  1210. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1211. info->reg_base = devm_ioremap_resource(&pdev->dev, res);
  1212. if (IS_ERR(info->reg_base))
  1213. return PTR_ERR(info->reg_base);
  1214. /* The RK3188 has its pull registers in a separate place */
  1215. if (ctrl->type == RK3188) {
  1216. res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  1217. info->reg_pull = devm_ioremap_resource(&pdev->dev, res);
  1218. if (IS_ERR(info->reg_base))
  1219. return PTR_ERR(info->reg_base);
  1220. }
  1221. ret = rockchip_gpiolib_register(pdev, info);
  1222. if (ret)
  1223. return ret;
  1224. ret = rockchip_pinctrl_register(pdev, info);
  1225. if (ret) {
  1226. rockchip_gpiolib_unregister(pdev, info);
  1227. return ret;
  1228. }
  1229. platform_set_drvdata(pdev, info);
  1230. return 0;
  1231. }
  1232. static struct rockchip_pin_bank rk2928_pin_banks[] = {
  1233. PIN_BANK(0, 32, "gpio0"),
  1234. PIN_BANK(1, 32, "gpio1"),
  1235. PIN_BANK(2, 32, "gpio2"),
  1236. PIN_BANK(3, 32, "gpio3"),
  1237. };
  1238. static struct rockchip_pin_ctrl rk2928_pin_ctrl = {
  1239. .pin_banks = rk2928_pin_banks,
  1240. .nr_banks = ARRAY_SIZE(rk2928_pin_banks),
  1241. .label = "RK2928-GPIO",
  1242. .type = RK2928,
  1243. .mux_offset = 0xa8,
  1244. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1245. };
  1246. static struct rockchip_pin_bank rk3066a_pin_banks[] = {
  1247. PIN_BANK(0, 32, "gpio0"),
  1248. PIN_BANK(1, 32, "gpio1"),
  1249. PIN_BANK(2, 32, "gpio2"),
  1250. PIN_BANK(3, 32, "gpio3"),
  1251. PIN_BANK(4, 32, "gpio4"),
  1252. PIN_BANK(6, 16, "gpio6"),
  1253. };
  1254. static struct rockchip_pin_ctrl rk3066a_pin_ctrl = {
  1255. .pin_banks = rk3066a_pin_banks,
  1256. .nr_banks = ARRAY_SIZE(rk3066a_pin_banks),
  1257. .label = "RK3066a-GPIO",
  1258. .type = RK2928,
  1259. .mux_offset = 0xa8,
  1260. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1261. };
  1262. static struct rockchip_pin_bank rk3066b_pin_banks[] = {
  1263. PIN_BANK(0, 32, "gpio0"),
  1264. PIN_BANK(1, 32, "gpio1"),
  1265. PIN_BANK(2, 32, "gpio2"),
  1266. PIN_BANK(3, 32, "gpio3"),
  1267. };
  1268. static struct rockchip_pin_ctrl rk3066b_pin_ctrl = {
  1269. .pin_banks = rk3066b_pin_banks,
  1270. .nr_banks = ARRAY_SIZE(rk3066b_pin_banks),
  1271. .label = "RK3066b-GPIO",
  1272. .type = RK3066B,
  1273. .mux_offset = 0x60,
  1274. };
  1275. static struct rockchip_pin_bank rk3188_pin_banks[] = {
  1276. PIN_BANK(0, 32, "gpio0"),
  1277. PIN_BANK(1, 32, "gpio1"),
  1278. PIN_BANK(2, 32, "gpio2"),
  1279. PIN_BANK(3, 32, "gpio3"),
  1280. };
  1281. static struct rockchip_pin_ctrl rk3188_pin_ctrl = {
  1282. .pin_banks = rk3188_pin_banks,
  1283. .nr_banks = ARRAY_SIZE(rk3188_pin_banks),
  1284. .label = "RK3188-GPIO",
  1285. .type = RK3188,
  1286. .mux_offset = 0x68,
  1287. .pull_calc_reg = rk3188_calc_pull_reg_and_bit,
  1288. };
  1289. static const struct of_device_id rockchip_pinctrl_dt_match[] = {
  1290. { .compatible = "rockchip,rk2928-pinctrl",
  1291. .data = (void *)&rk2928_pin_ctrl },
  1292. { .compatible = "rockchip,rk3066a-pinctrl",
  1293. .data = (void *)&rk3066a_pin_ctrl },
  1294. { .compatible = "rockchip,rk3066b-pinctrl",
  1295. .data = (void *)&rk3066b_pin_ctrl },
  1296. { .compatible = "rockchip,rk3188-pinctrl",
  1297. .data = (void *)&rk3188_pin_ctrl },
  1298. {},
  1299. };
  1300. MODULE_DEVICE_TABLE(of, rockchip_pinctrl_dt_match);
  1301. static struct platform_driver rockchip_pinctrl_driver = {
  1302. .probe = rockchip_pinctrl_probe,
  1303. .driver = {
  1304. .name = "rockchip-pinctrl",
  1305. .owner = THIS_MODULE,
  1306. .of_match_table = rockchip_pinctrl_dt_match,
  1307. },
  1308. };
  1309. static int __init rockchip_pinctrl_drv_register(void)
  1310. {
  1311. return platform_driver_register(&rockchip_pinctrl_driver);
  1312. }
  1313. postcore_initcall(rockchip_pinctrl_drv_register);
  1314. MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
  1315. MODULE_DESCRIPTION("Rockchip pinctrl driver");
  1316. MODULE_LICENSE("GPL v2");