pinctrl-rockchip.c 56 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195
  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 <linux/regmap.h>
  40. #include <linux/mfd/syscon.h>
  41. #include <dt-bindings/pinctrl/rockchip.h>
  42. #include "core.h"
  43. #include "pinconf.h"
  44. /* GPIO control registers */
  45. #define GPIO_SWPORT_DR 0x00
  46. #define GPIO_SWPORT_DDR 0x04
  47. #define GPIO_INTEN 0x30
  48. #define GPIO_INTMASK 0x34
  49. #define GPIO_INTTYPE_LEVEL 0x38
  50. #define GPIO_INT_POLARITY 0x3c
  51. #define GPIO_INT_STATUS 0x40
  52. #define GPIO_INT_RAWSTATUS 0x44
  53. #define GPIO_DEBOUNCE 0x48
  54. #define GPIO_PORTS_EOI 0x4c
  55. #define GPIO_EXT_PORT 0x50
  56. #define GPIO_LS_SYNC 0x60
  57. enum rockchip_pinctrl_type {
  58. RK2928,
  59. RK3066B,
  60. RK3188,
  61. RK3288,
  62. RK3368,
  63. };
  64. /**
  65. * Encode variants of iomux registers into a type variable
  66. */
  67. #define IOMUX_GPIO_ONLY BIT(0)
  68. #define IOMUX_WIDTH_4BIT BIT(1)
  69. #define IOMUX_SOURCE_PMU BIT(2)
  70. #define IOMUX_UNROUTED BIT(3)
  71. /**
  72. * @type: iomux variant using IOMUX_* constants
  73. * @offset: if initialized to -1 it will be autocalculated, by specifying
  74. * an initial offset value the relevant source offset can be reset
  75. * to a new value for autocalculating the following iomux registers.
  76. */
  77. struct rockchip_iomux {
  78. int type;
  79. int offset;
  80. };
  81. /**
  82. * @reg_base: register base of the gpio bank
  83. * @reg_pull: optional separate register for additional pull settings
  84. * @clk: clock of the gpio bank
  85. * @irq: interrupt of the gpio bank
  86. * @saved_masks: Saved content of GPIO_INTEN at suspend time.
  87. * @pin_base: first pin number
  88. * @nr_pins: number of pins in this bank
  89. * @name: name of the bank
  90. * @bank_num: number of the bank, to account for holes
  91. * @iomux: array describing the 4 iomux sources of the bank
  92. * @valid: are all necessary informations present
  93. * @of_node: dt node of this bank
  94. * @drvdata: common pinctrl basedata
  95. * @domain: irqdomain of the gpio bank
  96. * @gpio_chip: gpiolib chip
  97. * @grange: gpio range
  98. * @slock: spinlock for the gpio bank
  99. */
  100. struct rockchip_pin_bank {
  101. void __iomem *reg_base;
  102. struct regmap *regmap_pull;
  103. struct clk *clk;
  104. int irq;
  105. u32 saved_masks;
  106. u32 pin_base;
  107. u8 nr_pins;
  108. char *name;
  109. u8 bank_num;
  110. struct rockchip_iomux iomux[4];
  111. bool valid;
  112. struct device_node *of_node;
  113. struct rockchip_pinctrl *drvdata;
  114. struct irq_domain *domain;
  115. struct gpio_chip gpio_chip;
  116. struct pinctrl_gpio_range grange;
  117. spinlock_t slock;
  118. u32 toggle_edge_mode;
  119. };
  120. #define PIN_BANK(id, pins, label) \
  121. { \
  122. .bank_num = id, \
  123. .nr_pins = pins, \
  124. .name = label, \
  125. .iomux = { \
  126. { .offset = -1 }, \
  127. { .offset = -1 }, \
  128. { .offset = -1 }, \
  129. { .offset = -1 }, \
  130. }, \
  131. }
  132. #define PIN_BANK_IOMUX_FLAGS(id, pins, label, iom0, iom1, iom2, iom3) \
  133. { \
  134. .bank_num = id, \
  135. .nr_pins = pins, \
  136. .name = label, \
  137. .iomux = { \
  138. { .type = iom0, .offset = -1 }, \
  139. { .type = iom1, .offset = -1 }, \
  140. { .type = iom2, .offset = -1 }, \
  141. { .type = iom3, .offset = -1 }, \
  142. }, \
  143. }
  144. /**
  145. */
  146. struct rockchip_pin_ctrl {
  147. struct rockchip_pin_bank *pin_banks;
  148. u32 nr_banks;
  149. u32 nr_pins;
  150. char *label;
  151. enum rockchip_pinctrl_type type;
  152. int grf_mux_offset;
  153. int pmu_mux_offset;
  154. void (*pull_calc_reg)(struct rockchip_pin_bank *bank,
  155. int pin_num, struct regmap **regmap,
  156. int *reg, u8 *bit);
  157. void (*drv_calc_reg)(struct rockchip_pin_bank *bank,
  158. int pin_num, struct regmap **regmap,
  159. int *reg, u8 *bit);
  160. };
  161. struct rockchip_pin_config {
  162. unsigned int func;
  163. unsigned long *configs;
  164. unsigned int nconfigs;
  165. };
  166. /**
  167. * struct rockchip_pin_group: represent group of pins of a pinmux function.
  168. * @name: name of the pin group, used to lookup the group.
  169. * @pins: the pins included in this group.
  170. * @npins: number of pins included in this group.
  171. * @func: the mux function number to be programmed when selected.
  172. * @configs: the config values to be set for each pin
  173. * @nconfigs: number of configs for each pin
  174. */
  175. struct rockchip_pin_group {
  176. const char *name;
  177. unsigned int npins;
  178. unsigned int *pins;
  179. struct rockchip_pin_config *data;
  180. };
  181. /**
  182. * struct rockchip_pmx_func: represent a pin function.
  183. * @name: name of the pin function, used to lookup the function.
  184. * @groups: one or more names of pin groups that provide this function.
  185. * @num_groups: number of groups included in @groups.
  186. */
  187. struct rockchip_pmx_func {
  188. const char *name;
  189. const char **groups;
  190. u8 ngroups;
  191. };
  192. struct rockchip_pinctrl {
  193. struct regmap *regmap_base;
  194. int reg_size;
  195. struct regmap *regmap_pull;
  196. struct regmap *regmap_pmu;
  197. struct device *dev;
  198. struct rockchip_pin_ctrl *ctrl;
  199. struct pinctrl_desc pctl;
  200. struct pinctrl_dev *pctl_dev;
  201. struct rockchip_pin_group *groups;
  202. unsigned int ngroups;
  203. struct rockchip_pmx_func *functions;
  204. unsigned int nfunctions;
  205. };
  206. static struct regmap_config rockchip_regmap_config = {
  207. .reg_bits = 32,
  208. .val_bits = 32,
  209. .reg_stride = 4,
  210. };
  211. static inline struct rockchip_pin_bank *gc_to_pin_bank(struct gpio_chip *gc)
  212. {
  213. return container_of(gc, struct rockchip_pin_bank, gpio_chip);
  214. }
  215. static const inline struct rockchip_pin_group *pinctrl_name_to_group(
  216. const struct rockchip_pinctrl *info,
  217. const char *name)
  218. {
  219. int i;
  220. for (i = 0; i < info->ngroups; i++) {
  221. if (!strcmp(info->groups[i].name, name))
  222. return &info->groups[i];
  223. }
  224. return NULL;
  225. }
  226. /*
  227. * given a pin number that is local to a pin controller, find out the pin bank
  228. * and the register base of the pin bank.
  229. */
  230. static struct rockchip_pin_bank *pin_to_bank(struct rockchip_pinctrl *info,
  231. unsigned pin)
  232. {
  233. struct rockchip_pin_bank *b = info->ctrl->pin_banks;
  234. while (pin >= (b->pin_base + b->nr_pins))
  235. b++;
  236. return b;
  237. }
  238. static struct rockchip_pin_bank *bank_num_to_bank(
  239. struct rockchip_pinctrl *info,
  240. unsigned num)
  241. {
  242. struct rockchip_pin_bank *b = info->ctrl->pin_banks;
  243. int i;
  244. for (i = 0; i < info->ctrl->nr_banks; i++, b++) {
  245. if (b->bank_num == num)
  246. return b;
  247. }
  248. return ERR_PTR(-EINVAL);
  249. }
  250. /*
  251. * Pinctrl_ops handling
  252. */
  253. static int rockchip_get_groups_count(struct pinctrl_dev *pctldev)
  254. {
  255. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  256. return info->ngroups;
  257. }
  258. static const char *rockchip_get_group_name(struct pinctrl_dev *pctldev,
  259. unsigned selector)
  260. {
  261. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  262. return info->groups[selector].name;
  263. }
  264. static int rockchip_get_group_pins(struct pinctrl_dev *pctldev,
  265. unsigned selector, const unsigned **pins,
  266. unsigned *npins)
  267. {
  268. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  269. if (selector >= info->ngroups)
  270. return -EINVAL;
  271. *pins = info->groups[selector].pins;
  272. *npins = info->groups[selector].npins;
  273. return 0;
  274. }
  275. static int rockchip_dt_node_to_map(struct pinctrl_dev *pctldev,
  276. struct device_node *np,
  277. struct pinctrl_map **map, unsigned *num_maps)
  278. {
  279. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  280. const struct rockchip_pin_group *grp;
  281. struct pinctrl_map *new_map;
  282. struct device_node *parent;
  283. int map_num = 1;
  284. int i;
  285. /*
  286. * first find the group of this node and check if we need to create
  287. * config maps for pins
  288. */
  289. grp = pinctrl_name_to_group(info, np->name);
  290. if (!grp) {
  291. dev_err(info->dev, "unable to find group for node %s\n",
  292. np->name);
  293. return -EINVAL;
  294. }
  295. map_num += grp->npins;
  296. new_map = devm_kzalloc(pctldev->dev, sizeof(*new_map) * map_num,
  297. GFP_KERNEL);
  298. if (!new_map)
  299. return -ENOMEM;
  300. *map = new_map;
  301. *num_maps = map_num;
  302. /* create mux map */
  303. parent = of_get_parent(np);
  304. if (!parent) {
  305. devm_kfree(pctldev->dev, new_map);
  306. return -EINVAL;
  307. }
  308. new_map[0].type = PIN_MAP_TYPE_MUX_GROUP;
  309. new_map[0].data.mux.function = parent->name;
  310. new_map[0].data.mux.group = np->name;
  311. of_node_put(parent);
  312. /* create config map */
  313. new_map++;
  314. for (i = 0; i < grp->npins; i++) {
  315. new_map[i].type = PIN_MAP_TYPE_CONFIGS_PIN;
  316. new_map[i].data.configs.group_or_pin =
  317. pin_get_name(pctldev, grp->pins[i]);
  318. new_map[i].data.configs.configs = grp->data[i].configs;
  319. new_map[i].data.configs.num_configs = grp->data[i].nconfigs;
  320. }
  321. dev_dbg(pctldev->dev, "maps: function %s group %s num %d\n",
  322. (*map)->data.mux.function, (*map)->data.mux.group, map_num);
  323. return 0;
  324. }
  325. static void rockchip_dt_free_map(struct pinctrl_dev *pctldev,
  326. struct pinctrl_map *map, unsigned num_maps)
  327. {
  328. }
  329. static const struct pinctrl_ops rockchip_pctrl_ops = {
  330. .get_groups_count = rockchip_get_groups_count,
  331. .get_group_name = rockchip_get_group_name,
  332. .get_group_pins = rockchip_get_group_pins,
  333. .dt_node_to_map = rockchip_dt_node_to_map,
  334. .dt_free_map = rockchip_dt_free_map,
  335. };
  336. /*
  337. * Hardware access
  338. */
  339. static int rockchip_get_mux(struct rockchip_pin_bank *bank, int pin)
  340. {
  341. struct rockchip_pinctrl *info = bank->drvdata;
  342. int iomux_num = (pin / 8);
  343. struct regmap *regmap;
  344. unsigned int val;
  345. int reg, ret, mask;
  346. u8 bit;
  347. if (iomux_num > 3)
  348. return -EINVAL;
  349. if (bank->iomux[iomux_num].type & IOMUX_UNROUTED) {
  350. dev_err(info->dev, "pin %d is unrouted\n", pin);
  351. return -EINVAL;
  352. }
  353. if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY)
  354. return RK_FUNC_GPIO;
  355. regmap = (bank->iomux[iomux_num].type & IOMUX_SOURCE_PMU)
  356. ? info->regmap_pmu : info->regmap_base;
  357. /* get basic quadrupel of mux registers and the correct reg inside */
  358. mask = (bank->iomux[iomux_num].type & IOMUX_WIDTH_4BIT) ? 0xf : 0x3;
  359. reg = bank->iomux[iomux_num].offset;
  360. if (bank->iomux[iomux_num].type & IOMUX_WIDTH_4BIT) {
  361. if ((pin % 8) >= 4)
  362. reg += 0x4;
  363. bit = (pin % 4) * 4;
  364. } else {
  365. bit = (pin % 8) * 2;
  366. }
  367. ret = regmap_read(regmap, reg, &val);
  368. if (ret)
  369. return ret;
  370. return ((val >> bit) & mask);
  371. }
  372. /*
  373. * Set a new mux function for a pin.
  374. *
  375. * The register is divided into the upper and lower 16 bit. When changing
  376. * a value, the previous register value is not read and changed. Instead
  377. * it seems the changed bits are marked in the upper 16 bit, while the
  378. * changed value gets set in the same offset in the lower 16 bit.
  379. * All pin settings seem to be 2 bit wide in both the upper and lower
  380. * parts.
  381. * @bank: pin bank to change
  382. * @pin: pin to change
  383. * @mux: new mux function to set
  384. */
  385. static int rockchip_set_mux(struct rockchip_pin_bank *bank, int pin, int mux)
  386. {
  387. struct rockchip_pinctrl *info = bank->drvdata;
  388. int iomux_num = (pin / 8);
  389. struct regmap *regmap;
  390. int reg, ret, mask;
  391. unsigned long flags;
  392. u8 bit;
  393. u32 data, rmask;
  394. if (iomux_num > 3)
  395. return -EINVAL;
  396. if (bank->iomux[iomux_num].type & IOMUX_UNROUTED) {
  397. dev_err(info->dev, "pin %d is unrouted\n", pin);
  398. return -EINVAL;
  399. }
  400. if (bank->iomux[iomux_num].type & IOMUX_GPIO_ONLY) {
  401. if (mux != RK_FUNC_GPIO) {
  402. dev_err(info->dev,
  403. "pin %d only supports a gpio mux\n", pin);
  404. return -ENOTSUPP;
  405. } else {
  406. return 0;
  407. }
  408. }
  409. dev_dbg(info->dev, "setting mux of GPIO%d-%d to %d\n",
  410. bank->bank_num, pin, mux);
  411. regmap = (bank->iomux[iomux_num].type & IOMUX_SOURCE_PMU)
  412. ? info->regmap_pmu : info->regmap_base;
  413. /* get basic quadrupel of mux registers and the correct reg inside */
  414. mask = (bank->iomux[iomux_num].type & IOMUX_WIDTH_4BIT) ? 0xf : 0x3;
  415. reg = bank->iomux[iomux_num].offset;
  416. if (bank->iomux[iomux_num].type & IOMUX_WIDTH_4BIT) {
  417. if ((pin % 8) >= 4)
  418. reg += 0x4;
  419. bit = (pin % 4) * 4;
  420. } else {
  421. bit = (pin % 8) * 2;
  422. }
  423. spin_lock_irqsave(&bank->slock, flags);
  424. data = (mask << (bit + 16));
  425. rmask = data | (data >> 16);
  426. data |= (mux & mask) << bit;
  427. ret = regmap_update_bits(regmap, reg, rmask, data);
  428. spin_unlock_irqrestore(&bank->slock, flags);
  429. return ret;
  430. }
  431. #define RK2928_PULL_OFFSET 0x118
  432. #define RK2928_PULL_PINS_PER_REG 16
  433. #define RK2928_PULL_BANK_STRIDE 8
  434. static void rk2928_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
  435. int pin_num, struct regmap **regmap,
  436. int *reg, u8 *bit)
  437. {
  438. struct rockchip_pinctrl *info = bank->drvdata;
  439. *regmap = info->regmap_base;
  440. *reg = RK2928_PULL_OFFSET;
  441. *reg += bank->bank_num * RK2928_PULL_BANK_STRIDE;
  442. *reg += (pin_num / RK2928_PULL_PINS_PER_REG) * 4;
  443. *bit = pin_num % RK2928_PULL_PINS_PER_REG;
  444. };
  445. #define RK3188_PULL_OFFSET 0x164
  446. #define RK3188_PULL_BITS_PER_PIN 2
  447. #define RK3188_PULL_PINS_PER_REG 8
  448. #define RK3188_PULL_BANK_STRIDE 16
  449. #define RK3188_PULL_PMU_OFFSET 0x64
  450. static void rk3188_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
  451. int pin_num, struct regmap **regmap,
  452. int *reg, u8 *bit)
  453. {
  454. struct rockchip_pinctrl *info = bank->drvdata;
  455. /* The first 12 pins of the first bank are located elsewhere */
  456. if (bank->bank_num == 0 && pin_num < 12) {
  457. *regmap = info->regmap_pmu ? info->regmap_pmu
  458. : bank->regmap_pull;
  459. *reg = info->regmap_pmu ? RK3188_PULL_PMU_OFFSET : 0;
  460. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  461. *bit = pin_num % RK3188_PULL_PINS_PER_REG;
  462. *bit *= RK3188_PULL_BITS_PER_PIN;
  463. } else {
  464. *regmap = info->regmap_pull ? info->regmap_pull
  465. : info->regmap_base;
  466. *reg = info->regmap_pull ? 0 : RK3188_PULL_OFFSET;
  467. /* correct the offset, as it is the 2nd pull register */
  468. *reg -= 4;
  469. *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE;
  470. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  471. /*
  472. * The bits in these registers have an inverse ordering
  473. * with the lowest pin being in bits 15:14 and the highest
  474. * pin in bits 1:0
  475. */
  476. *bit = 7 - (pin_num % RK3188_PULL_PINS_PER_REG);
  477. *bit *= RK3188_PULL_BITS_PER_PIN;
  478. }
  479. }
  480. #define RK3288_PULL_OFFSET 0x140
  481. static void rk3288_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
  482. int pin_num, struct regmap **regmap,
  483. int *reg, u8 *bit)
  484. {
  485. struct rockchip_pinctrl *info = bank->drvdata;
  486. /* The first 24 pins of the first bank are located in PMU */
  487. if (bank->bank_num == 0) {
  488. *regmap = info->regmap_pmu;
  489. *reg = RK3188_PULL_PMU_OFFSET;
  490. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  491. *bit = pin_num % RK3188_PULL_PINS_PER_REG;
  492. *bit *= RK3188_PULL_BITS_PER_PIN;
  493. } else {
  494. *regmap = info->regmap_base;
  495. *reg = RK3288_PULL_OFFSET;
  496. /* correct the offset, as we're starting with the 2nd bank */
  497. *reg -= 0x10;
  498. *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE;
  499. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  500. *bit = (pin_num % RK3188_PULL_PINS_PER_REG);
  501. *bit *= RK3188_PULL_BITS_PER_PIN;
  502. }
  503. }
  504. #define RK3288_DRV_PMU_OFFSET 0x70
  505. #define RK3288_DRV_GRF_OFFSET 0x1c0
  506. #define RK3288_DRV_BITS_PER_PIN 2
  507. #define RK3288_DRV_PINS_PER_REG 8
  508. #define RK3288_DRV_BANK_STRIDE 16
  509. static void rk3288_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank,
  510. int pin_num, struct regmap **regmap,
  511. int *reg, u8 *bit)
  512. {
  513. struct rockchip_pinctrl *info = bank->drvdata;
  514. /* The first 24 pins of the first bank are located in PMU */
  515. if (bank->bank_num == 0) {
  516. *regmap = info->regmap_pmu;
  517. *reg = RK3288_DRV_PMU_OFFSET;
  518. *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4);
  519. *bit = pin_num % RK3288_DRV_PINS_PER_REG;
  520. *bit *= RK3288_DRV_BITS_PER_PIN;
  521. } else {
  522. *regmap = info->regmap_base;
  523. *reg = RK3288_DRV_GRF_OFFSET;
  524. /* correct the offset, as we're starting with the 2nd bank */
  525. *reg -= 0x10;
  526. *reg += bank->bank_num * RK3288_DRV_BANK_STRIDE;
  527. *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4);
  528. *bit = (pin_num % RK3288_DRV_PINS_PER_REG);
  529. *bit *= RK3288_DRV_BITS_PER_PIN;
  530. }
  531. }
  532. #define RK3368_PULL_GRF_OFFSET 0x100
  533. #define RK3368_PULL_PMU_OFFSET 0x10
  534. static void rk3368_calc_pull_reg_and_bit(struct rockchip_pin_bank *bank,
  535. int pin_num, struct regmap **regmap,
  536. int *reg, u8 *bit)
  537. {
  538. struct rockchip_pinctrl *info = bank->drvdata;
  539. /* The first 32 pins of the first bank are located in PMU */
  540. if (bank->bank_num == 0) {
  541. *regmap = info->regmap_pmu;
  542. *reg = RK3368_PULL_PMU_OFFSET;
  543. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  544. *bit = pin_num % RK3188_PULL_PINS_PER_REG;
  545. *bit *= RK3188_PULL_BITS_PER_PIN;
  546. } else {
  547. *regmap = info->regmap_base;
  548. *reg = RK3368_PULL_GRF_OFFSET;
  549. /* correct the offset, as we're starting with the 2nd bank */
  550. *reg -= 0x10;
  551. *reg += bank->bank_num * RK3188_PULL_BANK_STRIDE;
  552. *reg += ((pin_num / RK3188_PULL_PINS_PER_REG) * 4);
  553. *bit = (pin_num % RK3188_PULL_PINS_PER_REG);
  554. *bit *= RK3188_PULL_BITS_PER_PIN;
  555. }
  556. }
  557. #define RK3368_DRV_PMU_OFFSET 0x20
  558. #define RK3368_DRV_GRF_OFFSET 0x200
  559. static void rk3368_calc_drv_reg_and_bit(struct rockchip_pin_bank *bank,
  560. int pin_num, struct regmap **regmap,
  561. int *reg, u8 *bit)
  562. {
  563. struct rockchip_pinctrl *info = bank->drvdata;
  564. /* The first 32 pins of the first bank are located in PMU */
  565. if (bank->bank_num == 0) {
  566. *regmap = info->regmap_pmu;
  567. *reg = RK3368_DRV_PMU_OFFSET;
  568. *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4);
  569. *bit = pin_num % RK3288_DRV_PINS_PER_REG;
  570. *bit *= RK3288_DRV_BITS_PER_PIN;
  571. } else {
  572. *regmap = info->regmap_base;
  573. *reg = RK3368_DRV_GRF_OFFSET;
  574. /* correct the offset, as we're starting with the 2nd bank */
  575. *reg -= 0x10;
  576. *reg += bank->bank_num * RK3288_DRV_BANK_STRIDE;
  577. *reg += ((pin_num / RK3288_DRV_PINS_PER_REG) * 4);
  578. *bit = (pin_num % RK3288_DRV_PINS_PER_REG);
  579. *bit *= RK3288_DRV_BITS_PER_PIN;
  580. }
  581. }
  582. static int rockchip_perpin_drv_list[] = { 2, 4, 8, 12 };
  583. static int rockchip_get_drive_perpin(struct rockchip_pin_bank *bank,
  584. int pin_num)
  585. {
  586. struct rockchip_pinctrl *info = bank->drvdata;
  587. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  588. struct regmap *regmap;
  589. int reg, ret;
  590. u32 data;
  591. u8 bit;
  592. ctrl->drv_calc_reg(bank, pin_num, &regmap, &reg, &bit);
  593. ret = regmap_read(regmap, reg, &data);
  594. if (ret)
  595. return ret;
  596. data >>= bit;
  597. data &= (1 << RK3288_DRV_BITS_PER_PIN) - 1;
  598. return rockchip_perpin_drv_list[data];
  599. }
  600. static int rockchip_set_drive_perpin(struct rockchip_pin_bank *bank,
  601. int pin_num, int strength)
  602. {
  603. struct rockchip_pinctrl *info = bank->drvdata;
  604. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  605. struct regmap *regmap;
  606. unsigned long flags;
  607. int reg, ret, i;
  608. u32 data, rmask;
  609. u8 bit;
  610. ctrl->drv_calc_reg(bank, pin_num, &regmap, &reg, &bit);
  611. ret = -EINVAL;
  612. for (i = 0; i < ARRAY_SIZE(rockchip_perpin_drv_list); i++) {
  613. if (rockchip_perpin_drv_list[i] == strength) {
  614. ret = i;
  615. break;
  616. }
  617. }
  618. if (ret < 0) {
  619. dev_err(info->dev, "unsupported driver strength %d\n",
  620. strength);
  621. return ret;
  622. }
  623. spin_lock_irqsave(&bank->slock, flags);
  624. /* enable the write to the equivalent lower bits */
  625. data = ((1 << RK3288_DRV_BITS_PER_PIN) - 1) << (bit + 16);
  626. rmask = data | (data >> 16);
  627. data |= (ret << bit);
  628. ret = regmap_update_bits(regmap, reg, rmask, data);
  629. spin_unlock_irqrestore(&bank->slock, flags);
  630. return ret;
  631. }
  632. static int rockchip_get_pull(struct rockchip_pin_bank *bank, int pin_num)
  633. {
  634. struct rockchip_pinctrl *info = bank->drvdata;
  635. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  636. struct regmap *regmap;
  637. int reg, ret;
  638. u8 bit;
  639. u32 data;
  640. /* rk3066b does support any pulls */
  641. if (ctrl->type == RK3066B)
  642. return PIN_CONFIG_BIAS_DISABLE;
  643. ctrl->pull_calc_reg(bank, pin_num, &regmap, &reg, &bit);
  644. ret = regmap_read(regmap, reg, &data);
  645. if (ret)
  646. return ret;
  647. switch (ctrl->type) {
  648. case RK2928:
  649. return !(data & BIT(bit))
  650. ? PIN_CONFIG_BIAS_PULL_PIN_DEFAULT
  651. : PIN_CONFIG_BIAS_DISABLE;
  652. case RK3188:
  653. case RK3288:
  654. case RK3368:
  655. data >>= bit;
  656. data &= (1 << RK3188_PULL_BITS_PER_PIN) - 1;
  657. switch (data) {
  658. case 0:
  659. return PIN_CONFIG_BIAS_DISABLE;
  660. case 1:
  661. return PIN_CONFIG_BIAS_PULL_UP;
  662. case 2:
  663. return PIN_CONFIG_BIAS_PULL_DOWN;
  664. case 3:
  665. return PIN_CONFIG_BIAS_BUS_HOLD;
  666. }
  667. dev_err(info->dev, "unknown pull setting\n");
  668. return -EIO;
  669. default:
  670. dev_err(info->dev, "unsupported pinctrl type\n");
  671. return -EINVAL;
  672. };
  673. }
  674. static int rockchip_set_pull(struct rockchip_pin_bank *bank,
  675. int pin_num, int pull)
  676. {
  677. struct rockchip_pinctrl *info = bank->drvdata;
  678. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  679. struct regmap *regmap;
  680. int reg, ret;
  681. unsigned long flags;
  682. u8 bit;
  683. u32 data, rmask;
  684. dev_dbg(info->dev, "setting pull of GPIO%d-%d to %d\n",
  685. bank->bank_num, pin_num, pull);
  686. /* rk3066b does support any pulls */
  687. if (ctrl->type == RK3066B)
  688. return pull ? -EINVAL : 0;
  689. ctrl->pull_calc_reg(bank, pin_num, &regmap, &reg, &bit);
  690. switch (ctrl->type) {
  691. case RK2928:
  692. spin_lock_irqsave(&bank->slock, flags);
  693. data = BIT(bit + 16);
  694. if (pull == PIN_CONFIG_BIAS_DISABLE)
  695. data |= BIT(bit);
  696. ret = regmap_write(regmap, reg, data);
  697. spin_unlock_irqrestore(&bank->slock, flags);
  698. break;
  699. case RK3188:
  700. case RK3288:
  701. case RK3368:
  702. spin_lock_irqsave(&bank->slock, flags);
  703. /* enable the write to the equivalent lower bits */
  704. data = ((1 << RK3188_PULL_BITS_PER_PIN) - 1) << (bit + 16);
  705. rmask = data | (data >> 16);
  706. switch (pull) {
  707. case PIN_CONFIG_BIAS_DISABLE:
  708. break;
  709. case PIN_CONFIG_BIAS_PULL_UP:
  710. data |= (1 << bit);
  711. break;
  712. case PIN_CONFIG_BIAS_PULL_DOWN:
  713. data |= (2 << bit);
  714. break;
  715. case PIN_CONFIG_BIAS_BUS_HOLD:
  716. data |= (3 << bit);
  717. break;
  718. default:
  719. spin_unlock_irqrestore(&bank->slock, flags);
  720. dev_err(info->dev, "unsupported pull setting %d\n",
  721. pull);
  722. return -EINVAL;
  723. }
  724. ret = regmap_update_bits(regmap, reg, rmask, data);
  725. spin_unlock_irqrestore(&bank->slock, flags);
  726. break;
  727. default:
  728. dev_err(info->dev, "unsupported pinctrl type\n");
  729. return -EINVAL;
  730. }
  731. return ret;
  732. }
  733. /*
  734. * Pinmux_ops handling
  735. */
  736. static int rockchip_pmx_get_funcs_count(struct pinctrl_dev *pctldev)
  737. {
  738. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  739. return info->nfunctions;
  740. }
  741. static const char *rockchip_pmx_get_func_name(struct pinctrl_dev *pctldev,
  742. unsigned selector)
  743. {
  744. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  745. return info->functions[selector].name;
  746. }
  747. static int rockchip_pmx_get_groups(struct pinctrl_dev *pctldev,
  748. unsigned selector, const char * const **groups,
  749. unsigned * const num_groups)
  750. {
  751. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  752. *groups = info->functions[selector].groups;
  753. *num_groups = info->functions[selector].ngroups;
  754. return 0;
  755. }
  756. static int rockchip_pmx_set(struct pinctrl_dev *pctldev, unsigned selector,
  757. unsigned group)
  758. {
  759. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  760. const unsigned int *pins = info->groups[group].pins;
  761. const struct rockchip_pin_config *data = info->groups[group].data;
  762. struct rockchip_pin_bank *bank;
  763. int cnt, ret = 0;
  764. dev_dbg(info->dev, "enable function %s group %s\n",
  765. info->functions[selector].name, info->groups[group].name);
  766. /*
  767. * for each pin in the pin group selected, program the correspoding pin
  768. * pin function number in the config register.
  769. */
  770. for (cnt = 0; cnt < info->groups[group].npins; cnt++) {
  771. bank = pin_to_bank(info, pins[cnt]);
  772. ret = rockchip_set_mux(bank, pins[cnt] - bank->pin_base,
  773. data[cnt].func);
  774. if (ret)
  775. break;
  776. }
  777. if (ret) {
  778. /* revert the already done pin settings */
  779. for (cnt--; cnt >= 0; cnt--)
  780. rockchip_set_mux(bank, pins[cnt] - bank->pin_base, 0);
  781. return ret;
  782. }
  783. return 0;
  784. }
  785. /*
  786. * The calls to gpio_direction_output() and gpio_direction_input()
  787. * leads to this function call (via the pinctrl_gpio_direction_{input|output}()
  788. * function called from the gpiolib interface).
  789. */
  790. static int _rockchip_pmx_gpio_set_direction(struct gpio_chip *chip,
  791. int pin, bool input)
  792. {
  793. struct rockchip_pin_bank *bank;
  794. int ret;
  795. unsigned long flags;
  796. u32 data;
  797. bank = gc_to_pin_bank(chip);
  798. ret = rockchip_set_mux(bank, pin, RK_FUNC_GPIO);
  799. if (ret < 0)
  800. return ret;
  801. spin_lock_irqsave(&bank->slock, flags);
  802. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  803. /* set bit to 1 for output, 0 for input */
  804. if (!input)
  805. data |= BIT(pin);
  806. else
  807. data &= ~BIT(pin);
  808. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  809. spin_unlock_irqrestore(&bank->slock, flags);
  810. return 0;
  811. }
  812. static int rockchip_pmx_gpio_set_direction(struct pinctrl_dev *pctldev,
  813. struct pinctrl_gpio_range *range,
  814. unsigned offset, bool input)
  815. {
  816. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  817. struct gpio_chip *chip;
  818. int pin;
  819. chip = range->gc;
  820. pin = offset - chip->base;
  821. dev_dbg(info->dev, "gpio_direction for pin %u as %s-%d to %s\n",
  822. offset, range->name, pin, input ? "input" : "output");
  823. return _rockchip_pmx_gpio_set_direction(chip, offset - chip->base,
  824. input);
  825. }
  826. static const struct pinmux_ops rockchip_pmx_ops = {
  827. .get_functions_count = rockchip_pmx_get_funcs_count,
  828. .get_function_name = rockchip_pmx_get_func_name,
  829. .get_function_groups = rockchip_pmx_get_groups,
  830. .set_mux = rockchip_pmx_set,
  831. .gpio_set_direction = rockchip_pmx_gpio_set_direction,
  832. };
  833. /*
  834. * Pinconf_ops handling
  835. */
  836. static bool rockchip_pinconf_pull_valid(struct rockchip_pin_ctrl *ctrl,
  837. enum pin_config_param pull)
  838. {
  839. switch (ctrl->type) {
  840. case RK2928:
  841. return (pull == PIN_CONFIG_BIAS_PULL_PIN_DEFAULT ||
  842. pull == PIN_CONFIG_BIAS_DISABLE);
  843. case RK3066B:
  844. return pull ? false : true;
  845. case RK3188:
  846. case RK3288:
  847. case RK3368:
  848. return (pull != PIN_CONFIG_BIAS_PULL_PIN_DEFAULT);
  849. }
  850. return false;
  851. }
  852. static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value);
  853. static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset);
  854. /* set the pin config settings for a specified pin */
  855. static int rockchip_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
  856. unsigned long *configs, unsigned num_configs)
  857. {
  858. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  859. struct rockchip_pin_bank *bank = pin_to_bank(info, pin);
  860. enum pin_config_param param;
  861. u16 arg;
  862. int i;
  863. int rc;
  864. for (i = 0; i < num_configs; i++) {
  865. param = pinconf_to_config_param(configs[i]);
  866. arg = pinconf_to_config_argument(configs[i]);
  867. switch (param) {
  868. case PIN_CONFIG_BIAS_DISABLE:
  869. rc = rockchip_set_pull(bank, pin - bank->pin_base,
  870. param);
  871. if (rc)
  872. return rc;
  873. break;
  874. case PIN_CONFIG_BIAS_PULL_UP:
  875. case PIN_CONFIG_BIAS_PULL_DOWN:
  876. case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
  877. case PIN_CONFIG_BIAS_BUS_HOLD:
  878. if (!rockchip_pinconf_pull_valid(info->ctrl, param))
  879. return -ENOTSUPP;
  880. if (!arg)
  881. return -EINVAL;
  882. rc = rockchip_set_pull(bank, pin - bank->pin_base,
  883. param);
  884. if (rc)
  885. return rc;
  886. break;
  887. case PIN_CONFIG_OUTPUT:
  888. rockchip_gpio_set(&bank->gpio_chip,
  889. pin - bank->pin_base, arg);
  890. rc = _rockchip_pmx_gpio_set_direction(&bank->gpio_chip,
  891. pin - bank->pin_base, false);
  892. if (rc)
  893. return rc;
  894. break;
  895. case PIN_CONFIG_DRIVE_STRENGTH:
  896. /* rk3288 is the first with per-pin drive-strength */
  897. if (!info->ctrl->drv_calc_reg)
  898. return -ENOTSUPP;
  899. rc = rockchip_set_drive_perpin(bank,
  900. pin - bank->pin_base, arg);
  901. if (rc < 0)
  902. return rc;
  903. break;
  904. default:
  905. return -ENOTSUPP;
  906. break;
  907. }
  908. } /* for each config */
  909. return 0;
  910. }
  911. /* get the pin config settings for a specified pin */
  912. static int rockchip_pinconf_get(struct pinctrl_dev *pctldev, unsigned int pin,
  913. unsigned long *config)
  914. {
  915. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  916. struct rockchip_pin_bank *bank = pin_to_bank(info, pin);
  917. enum pin_config_param param = pinconf_to_config_param(*config);
  918. u16 arg;
  919. int rc;
  920. switch (param) {
  921. case PIN_CONFIG_BIAS_DISABLE:
  922. if (rockchip_get_pull(bank, pin - bank->pin_base) != param)
  923. return -EINVAL;
  924. arg = 0;
  925. break;
  926. case PIN_CONFIG_BIAS_PULL_UP:
  927. case PIN_CONFIG_BIAS_PULL_DOWN:
  928. case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
  929. case PIN_CONFIG_BIAS_BUS_HOLD:
  930. if (!rockchip_pinconf_pull_valid(info->ctrl, param))
  931. return -ENOTSUPP;
  932. if (rockchip_get_pull(bank, pin - bank->pin_base) != param)
  933. return -EINVAL;
  934. arg = 1;
  935. break;
  936. case PIN_CONFIG_OUTPUT:
  937. rc = rockchip_get_mux(bank, pin - bank->pin_base);
  938. if (rc != RK_FUNC_GPIO)
  939. return -EINVAL;
  940. rc = rockchip_gpio_get(&bank->gpio_chip, pin - bank->pin_base);
  941. if (rc < 0)
  942. return rc;
  943. arg = rc ? 1 : 0;
  944. break;
  945. case PIN_CONFIG_DRIVE_STRENGTH:
  946. /* rk3288 is the first with per-pin drive-strength */
  947. if (!info->ctrl->drv_calc_reg)
  948. return -ENOTSUPP;
  949. rc = rockchip_get_drive_perpin(bank, pin - bank->pin_base);
  950. if (rc < 0)
  951. return rc;
  952. arg = rc;
  953. break;
  954. default:
  955. return -ENOTSUPP;
  956. break;
  957. }
  958. *config = pinconf_to_config_packed(param, arg);
  959. return 0;
  960. }
  961. static const struct pinconf_ops rockchip_pinconf_ops = {
  962. .pin_config_get = rockchip_pinconf_get,
  963. .pin_config_set = rockchip_pinconf_set,
  964. .is_generic = true,
  965. };
  966. static const struct of_device_id rockchip_bank_match[] = {
  967. { .compatible = "rockchip,gpio-bank" },
  968. { .compatible = "rockchip,rk3188-gpio-bank0" },
  969. {},
  970. };
  971. static void rockchip_pinctrl_child_count(struct rockchip_pinctrl *info,
  972. struct device_node *np)
  973. {
  974. struct device_node *child;
  975. for_each_child_of_node(np, child) {
  976. if (of_match_node(rockchip_bank_match, child))
  977. continue;
  978. info->nfunctions++;
  979. info->ngroups += of_get_child_count(child);
  980. }
  981. }
  982. static int rockchip_pinctrl_parse_groups(struct device_node *np,
  983. struct rockchip_pin_group *grp,
  984. struct rockchip_pinctrl *info,
  985. u32 index)
  986. {
  987. struct rockchip_pin_bank *bank;
  988. int size;
  989. const __be32 *list;
  990. int num;
  991. int i, j;
  992. int ret;
  993. dev_dbg(info->dev, "group(%d): %s\n", index, np->name);
  994. /* Initialise group */
  995. grp->name = np->name;
  996. /*
  997. * the binding format is rockchip,pins = <bank pin mux CONFIG>,
  998. * do sanity check and calculate pins number
  999. */
  1000. list = of_get_property(np, "rockchip,pins", &size);
  1001. /* we do not check return since it's safe node passed down */
  1002. size /= sizeof(*list);
  1003. if (!size || size % 4) {
  1004. dev_err(info->dev, "wrong pins number or pins and configs should be by 4\n");
  1005. return -EINVAL;
  1006. }
  1007. grp->npins = size / 4;
  1008. grp->pins = devm_kzalloc(info->dev, grp->npins * sizeof(unsigned int),
  1009. GFP_KERNEL);
  1010. grp->data = devm_kzalloc(info->dev, grp->npins *
  1011. sizeof(struct rockchip_pin_config),
  1012. GFP_KERNEL);
  1013. if (!grp->pins || !grp->data)
  1014. return -ENOMEM;
  1015. for (i = 0, j = 0; i < size; i += 4, j++) {
  1016. const __be32 *phandle;
  1017. struct device_node *np_config;
  1018. num = be32_to_cpu(*list++);
  1019. bank = bank_num_to_bank(info, num);
  1020. if (IS_ERR(bank))
  1021. return PTR_ERR(bank);
  1022. grp->pins[j] = bank->pin_base + be32_to_cpu(*list++);
  1023. grp->data[j].func = be32_to_cpu(*list++);
  1024. phandle = list++;
  1025. if (!phandle)
  1026. return -EINVAL;
  1027. np_config = of_find_node_by_phandle(be32_to_cpup(phandle));
  1028. ret = pinconf_generic_parse_dt_config(np_config, NULL,
  1029. &grp->data[j].configs, &grp->data[j].nconfigs);
  1030. if (ret)
  1031. return ret;
  1032. }
  1033. return 0;
  1034. }
  1035. static int rockchip_pinctrl_parse_functions(struct device_node *np,
  1036. struct rockchip_pinctrl *info,
  1037. u32 index)
  1038. {
  1039. struct device_node *child;
  1040. struct rockchip_pmx_func *func;
  1041. struct rockchip_pin_group *grp;
  1042. int ret;
  1043. static u32 grp_index;
  1044. u32 i = 0;
  1045. dev_dbg(info->dev, "parse function(%d): %s\n", index, np->name);
  1046. func = &info->functions[index];
  1047. /* Initialise function */
  1048. func->name = np->name;
  1049. func->ngroups = of_get_child_count(np);
  1050. if (func->ngroups <= 0)
  1051. return 0;
  1052. func->groups = devm_kzalloc(info->dev,
  1053. func->ngroups * sizeof(char *), GFP_KERNEL);
  1054. if (!func->groups)
  1055. return -ENOMEM;
  1056. for_each_child_of_node(np, child) {
  1057. func->groups[i] = child->name;
  1058. grp = &info->groups[grp_index++];
  1059. ret = rockchip_pinctrl_parse_groups(child, grp, info, i++);
  1060. if (ret)
  1061. return ret;
  1062. }
  1063. return 0;
  1064. }
  1065. static int rockchip_pinctrl_parse_dt(struct platform_device *pdev,
  1066. struct rockchip_pinctrl *info)
  1067. {
  1068. struct device *dev = &pdev->dev;
  1069. struct device_node *np = dev->of_node;
  1070. struct device_node *child;
  1071. int ret;
  1072. int i;
  1073. rockchip_pinctrl_child_count(info, np);
  1074. dev_dbg(&pdev->dev, "nfunctions = %d\n", info->nfunctions);
  1075. dev_dbg(&pdev->dev, "ngroups = %d\n", info->ngroups);
  1076. info->functions = devm_kzalloc(dev, info->nfunctions *
  1077. sizeof(struct rockchip_pmx_func),
  1078. GFP_KERNEL);
  1079. if (!info->functions) {
  1080. dev_err(dev, "failed to allocate memory for function list\n");
  1081. return -EINVAL;
  1082. }
  1083. info->groups = devm_kzalloc(dev, info->ngroups *
  1084. sizeof(struct rockchip_pin_group),
  1085. GFP_KERNEL);
  1086. if (!info->groups) {
  1087. dev_err(dev, "failed allocate memory for ping group list\n");
  1088. return -EINVAL;
  1089. }
  1090. i = 0;
  1091. for_each_child_of_node(np, child) {
  1092. if (of_match_node(rockchip_bank_match, child))
  1093. continue;
  1094. ret = rockchip_pinctrl_parse_functions(child, info, i++);
  1095. if (ret) {
  1096. dev_err(&pdev->dev, "failed to parse function\n");
  1097. return ret;
  1098. }
  1099. }
  1100. return 0;
  1101. }
  1102. static int rockchip_pinctrl_register(struct platform_device *pdev,
  1103. struct rockchip_pinctrl *info)
  1104. {
  1105. struct pinctrl_desc *ctrldesc = &info->pctl;
  1106. struct pinctrl_pin_desc *pindesc, *pdesc;
  1107. struct rockchip_pin_bank *pin_bank;
  1108. int pin, bank, ret;
  1109. int k;
  1110. ctrldesc->name = "rockchip-pinctrl";
  1111. ctrldesc->owner = THIS_MODULE;
  1112. ctrldesc->pctlops = &rockchip_pctrl_ops;
  1113. ctrldesc->pmxops = &rockchip_pmx_ops;
  1114. ctrldesc->confops = &rockchip_pinconf_ops;
  1115. pindesc = devm_kzalloc(&pdev->dev, sizeof(*pindesc) *
  1116. info->ctrl->nr_pins, GFP_KERNEL);
  1117. if (!pindesc) {
  1118. dev_err(&pdev->dev, "mem alloc for pin descriptors failed\n");
  1119. return -ENOMEM;
  1120. }
  1121. ctrldesc->pins = pindesc;
  1122. ctrldesc->npins = info->ctrl->nr_pins;
  1123. pdesc = pindesc;
  1124. for (bank = 0 , k = 0; bank < info->ctrl->nr_banks; bank++) {
  1125. pin_bank = &info->ctrl->pin_banks[bank];
  1126. for (pin = 0; pin < pin_bank->nr_pins; pin++, k++) {
  1127. pdesc->number = k;
  1128. pdesc->name = kasprintf(GFP_KERNEL, "%s-%d",
  1129. pin_bank->name, pin);
  1130. pdesc++;
  1131. }
  1132. }
  1133. ret = rockchip_pinctrl_parse_dt(pdev, info);
  1134. if (ret)
  1135. return ret;
  1136. info->pctl_dev = pinctrl_register(ctrldesc, &pdev->dev, info);
  1137. if (IS_ERR(info->pctl_dev)) {
  1138. dev_err(&pdev->dev, "could not register pinctrl driver\n");
  1139. return PTR_ERR(info->pctl_dev);
  1140. }
  1141. for (bank = 0; bank < info->ctrl->nr_banks; ++bank) {
  1142. pin_bank = &info->ctrl->pin_banks[bank];
  1143. pin_bank->grange.name = pin_bank->name;
  1144. pin_bank->grange.id = bank;
  1145. pin_bank->grange.pin_base = pin_bank->pin_base;
  1146. pin_bank->grange.base = pin_bank->gpio_chip.base;
  1147. pin_bank->grange.npins = pin_bank->gpio_chip.ngpio;
  1148. pin_bank->grange.gc = &pin_bank->gpio_chip;
  1149. pinctrl_add_gpio_range(info->pctl_dev, &pin_bank->grange);
  1150. }
  1151. return 0;
  1152. }
  1153. /*
  1154. * GPIO handling
  1155. */
  1156. static int rockchip_gpio_request(struct gpio_chip *chip, unsigned offset)
  1157. {
  1158. return pinctrl_request_gpio(chip->base + offset);
  1159. }
  1160. static void rockchip_gpio_free(struct gpio_chip *chip, unsigned offset)
  1161. {
  1162. pinctrl_free_gpio(chip->base + offset);
  1163. }
  1164. static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value)
  1165. {
  1166. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1167. void __iomem *reg = bank->reg_base + GPIO_SWPORT_DR;
  1168. unsigned long flags;
  1169. u32 data;
  1170. spin_lock_irqsave(&bank->slock, flags);
  1171. data = readl(reg);
  1172. data &= ~BIT(offset);
  1173. if (value)
  1174. data |= BIT(offset);
  1175. writel(data, reg);
  1176. spin_unlock_irqrestore(&bank->slock, flags);
  1177. }
  1178. /*
  1179. * Returns the level of the pin for input direction and setting of the DR
  1180. * register for output gpios.
  1181. */
  1182. static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset)
  1183. {
  1184. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1185. u32 data;
  1186. data = readl(bank->reg_base + GPIO_EXT_PORT);
  1187. data >>= offset;
  1188. data &= 1;
  1189. return data;
  1190. }
  1191. /*
  1192. * gpiolib gpio_direction_input callback function. The setting of the pin
  1193. * mux function as 'gpio input' will be handled by the pinctrl susbsystem
  1194. * interface.
  1195. */
  1196. static int rockchip_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
  1197. {
  1198. return pinctrl_gpio_direction_input(gc->base + offset);
  1199. }
  1200. /*
  1201. * gpiolib gpio_direction_output callback function. The setting of the pin
  1202. * mux function as 'gpio output' will be handled by the pinctrl susbsystem
  1203. * interface.
  1204. */
  1205. static int rockchip_gpio_direction_output(struct gpio_chip *gc,
  1206. unsigned offset, int value)
  1207. {
  1208. rockchip_gpio_set(gc, offset, value);
  1209. return pinctrl_gpio_direction_output(gc->base + offset);
  1210. }
  1211. /*
  1212. * gpiolib gpio_to_irq callback function. Creates a mapping between a GPIO pin
  1213. * and a virtual IRQ, if not already present.
  1214. */
  1215. static int rockchip_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
  1216. {
  1217. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1218. unsigned int virq;
  1219. if (!bank->domain)
  1220. return -ENXIO;
  1221. virq = irq_create_mapping(bank->domain, offset);
  1222. return (virq) ? : -ENXIO;
  1223. }
  1224. static const struct gpio_chip rockchip_gpiolib_chip = {
  1225. .request = rockchip_gpio_request,
  1226. .free = rockchip_gpio_free,
  1227. .set = rockchip_gpio_set,
  1228. .get = rockchip_gpio_get,
  1229. .direction_input = rockchip_gpio_direction_input,
  1230. .direction_output = rockchip_gpio_direction_output,
  1231. .to_irq = rockchip_gpio_to_irq,
  1232. .owner = THIS_MODULE,
  1233. };
  1234. /*
  1235. * Interrupt handling
  1236. */
  1237. static void rockchip_irq_demux(unsigned int irq, struct irq_desc *desc)
  1238. {
  1239. struct irq_chip *chip = irq_get_chip(irq);
  1240. struct rockchip_pin_bank *bank = irq_get_handler_data(irq);
  1241. u32 pend;
  1242. dev_dbg(bank->drvdata->dev, "got irq for bank %s\n", bank->name);
  1243. chained_irq_enter(chip, desc);
  1244. pend = readl_relaxed(bank->reg_base + GPIO_INT_STATUS);
  1245. while (pend) {
  1246. unsigned int virq;
  1247. irq = __ffs(pend);
  1248. pend &= ~BIT(irq);
  1249. virq = irq_linear_revmap(bank->domain, irq);
  1250. if (!virq) {
  1251. dev_err(bank->drvdata->dev, "unmapped irq %d\n", irq);
  1252. continue;
  1253. }
  1254. dev_dbg(bank->drvdata->dev, "handling irq %d\n", irq);
  1255. /*
  1256. * Triggering IRQ on both rising and falling edge
  1257. * needs manual intervention.
  1258. */
  1259. if (bank->toggle_edge_mode & BIT(irq)) {
  1260. u32 data, data_old, polarity;
  1261. unsigned long flags;
  1262. data = readl_relaxed(bank->reg_base + GPIO_EXT_PORT);
  1263. do {
  1264. spin_lock_irqsave(&bank->slock, flags);
  1265. polarity = readl_relaxed(bank->reg_base +
  1266. GPIO_INT_POLARITY);
  1267. if (data & BIT(irq))
  1268. polarity &= ~BIT(irq);
  1269. else
  1270. polarity |= BIT(irq);
  1271. writel(polarity,
  1272. bank->reg_base + GPIO_INT_POLARITY);
  1273. spin_unlock_irqrestore(&bank->slock, flags);
  1274. data_old = data;
  1275. data = readl_relaxed(bank->reg_base +
  1276. GPIO_EXT_PORT);
  1277. } while ((data & BIT(irq)) != (data_old & BIT(irq)));
  1278. }
  1279. generic_handle_irq(virq);
  1280. }
  1281. chained_irq_exit(chip, desc);
  1282. }
  1283. static int rockchip_irq_set_type(struct irq_data *d, unsigned int type)
  1284. {
  1285. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1286. struct rockchip_pin_bank *bank = gc->private;
  1287. u32 mask = BIT(d->hwirq);
  1288. u32 polarity;
  1289. u32 level;
  1290. u32 data;
  1291. unsigned long flags;
  1292. int ret;
  1293. /* make sure the pin is configured as gpio input */
  1294. ret = rockchip_set_mux(bank, d->hwirq, RK_FUNC_GPIO);
  1295. if (ret < 0)
  1296. return ret;
  1297. spin_lock_irqsave(&bank->slock, flags);
  1298. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  1299. data &= ~mask;
  1300. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  1301. spin_unlock_irqrestore(&bank->slock, flags);
  1302. if (type & IRQ_TYPE_EDGE_BOTH)
  1303. __irq_set_handler_locked(d->irq, handle_edge_irq);
  1304. else
  1305. __irq_set_handler_locked(d->irq, handle_level_irq);
  1306. spin_lock_irqsave(&bank->slock, flags);
  1307. irq_gc_lock(gc);
  1308. level = readl_relaxed(gc->reg_base + GPIO_INTTYPE_LEVEL);
  1309. polarity = readl_relaxed(gc->reg_base + GPIO_INT_POLARITY);
  1310. switch (type) {
  1311. case IRQ_TYPE_EDGE_BOTH:
  1312. bank->toggle_edge_mode |= mask;
  1313. level |= mask;
  1314. /*
  1315. * Determine gpio state. If 1 next interrupt should be falling
  1316. * otherwise rising.
  1317. */
  1318. data = readl(bank->reg_base + GPIO_EXT_PORT);
  1319. if (data & mask)
  1320. polarity &= ~mask;
  1321. else
  1322. polarity |= mask;
  1323. break;
  1324. case IRQ_TYPE_EDGE_RISING:
  1325. bank->toggle_edge_mode &= ~mask;
  1326. level |= mask;
  1327. polarity |= mask;
  1328. break;
  1329. case IRQ_TYPE_EDGE_FALLING:
  1330. bank->toggle_edge_mode &= ~mask;
  1331. level |= mask;
  1332. polarity &= ~mask;
  1333. break;
  1334. case IRQ_TYPE_LEVEL_HIGH:
  1335. bank->toggle_edge_mode &= ~mask;
  1336. level &= ~mask;
  1337. polarity |= mask;
  1338. break;
  1339. case IRQ_TYPE_LEVEL_LOW:
  1340. bank->toggle_edge_mode &= ~mask;
  1341. level &= ~mask;
  1342. polarity &= ~mask;
  1343. break;
  1344. default:
  1345. irq_gc_unlock(gc);
  1346. spin_unlock_irqrestore(&bank->slock, flags);
  1347. return -EINVAL;
  1348. }
  1349. writel_relaxed(level, gc->reg_base + GPIO_INTTYPE_LEVEL);
  1350. writel_relaxed(polarity, gc->reg_base + GPIO_INT_POLARITY);
  1351. irq_gc_unlock(gc);
  1352. spin_unlock_irqrestore(&bank->slock, flags);
  1353. return 0;
  1354. }
  1355. static void rockchip_irq_suspend(struct irq_data *d)
  1356. {
  1357. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1358. struct rockchip_pin_bank *bank = gc->private;
  1359. bank->saved_masks = irq_reg_readl(gc, GPIO_INTMASK);
  1360. irq_reg_writel(gc, ~gc->wake_active, GPIO_INTMASK);
  1361. }
  1362. static void rockchip_irq_resume(struct irq_data *d)
  1363. {
  1364. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1365. struct rockchip_pin_bank *bank = gc->private;
  1366. irq_reg_writel(gc, bank->saved_masks, GPIO_INTMASK);
  1367. }
  1368. static int rockchip_interrupts_register(struct platform_device *pdev,
  1369. struct rockchip_pinctrl *info)
  1370. {
  1371. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1372. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1373. unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN;
  1374. struct irq_chip_generic *gc;
  1375. int ret;
  1376. int i;
  1377. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1378. if (!bank->valid) {
  1379. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1380. bank->name);
  1381. continue;
  1382. }
  1383. bank->domain = irq_domain_add_linear(bank->of_node, 32,
  1384. &irq_generic_chip_ops, NULL);
  1385. if (!bank->domain) {
  1386. dev_warn(&pdev->dev, "could not initialize irq domain for bank %s\n",
  1387. bank->name);
  1388. continue;
  1389. }
  1390. ret = irq_alloc_domain_generic_chips(bank->domain, 32, 1,
  1391. "rockchip_gpio_irq", handle_level_irq,
  1392. clr, 0, IRQ_GC_INIT_MASK_CACHE);
  1393. if (ret) {
  1394. dev_err(&pdev->dev, "could not alloc generic chips for bank %s\n",
  1395. bank->name);
  1396. irq_domain_remove(bank->domain);
  1397. continue;
  1398. }
  1399. /*
  1400. * Linux assumes that all interrupts start out disabled/masked.
  1401. * Our driver only uses the concept of masked and always keeps
  1402. * things enabled, so for us that's all masked and all enabled.
  1403. */
  1404. writel_relaxed(0xffffffff, bank->reg_base + GPIO_INTMASK);
  1405. writel_relaxed(0xffffffff, bank->reg_base + GPIO_INTEN);
  1406. gc = irq_get_domain_generic_chip(bank->domain, 0);
  1407. gc->reg_base = bank->reg_base;
  1408. gc->private = bank;
  1409. gc->chip_types[0].regs.mask = GPIO_INTMASK;
  1410. gc->chip_types[0].regs.ack = GPIO_PORTS_EOI;
  1411. gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
  1412. gc->chip_types[0].chip.irq_mask = irq_gc_mask_set_bit;
  1413. gc->chip_types[0].chip.irq_unmask = irq_gc_mask_clr_bit;
  1414. gc->chip_types[0].chip.irq_set_wake = irq_gc_set_wake;
  1415. gc->chip_types[0].chip.irq_suspend = rockchip_irq_suspend;
  1416. gc->chip_types[0].chip.irq_resume = rockchip_irq_resume;
  1417. gc->chip_types[0].chip.irq_set_type = rockchip_irq_set_type;
  1418. gc->wake_enabled = IRQ_MSK(bank->nr_pins);
  1419. irq_set_handler_data(bank->irq, bank);
  1420. irq_set_chained_handler(bank->irq, rockchip_irq_demux);
  1421. }
  1422. return 0;
  1423. }
  1424. static int rockchip_gpiolib_register(struct platform_device *pdev,
  1425. struct rockchip_pinctrl *info)
  1426. {
  1427. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1428. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1429. struct gpio_chip *gc;
  1430. int ret;
  1431. int i;
  1432. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1433. if (!bank->valid) {
  1434. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1435. bank->name);
  1436. continue;
  1437. }
  1438. bank->gpio_chip = rockchip_gpiolib_chip;
  1439. gc = &bank->gpio_chip;
  1440. gc->base = bank->pin_base;
  1441. gc->ngpio = bank->nr_pins;
  1442. gc->dev = &pdev->dev;
  1443. gc->of_node = bank->of_node;
  1444. gc->label = bank->name;
  1445. ret = gpiochip_add(gc);
  1446. if (ret) {
  1447. dev_err(&pdev->dev, "failed to register gpio_chip %s, error code: %d\n",
  1448. gc->label, ret);
  1449. goto fail;
  1450. }
  1451. }
  1452. rockchip_interrupts_register(pdev, info);
  1453. return 0;
  1454. fail:
  1455. for (--i, --bank; i >= 0; --i, --bank) {
  1456. if (!bank->valid)
  1457. continue;
  1458. gpiochip_remove(&bank->gpio_chip);
  1459. }
  1460. return ret;
  1461. }
  1462. static int rockchip_gpiolib_unregister(struct platform_device *pdev,
  1463. struct rockchip_pinctrl *info)
  1464. {
  1465. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1466. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1467. int i;
  1468. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1469. if (!bank->valid)
  1470. continue;
  1471. gpiochip_remove(&bank->gpio_chip);
  1472. }
  1473. return 0;
  1474. }
  1475. static int rockchip_get_bank_data(struct rockchip_pin_bank *bank,
  1476. struct rockchip_pinctrl *info)
  1477. {
  1478. struct resource res;
  1479. void __iomem *base;
  1480. if (of_address_to_resource(bank->of_node, 0, &res)) {
  1481. dev_err(info->dev, "cannot find IO resource for bank\n");
  1482. return -ENOENT;
  1483. }
  1484. bank->reg_base = devm_ioremap_resource(info->dev, &res);
  1485. if (IS_ERR(bank->reg_base))
  1486. return PTR_ERR(bank->reg_base);
  1487. /*
  1488. * special case, where parts of the pull setting-registers are
  1489. * part of the PMU register space
  1490. */
  1491. if (of_device_is_compatible(bank->of_node,
  1492. "rockchip,rk3188-gpio-bank0")) {
  1493. struct device_node *node;
  1494. node = of_parse_phandle(bank->of_node->parent,
  1495. "rockchip,pmu", 0);
  1496. if (!node) {
  1497. if (of_address_to_resource(bank->of_node, 1, &res)) {
  1498. dev_err(info->dev, "cannot find IO resource for bank\n");
  1499. return -ENOENT;
  1500. }
  1501. base = devm_ioremap_resource(info->dev, &res);
  1502. if (IS_ERR(base))
  1503. return PTR_ERR(base);
  1504. rockchip_regmap_config.max_register =
  1505. resource_size(&res) - 4;
  1506. rockchip_regmap_config.name =
  1507. "rockchip,rk3188-gpio-bank0-pull";
  1508. bank->regmap_pull = devm_regmap_init_mmio(info->dev,
  1509. base,
  1510. &rockchip_regmap_config);
  1511. }
  1512. }
  1513. bank->irq = irq_of_parse_and_map(bank->of_node, 0);
  1514. bank->clk = of_clk_get(bank->of_node, 0);
  1515. if (IS_ERR(bank->clk))
  1516. return PTR_ERR(bank->clk);
  1517. return clk_prepare_enable(bank->clk);
  1518. }
  1519. static const struct of_device_id rockchip_pinctrl_dt_match[];
  1520. /* retrieve the soc specific data */
  1521. static struct rockchip_pin_ctrl *rockchip_pinctrl_get_soc_data(
  1522. struct rockchip_pinctrl *d,
  1523. struct platform_device *pdev)
  1524. {
  1525. const struct of_device_id *match;
  1526. struct device_node *node = pdev->dev.of_node;
  1527. struct device_node *np;
  1528. struct rockchip_pin_ctrl *ctrl;
  1529. struct rockchip_pin_bank *bank;
  1530. int grf_offs, pmu_offs, i, j;
  1531. match = of_match_node(rockchip_pinctrl_dt_match, node);
  1532. ctrl = (struct rockchip_pin_ctrl *)match->data;
  1533. for_each_child_of_node(node, np) {
  1534. if (!of_find_property(np, "gpio-controller", NULL))
  1535. continue;
  1536. bank = ctrl->pin_banks;
  1537. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1538. if (!strcmp(bank->name, np->name)) {
  1539. bank->of_node = np;
  1540. if (!rockchip_get_bank_data(bank, d))
  1541. bank->valid = true;
  1542. break;
  1543. }
  1544. }
  1545. }
  1546. grf_offs = ctrl->grf_mux_offset;
  1547. pmu_offs = ctrl->pmu_mux_offset;
  1548. bank = ctrl->pin_banks;
  1549. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1550. int bank_pins = 0;
  1551. spin_lock_init(&bank->slock);
  1552. bank->drvdata = d;
  1553. bank->pin_base = ctrl->nr_pins;
  1554. ctrl->nr_pins += bank->nr_pins;
  1555. /* calculate iomux offsets */
  1556. for (j = 0; j < 4; j++) {
  1557. struct rockchip_iomux *iom = &bank->iomux[j];
  1558. int inc;
  1559. if (bank_pins >= bank->nr_pins)
  1560. break;
  1561. /* preset offset value, set new start value */
  1562. if (iom->offset >= 0) {
  1563. if (iom->type & IOMUX_SOURCE_PMU)
  1564. pmu_offs = iom->offset;
  1565. else
  1566. grf_offs = iom->offset;
  1567. } else { /* set current offset */
  1568. iom->offset = (iom->type & IOMUX_SOURCE_PMU) ?
  1569. pmu_offs : grf_offs;
  1570. }
  1571. dev_dbg(d->dev, "bank %d, iomux %d has offset 0x%x\n",
  1572. i, j, iom->offset);
  1573. /*
  1574. * Increase offset according to iomux width.
  1575. * 4bit iomux'es are spread over two registers.
  1576. */
  1577. inc = (iom->type & IOMUX_WIDTH_4BIT) ? 8 : 4;
  1578. if (iom->type & IOMUX_SOURCE_PMU)
  1579. pmu_offs += inc;
  1580. else
  1581. grf_offs += inc;
  1582. bank_pins += 8;
  1583. }
  1584. }
  1585. return ctrl;
  1586. }
  1587. #define RK3288_GRF_GPIO6C_IOMUX 0x64
  1588. #define GPIO6C6_SEL_WRITE_ENABLE BIT(28)
  1589. static u32 rk3288_grf_gpio6c_iomux;
  1590. static int __maybe_unused rockchip_pinctrl_suspend(struct device *dev)
  1591. {
  1592. struct rockchip_pinctrl *info = dev_get_drvdata(dev);
  1593. int ret = pinctrl_force_sleep(info->pctl_dev);
  1594. if (ret)
  1595. return ret;
  1596. /*
  1597. * RK3288 GPIO6_C6 mux would be modified by Maskrom when resume, so save
  1598. * the setting here, and restore it at resume.
  1599. */
  1600. if (info->ctrl->type == RK3288) {
  1601. ret = regmap_read(info->regmap_base, RK3288_GRF_GPIO6C_IOMUX,
  1602. &rk3288_grf_gpio6c_iomux);
  1603. if (ret) {
  1604. pinctrl_force_default(info->pctl_dev);
  1605. return ret;
  1606. }
  1607. }
  1608. return 0;
  1609. }
  1610. static int __maybe_unused rockchip_pinctrl_resume(struct device *dev)
  1611. {
  1612. struct rockchip_pinctrl *info = dev_get_drvdata(dev);
  1613. int ret = regmap_write(info->regmap_base, RK3288_GRF_GPIO6C_IOMUX,
  1614. rk3288_grf_gpio6c_iomux |
  1615. GPIO6C6_SEL_WRITE_ENABLE);
  1616. if (ret)
  1617. return ret;
  1618. return pinctrl_force_default(info->pctl_dev);
  1619. }
  1620. static SIMPLE_DEV_PM_OPS(rockchip_pinctrl_dev_pm_ops, rockchip_pinctrl_suspend,
  1621. rockchip_pinctrl_resume);
  1622. static int rockchip_pinctrl_probe(struct platform_device *pdev)
  1623. {
  1624. struct rockchip_pinctrl *info;
  1625. struct device *dev = &pdev->dev;
  1626. struct rockchip_pin_ctrl *ctrl;
  1627. struct device_node *np = pdev->dev.of_node, *node;
  1628. struct resource *res;
  1629. void __iomem *base;
  1630. int ret;
  1631. if (!dev->of_node) {
  1632. dev_err(dev, "device tree node not found\n");
  1633. return -ENODEV;
  1634. }
  1635. info = devm_kzalloc(dev, sizeof(struct rockchip_pinctrl), GFP_KERNEL);
  1636. if (!info)
  1637. return -ENOMEM;
  1638. info->dev = dev;
  1639. ctrl = rockchip_pinctrl_get_soc_data(info, pdev);
  1640. if (!ctrl) {
  1641. dev_err(dev, "driver data not available\n");
  1642. return -EINVAL;
  1643. }
  1644. info->ctrl = ctrl;
  1645. node = of_parse_phandle(np, "rockchip,grf", 0);
  1646. if (node) {
  1647. info->regmap_base = syscon_node_to_regmap(node);
  1648. if (IS_ERR(info->regmap_base))
  1649. return PTR_ERR(info->regmap_base);
  1650. } else {
  1651. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1652. base = devm_ioremap_resource(&pdev->dev, res);
  1653. if (IS_ERR(base))
  1654. return PTR_ERR(base);
  1655. rockchip_regmap_config.max_register = resource_size(res) - 4;
  1656. rockchip_regmap_config.name = "rockchip,pinctrl";
  1657. info->regmap_base = devm_regmap_init_mmio(&pdev->dev, base,
  1658. &rockchip_regmap_config);
  1659. /* to check for the old dt-bindings */
  1660. info->reg_size = resource_size(res);
  1661. /* Honor the old binding, with pull registers as 2nd resource */
  1662. if (ctrl->type == RK3188 && info->reg_size < 0x200) {
  1663. res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  1664. base = devm_ioremap_resource(&pdev->dev, res);
  1665. if (IS_ERR(base))
  1666. return PTR_ERR(base);
  1667. rockchip_regmap_config.max_register =
  1668. resource_size(res) - 4;
  1669. rockchip_regmap_config.name = "rockchip,pinctrl-pull";
  1670. info->regmap_pull = devm_regmap_init_mmio(&pdev->dev,
  1671. base,
  1672. &rockchip_regmap_config);
  1673. }
  1674. }
  1675. /* try to find the optional reference to the pmu syscon */
  1676. node = of_parse_phandle(np, "rockchip,pmu", 0);
  1677. if (node) {
  1678. info->regmap_pmu = syscon_node_to_regmap(node);
  1679. if (IS_ERR(info->regmap_pmu))
  1680. return PTR_ERR(info->regmap_pmu);
  1681. }
  1682. ret = rockchip_gpiolib_register(pdev, info);
  1683. if (ret)
  1684. return ret;
  1685. ret = rockchip_pinctrl_register(pdev, info);
  1686. if (ret) {
  1687. rockchip_gpiolib_unregister(pdev, info);
  1688. return ret;
  1689. }
  1690. platform_set_drvdata(pdev, info);
  1691. return 0;
  1692. }
  1693. static struct rockchip_pin_bank rk2928_pin_banks[] = {
  1694. PIN_BANK(0, 32, "gpio0"),
  1695. PIN_BANK(1, 32, "gpio1"),
  1696. PIN_BANK(2, 32, "gpio2"),
  1697. PIN_BANK(3, 32, "gpio3"),
  1698. };
  1699. static struct rockchip_pin_ctrl rk2928_pin_ctrl = {
  1700. .pin_banks = rk2928_pin_banks,
  1701. .nr_banks = ARRAY_SIZE(rk2928_pin_banks),
  1702. .label = "RK2928-GPIO",
  1703. .type = RK2928,
  1704. .grf_mux_offset = 0xa8,
  1705. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1706. };
  1707. static struct rockchip_pin_bank rk3066a_pin_banks[] = {
  1708. PIN_BANK(0, 32, "gpio0"),
  1709. PIN_BANK(1, 32, "gpio1"),
  1710. PIN_BANK(2, 32, "gpio2"),
  1711. PIN_BANK(3, 32, "gpio3"),
  1712. PIN_BANK(4, 32, "gpio4"),
  1713. PIN_BANK(6, 16, "gpio6"),
  1714. };
  1715. static struct rockchip_pin_ctrl rk3066a_pin_ctrl = {
  1716. .pin_banks = rk3066a_pin_banks,
  1717. .nr_banks = ARRAY_SIZE(rk3066a_pin_banks),
  1718. .label = "RK3066a-GPIO",
  1719. .type = RK2928,
  1720. .grf_mux_offset = 0xa8,
  1721. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1722. };
  1723. static struct rockchip_pin_bank rk3066b_pin_banks[] = {
  1724. PIN_BANK(0, 32, "gpio0"),
  1725. PIN_BANK(1, 32, "gpio1"),
  1726. PIN_BANK(2, 32, "gpio2"),
  1727. PIN_BANK(3, 32, "gpio3"),
  1728. };
  1729. static struct rockchip_pin_ctrl rk3066b_pin_ctrl = {
  1730. .pin_banks = rk3066b_pin_banks,
  1731. .nr_banks = ARRAY_SIZE(rk3066b_pin_banks),
  1732. .label = "RK3066b-GPIO",
  1733. .type = RK3066B,
  1734. .grf_mux_offset = 0x60,
  1735. };
  1736. static struct rockchip_pin_bank rk3188_pin_banks[] = {
  1737. PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_GPIO_ONLY, 0, 0, 0),
  1738. PIN_BANK(1, 32, "gpio1"),
  1739. PIN_BANK(2, 32, "gpio2"),
  1740. PIN_BANK(3, 32, "gpio3"),
  1741. };
  1742. static struct rockchip_pin_ctrl rk3188_pin_ctrl = {
  1743. .pin_banks = rk3188_pin_banks,
  1744. .nr_banks = ARRAY_SIZE(rk3188_pin_banks),
  1745. .label = "RK3188-GPIO",
  1746. .type = RK3188,
  1747. .grf_mux_offset = 0x60,
  1748. .pull_calc_reg = rk3188_calc_pull_reg_and_bit,
  1749. };
  1750. static struct rockchip_pin_bank rk3288_pin_banks[] = {
  1751. PIN_BANK_IOMUX_FLAGS(0, 24, "gpio0", IOMUX_SOURCE_PMU,
  1752. IOMUX_SOURCE_PMU,
  1753. IOMUX_SOURCE_PMU,
  1754. IOMUX_UNROUTED
  1755. ),
  1756. PIN_BANK_IOMUX_FLAGS(1, 32, "gpio1", IOMUX_UNROUTED,
  1757. IOMUX_UNROUTED,
  1758. IOMUX_UNROUTED,
  1759. 0
  1760. ),
  1761. PIN_BANK_IOMUX_FLAGS(2, 32, "gpio2", 0, 0, 0, IOMUX_UNROUTED),
  1762. PIN_BANK_IOMUX_FLAGS(3, 32, "gpio3", 0, 0, 0, IOMUX_WIDTH_4BIT),
  1763. PIN_BANK_IOMUX_FLAGS(4, 32, "gpio4", IOMUX_WIDTH_4BIT,
  1764. IOMUX_WIDTH_4BIT,
  1765. 0,
  1766. 0
  1767. ),
  1768. PIN_BANK_IOMUX_FLAGS(5, 32, "gpio5", IOMUX_UNROUTED,
  1769. 0,
  1770. 0,
  1771. IOMUX_UNROUTED
  1772. ),
  1773. PIN_BANK_IOMUX_FLAGS(6, 32, "gpio6", 0, 0, 0, IOMUX_UNROUTED),
  1774. PIN_BANK_IOMUX_FLAGS(7, 32, "gpio7", 0,
  1775. 0,
  1776. IOMUX_WIDTH_4BIT,
  1777. IOMUX_UNROUTED
  1778. ),
  1779. PIN_BANK(8, 16, "gpio8"),
  1780. };
  1781. static struct rockchip_pin_ctrl rk3288_pin_ctrl = {
  1782. .pin_banks = rk3288_pin_banks,
  1783. .nr_banks = ARRAY_SIZE(rk3288_pin_banks),
  1784. .label = "RK3288-GPIO",
  1785. .type = RK3288,
  1786. .grf_mux_offset = 0x0,
  1787. .pmu_mux_offset = 0x84,
  1788. .pull_calc_reg = rk3288_calc_pull_reg_and_bit,
  1789. .drv_calc_reg = rk3288_calc_drv_reg_and_bit,
  1790. };
  1791. static struct rockchip_pin_bank rk3368_pin_banks[] = {
  1792. PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU,
  1793. IOMUX_SOURCE_PMU,
  1794. IOMUX_SOURCE_PMU,
  1795. IOMUX_SOURCE_PMU
  1796. ),
  1797. PIN_BANK(1, 32, "gpio1"),
  1798. PIN_BANK(2, 32, "gpio2"),
  1799. PIN_BANK(3, 32, "gpio3"),
  1800. };
  1801. static struct rockchip_pin_ctrl rk3368_pin_ctrl = {
  1802. .pin_banks = rk3368_pin_banks,
  1803. .nr_banks = ARRAY_SIZE(rk3368_pin_banks),
  1804. .label = "RK3368-GPIO",
  1805. .type = RK3368,
  1806. .grf_mux_offset = 0x0,
  1807. .pmu_mux_offset = 0x0,
  1808. .pull_calc_reg = rk3368_calc_pull_reg_and_bit,
  1809. .drv_calc_reg = rk3368_calc_drv_reg_and_bit,
  1810. };
  1811. static const struct of_device_id rockchip_pinctrl_dt_match[] = {
  1812. { .compatible = "rockchip,rk2928-pinctrl",
  1813. .data = (void *)&rk2928_pin_ctrl },
  1814. { .compatible = "rockchip,rk3066a-pinctrl",
  1815. .data = (void *)&rk3066a_pin_ctrl },
  1816. { .compatible = "rockchip,rk3066b-pinctrl",
  1817. .data = (void *)&rk3066b_pin_ctrl },
  1818. { .compatible = "rockchip,rk3188-pinctrl",
  1819. .data = (void *)&rk3188_pin_ctrl },
  1820. { .compatible = "rockchip,rk3288-pinctrl",
  1821. .data = (void *)&rk3288_pin_ctrl },
  1822. { .compatible = "rockchip,rk3368-pinctrl",
  1823. .data = (void *)&rk3368_pin_ctrl },
  1824. {},
  1825. };
  1826. MODULE_DEVICE_TABLE(of, rockchip_pinctrl_dt_match);
  1827. static struct platform_driver rockchip_pinctrl_driver = {
  1828. .probe = rockchip_pinctrl_probe,
  1829. .driver = {
  1830. .name = "rockchip-pinctrl",
  1831. .pm = &rockchip_pinctrl_dev_pm_ops,
  1832. .of_match_table = rockchip_pinctrl_dt_match,
  1833. },
  1834. };
  1835. static int __init rockchip_pinctrl_drv_register(void)
  1836. {
  1837. return platform_driver_register(&rockchip_pinctrl_driver);
  1838. }
  1839. postcore_initcall(rockchip_pinctrl_drv_register);
  1840. MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
  1841. MODULE_DESCRIPTION("Rockchip pinctrl driver");
  1842. MODULE_LICENSE("GPL v2");