pinctrl-rockchip.c 57 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241
  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. clk_enable(bank->clk);
  802. spin_lock_irqsave(&bank->slock, flags);
  803. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  804. /* set bit to 1 for output, 0 for input */
  805. if (!input)
  806. data |= BIT(pin);
  807. else
  808. data &= ~BIT(pin);
  809. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  810. spin_unlock_irqrestore(&bank->slock, flags);
  811. clk_disable(bank->clk);
  812. return 0;
  813. }
  814. static int rockchip_pmx_gpio_set_direction(struct pinctrl_dev *pctldev,
  815. struct pinctrl_gpio_range *range,
  816. unsigned offset, bool input)
  817. {
  818. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  819. struct gpio_chip *chip;
  820. int pin;
  821. chip = range->gc;
  822. pin = offset - chip->base;
  823. dev_dbg(info->dev, "gpio_direction for pin %u as %s-%d to %s\n",
  824. offset, range->name, pin, input ? "input" : "output");
  825. return _rockchip_pmx_gpio_set_direction(chip, offset - chip->base,
  826. input);
  827. }
  828. static const struct pinmux_ops rockchip_pmx_ops = {
  829. .get_functions_count = rockchip_pmx_get_funcs_count,
  830. .get_function_name = rockchip_pmx_get_func_name,
  831. .get_function_groups = rockchip_pmx_get_groups,
  832. .set_mux = rockchip_pmx_set,
  833. .gpio_set_direction = rockchip_pmx_gpio_set_direction,
  834. };
  835. /*
  836. * Pinconf_ops handling
  837. */
  838. static bool rockchip_pinconf_pull_valid(struct rockchip_pin_ctrl *ctrl,
  839. enum pin_config_param pull)
  840. {
  841. switch (ctrl->type) {
  842. case RK2928:
  843. return (pull == PIN_CONFIG_BIAS_PULL_PIN_DEFAULT ||
  844. pull == PIN_CONFIG_BIAS_DISABLE);
  845. case RK3066B:
  846. return pull ? false : true;
  847. case RK3188:
  848. case RK3288:
  849. case RK3368:
  850. return (pull != PIN_CONFIG_BIAS_PULL_PIN_DEFAULT);
  851. }
  852. return false;
  853. }
  854. static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value);
  855. static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset);
  856. /* set the pin config settings for a specified pin */
  857. static int rockchip_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
  858. unsigned long *configs, unsigned num_configs)
  859. {
  860. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  861. struct rockchip_pin_bank *bank = pin_to_bank(info, pin);
  862. enum pin_config_param param;
  863. u16 arg;
  864. int i;
  865. int rc;
  866. for (i = 0; i < num_configs; i++) {
  867. param = pinconf_to_config_param(configs[i]);
  868. arg = pinconf_to_config_argument(configs[i]);
  869. switch (param) {
  870. case PIN_CONFIG_BIAS_DISABLE:
  871. rc = rockchip_set_pull(bank, pin - bank->pin_base,
  872. param);
  873. if (rc)
  874. return rc;
  875. break;
  876. case PIN_CONFIG_BIAS_PULL_UP:
  877. case PIN_CONFIG_BIAS_PULL_DOWN:
  878. case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
  879. case PIN_CONFIG_BIAS_BUS_HOLD:
  880. if (!rockchip_pinconf_pull_valid(info->ctrl, param))
  881. return -ENOTSUPP;
  882. if (!arg)
  883. return -EINVAL;
  884. rc = rockchip_set_pull(bank, pin - bank->pin_base,
  885. param);
  886. if (rc)
  887. return rc;
  888. break;
  889. case PIN_CONFIG_OUTPUT:
  890. rockchip_gpio_set(&bank->gpio_chip,
  891. pin - bank->pin_base, arg);
  892. rc = _rockchip_pmx_gpio_set_direction(&bank->gpio_chip,
  893. pin - bank->pin_base, false);
  894. if (rc)
  895. return rc;
  896. break;
  897. case PIN_CONFIG_DRIVE_STRENGTH:
  898. /* rk3288 is the first with per-pin drive-strength */
  899. if (!info->ctrl->drv_calc_reg)
  900. return -ENOTSUPP;
  901. rc = rockchip_set_drive_perpin(bank,
  902. pin - bank->pin_base, arg);
  903. if (rc < 0)
  904. return rc;
  905. break;
  906. default:
  907. return -ENOTSUPP;
  908. break;
  909. }
  910. } /* for each config */
  911. return 0;
  912. }
  913. /* get the pin config settings for a specified pin */
  914. static int rockchip_pinconf_get(struct pinctrl_dev *pctldev, unsigned int pin,
  915. unsigned long *config)
  916. {
  917. struct rockchip_pinctrl *info = pinctrl_dev_get_drvdata(pctldev);
  918. struct rockchip_pin_bank *bank = pin_to_bank(info, pin);
  919. enum pin_config_param param = pinconf_to_config_param(*config);
  920. u16 arg;
  921. int rc;
  922. switch (param) {
  923. case PIN_CONFIG_BIAS_DISABLE:
  924. if (rockchip_get_pull(bank, pin - bank->pin_base) != param)
  925. return -EINVAL;
  926. arg = 0;
  927. break;
  928. case PIN_CONFIG_BIAS_PULL_UP:
  929. case PIN_CONFIG_BIAS_PULL_DOWN:
  930. case PIN_CONFIG_BIAS_PULL_PIN_DEFAULT:
  931. case PIN_CONFIG_BIAS_BUS_HOLD:
  932. if (!rockchip_pinconf_pull_valid(info->ctrl, param))
  933. return -ENOTSUPP;
  934. if (rockchip_get_pull(bank, pin - bank->pin_base) != param)
  935. return -EINVAL;
  936. arg = 1;
  937. break;
  938. case PIN_CONFIG_OUTPUT:
  939. rc = rockchip_get_mux(bank, pin - bank->pin_base);
  940. if (rc != RK_FUNC_GPIO)
  941. return -EINVAL;
  942. rc = rockchip_gpio_get(&bank->gpio_chip, pin - bank->pin_base);
  943. if (rc < 0)
  944. return rc;
  945. arg = rc ? 1 : 0;
  946. break;
  947. case PIN_CONFIG_DRIVE_STRENGTH:
  948. /* rk3288 is the first with per-pin drive-strength */
  949. if (!info->ctrl->drv_calc_reg)
  950. return -ENOTSUPP;
  951. rc = rockchip_get_drive_perpin(bank, pin - bank->pin_base);
  952. if (rc < 0)
  953. return rc;
  954. arg = rc;
  955. break;
  956. default:
  957. return -ENOTSUPP;
  958. break;
  959. }
  960. *config = pinconf_to_config_packed(param, arg);
  961. return 0;
  962. }
  963. static const struct pinconf_ops rockchip_pinconf_ops = {
  964. .pin_config_get = rockchip_pinconf_get,
  965. .pin_config_set = rockchip_pinconf_set,
  966. .is_generic = true,
  967. };
  968. static const struct of_device_id rockchip_bank_match[] = {
  969. { .compatible = "rockchip,gpio-bank" },
  970. { .compatible = "rockchip,rk3188-gpio-bank0" },
  971. {},
  972. };
  973. static void rockchip_pinctrl_child_count(struct rockchip_pinctrl *info,
  974. struct device_node *np)
  975. {
  976. struct device_node *child;
  977. for_each_child_of_node(np, child) {
  978. if (of_match_node(rockchip_bank_match, child))
  979. continue;
  980. info->nfunctions++;
  981. info->ngroups += of_get_child_count(child);
  982. }
  983. }
  984. static int rockchip_pinctrl_parse_groups(struct device_node *np,
  985. struct rockchip_pin_group *grp,
  986. struct rockchip_pinctrl *info,
  987. u32 index)
  988. {
  989. struct rockchip_pin_bank *bank;
  990. int size;
  991. const __be32 *list;
  992. int num;
  993. int i, j;
  994. int ret;
  995. dev_dbg(info->dev, "group(%d): %s\n", index, np->name);
  996. /* Initialise group */
  997. grp->name = np->name;
  998. /*
  999. * the binding format is rockchip,pins = <bank pin mux CONFIG>,
  1000. * do sanity check and calculate pins number
  1001. */
  1002. list = of_get_property(np, "rockchip,pins", &size);
  1003. /* we do not check return since it's safe node passed down */
  1004. size /= sizeof(*list);
  1005. if (!size || size % 4) {
  1006. dev_err(info->dev, "wrong pins number or pins and configs should be by 4\n");
  1007. return -EINVAL;
  1008. }
  1009. grp->npins = size / 4;
  1010. grp->pins = devm_kzalloc(info->dev, grp->npins * sizeof(unsigned int),
  1011. GFP_KERNEL);
  1012. grp->data = devm_kzalloc(info->dev, grp->npins *
  1013. sizeof(struct rockchip_pin_config),
  1014. GFP_KERNEL);
  1015. if (!grp->pins || !grp->data)
  1016. return -ENOMEM;
  1017. for (i = 0, j = 0; i < size; i += 4, j++) {
  1018. const __be32 *phandle;
  1019. struct device_node *np_config;
  1020. num = be32_to_cpu(*list++);
  1021. bank = bank_num_to_bank(info, num);
  1022. if (IS_ERR(bank))
  1023. return PTR_ERR(bank);
  1024. grp->pins[j] = bank->pin_base + be32_to_cpu(*list++);
  1025. grp->data[j].func = be32_to_cpu(*list++);
  1026. phandle = list++;
  1027. if (!phandle)
  1028. return -EINVAL;
  1029. np_config = of_find_node_by_phandle(be32_to_cpup(phandle));
  1030. ret = pinconf_generic_parse_dt_config(np_config, NULL,
  1031. &grp->data[j].configs, &grp->data[j].nconfigs);
  1032. if (ret)
  1033. return ret;
  1034. }
  1035. return 0;
  1036. }
  1037. static int rockchip_pinctrl_parse_functions(struct device_node *np,
  1038. struct rockchip_pinctrl *info,
  1039. u32 index)
  1040. {
  1041. struct device_node *child;
  1042. struct rockchip_pmx_func *func;
  1043. struct rockchip_pin_group *grp;
  1044. int ret;
  1045. static u32 grp_index;
  1046. u32 i = 0;
  1047. dev_dbg(info->dev, "parse function(%d): %s\n", index, np->name);
  1048. func = &info->functions[index];
  1049. /* Initialise function */
  1050. func->name = np->name;
  1051. func->ngroups = of_get_child_count(np);
  1052. if (func->ngroups <= 0)
  1053. return 0;
  1054. func->groups = devm_kzalloc(info->dev,
  1055. func->ngroups * sizeof(char *), GFP_KERNEL);
  1056. if (!func->groups)
  1057. return -ENOMEM;
  1058. for_each_child_of_node(np, child) {
  1059. func->groups[i] = child->name;
  1060. grp = &info->groups[grp_index++];
  1061. ret = rockchip_pinctrl_parse_groups(child, grp, info, i++);
  1062. if (ret)
  1063. return ret;
  1064. }
  1065. return 0;
  1066. }
  1067. static int rockchip_pinctrl_parse_dt(struct platform_device *pdev,
  1068. struct rockchip_pinctrl *info)
  1069. {
  1070. struct device *dev = &pdev->dev;
  1071. struct device_node *np = dev->of_node;
  1072. struct device_node *child;
  1073. int ret;
  1074. int i;
  1075. rockchip_pinctrl_child_count(info, np);
  1076. dev_dbg(&pdev->dev, "nfunctions = %d\n", info->nfunctions);
  1077. dev_dbg(&pdev->dev, "ngroups = %d\n", info->ngroups);
  1078. info->functions = devm_kzalloc(dev, info->nfunctions *
  1079. sizeof(struct rockchip_pmx_func),
  1080. GFP_KERNEL);
  1081. if (!info->functions) {
  1082. dev_err(dev, "failed to allocate memory for function list\n");
  1083. return -EINVAL;
  1084. }
  1085. info->groups = devm_kzalloc(dev, info->ngroups *
  1086. sizeof(struct rockchip_pin_group),
  1087. GFP_KERNEL);
  1088. if (!info->groups) {
  1089. dev_err(dev, "failed allocate memory for ping group list\n");
  1090. return -EINVAL;
  1091. }
  1092. i = 0;
  1093. for_each_child_of_node(np, child) {
  1094. if (of_match_node(rockchip_bank_match, child))
  1095. continue;
  1096. ret = rockchip_pinctrl_parse_functions(child, info, i++);
  1097. if (ret) {
  1098. dev_err(&pdev->dev, "failed to parse function\n");
  1099. return ret;
  1100. }
  1101. }
  1102. return 0;
  1103. }
  1104. static int rockchip_pinctrl_register(struct platform_device *pdev,
  1105. struct rockchip_pinctrl *info)
  1106. {
  1107. struct pinctrl_desc *ctrldesc = &info->pctl;
  1108. struct pinctrl_pin_desc *pindesc, *pdesc;
  1109. struct rockchip_pin_bank *pin_bank;
  1110. int pin, bank, ret;
  1111. int k;
  1112. ctrldesc->name = "rockchip-pinctrl";
  1113. ctrldesc->owner = THIS_MODULE;
  1114. ctrldesc->pctlops = &rockchip_pctrl_ops;
  1115. ctrldesc->pmxops = &rockchip_pmx_ops;
  1116. ctrldesc->confops = &rockchip_pinconf_ops;
  1117. pindesc = devm_kzalloc(&pdev->dev, sizeof(*pindesc) *
  1118. info->ctrl->nr_pins, GFP_KERNEL);
  1119. if (!pindesc) {
  1120. dev_err(&pdev->dev, "mem alloc for pin descriptors failed\n");
  1121. return -ENOMEM;
  1122. }
  1123. ctrldesc->pins = pindesc;
  1124. ctrldesc->npins = info->ctrl->nr_pins;
  1125. pdesc = pindesc;
  1126. for (bank = 0 , k = 0; bank < info->ctrl->nr_banks; bank++) {
  1127. pin_bank = &info->ctrl->pin_banks[bank];
  1128. for (pin = 0; pin < pin_bank->nr_pins; pin++, k++) {
  1129. pdesc->number = k;
  1130. pdesc->name = kasprintf(GFP_KERNEL, "%s-%d",
  1131. pin_bank->name, pin);
  1132. pdesc++;
  1133. }
  1134. }
  1135. ret = rockchip_pinctrl_parse_dt(pdev, info);
  1136. if (ret)
  1137. return ret;
  1138. info->pctl_dev = pinctrl_register(ctrldesc, &pdev->dev, info);
  1139. if (IS_ERR(info->pctl_dev)) {
  1140. dev_err(&pdev->dev, "could not register pinctrl driver\n");
  1141. return PTR_ERR(info->pctl_dev);
  1142. }
  1143. for (bank = 0; bank < info->ctrl->nr_banks; ++bank) {
  1144. pin_bank = &info->ctrl->pin_banks[bank];
  1145. pin_bank->grange.name = pin_bank->name;
  1146. pin_bank->grange.id = bank;
  1147. pin_bank->grange.pin_base = pin_bank->pin_base;
  1148. pin_bank->grange.base = pin_bank->gpio_chip.base;
  1149. pin_bank->grange.npins = pin_bank->gpio_chip.ngpio;
  1150. pin_bank->grange.gc = &pin_bank->gpio_chip;
  1151. pinctrl_add_gpio_range(info->pctl_dev, &pin_bank->grange);
  1152. }
  1153. return 0;
  1154. }
  1155. /*
  1156. * GPIO handling
  1157. */
  1158. static int rockchip_gpio_request(struct gpio_chip *chip, unsigned offset)
  1159. {
  1160. return pinctrl_request_gpio(chip->base + offset);
  1161. }
  1162. static void rockchip_gpio_free(struct gpio_chip *chip, unsigned offset)
  1163. {
  1164. pinctrl_free_gpio(chip->base + offset);
  1165. }
  1166. static void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value)
  1167. {
  1168. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1169. void __iomem *reg = bank->reg_base + GPIO_SWPORT_DR;
  1170. unsigned long flags;
  1171. u32 data;
  1172. clk_enable(bank->clk);
  1173. spin_lock_irqsave(&bank->slock, flags);
  1174. data = readl(reg);
  1175. data &= ~BIT(offset);
  1176. if (value)
  1177. data |= BIT(offset);
  1178. writel(data, reg);
  1179. spin_unlock_irqrestore(&bank->slock, flags);
  1180. clk_disable(bank->clk);
  1181. }
  1182. /*
  1183. * Returns the level of the pin for input direction and setting of the DR
  1184. * register for output gpios.
  1185. */
  1186. static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset)
  1187. {
  1188. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1189. u32 data;
  1190. clk_enable(bank->clk);
  1191. data = readl(bank->reg_base + GPIO_EXT_PORT);
  1192. clk_disable(bank->clk);
  1193. data >>= offset;
  1194. data &= 1;
  1195. return data;
  1196. }
  1197. /*
  1198. * gpiolib gpio_direction_input callback function. The setting of the pin
  1199. * mux function as 'gpio input' will be handled by the pinctrl susbsystem
  1200. * interface.
  1201. */
  1202. static int rockchip_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
  1203. {
  1204. return pinctrl_gpio_direction_input(gc->base + offset);
  1205. }
  1206. /*
  1207. * gpiolib gpio_direction_output callback function. The setting of the pin
  1208. * mux function as 'gpio output' will be handled by the pinctrl susbsystem
  1209. * interface.
  1210. */
  1211. static int rockchip_gpio_direction_output(struct gpio_chip *gc,
  1212. unsigned offset, int value)
  1213. {
  1214. rockchip_gpio_set(gc, offset, value);
  1215. return pinctrl_gpio_direction_output(gc->base + offset);
  1216. }
  1217. /*
  1218. * gpiolib gpio_to_irq callback function. Creates a mapping between a GPIO pin
  1219. * and a virtual IRQ, if not already present.
  1220. */
  1221. static int rockchip_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
  1222. {
  1223. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1224. unsigned int virq;
  1225. if (!bank->domain)
  1226. return -ENXIO;
  1227. virq = irq_create_mapping(bank->domain, offset);
  1228. return (virq) ? : -ENXIO;
  1229. }
  1230. static const struct gpio_chip rockchip_gpiolib_chip = {
  1231. .request = rockchip_gpio_request,
  1232. .free = rockchip_gpio_free,
  1233. .set = rockchip_gpio_set,
  1234. .get = rockchip_gpio_get,
  1235. .direction_input = rockchip_gpio_direction_input,
  1236. .direction_output = rockchip_gpio_direction_output,
  1237. .to_irq = rockchip_gpio_to_irq,
  1238. .owner = THIS_MODULE,
  1239. };
  1240. /*
  1241. * Interrupt handling
  1242. */
  1243. static void rockchip_irq_demux(struct irq_desc *desc)
  1244. {
  1245. struct irq_chip *chip = irq_desc_get_chip(desc);
  1246. struct rockchip_pin_bank *bank = irq_desc_get_handler_data(desc);
  1247. u32 pend;
  1248. dev_dbg(bank->drvdata->dev, "got irq for bank %s\n", bank->name);
  1249. chained_irq_enter(chip, desc);
  1250. pend = readl_relaxed(bank->reg_base + GPIO_INT_STATUS);
  1251. while (pend) {
  1252. unsigned int irq, virq;
  1253. irq = __ffs(pend);
  1254. pend &= ~BIT(irq);
  1255. virq = irq_linear_revmap(bank->domain, irq);
  1256. if (!virq) {
  1257. dev_err(bank->drvdata->dev, "unmapped irq %d\n", irq);
  1258. continue;
  1259. }
  1260. dev_dbg(bank->drvdata->dev, "handling irq %d\n", irq);
  1261. /*
  1262. * Triggering IRQ on both rising and falling edge
  1263. * needs manual intervention.
  1264. */
  1265. if (bank->toggle_edge_mode & BIT(irq)) {
  1266. u32 data, data_old, polarity;
  1267. unsigned long flags;
  1268. data = readl_relaxed(bank->reg_base + GPIO_EXT_PORT);
  1269. do {
  1270. spin_lock_irqsave(&bank->slock, flags);
  1271. polarity = readl_relaxed(bank->reg_base +
  1272. GPIO_INT_POLARITY);
  1273. if (data & BIT(irq))
  1274. polarity &= ~BIT(irq);
  1275. else
  1276. polarity |= BIT(irq);
  1277. writel(polarity,
  1278. bank->reg_base + GPIO_INT_POLARITY);
  1279. spin_unlock_irqrestore(&bank->slock, flags);
  1280. data_old = data;
  1281. data = readl_relaxed(bank->reg_base +
  1282. GPIO_EXT_PORT);
  1283. } while ((data & BIT(irq)) != (data_old & BIT(irq)));
  1284. }
  1285. generic_handle_irq(virq);
  1286. }
  1287. chained_irq_exit(chip, desc);
  1288. }
  1289. static int rockchip_irq_set_type(struct irq_data *d, unsigned int type)
  1290. {
  1291. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1292. struct rockchip_pin_bank *bank = gc->private;
  1293. u32 mask = BIT(d->hwirq);
  1294. u32 polarity;
  1295. u32 level;
  1296. u32 data;
  1297. unsigned long flags;
  1298. int ret;
  1299. /* make sure the pin is configured as gpio input */
  1300. ret = rockchip_set_mux(bank, d->hwirq, RK_FUNC_GPIO);
  1301. if (ret < 0)
  1302. return ret;
  1303. clk_enable(bank->clk);
  1304. spin_lock_irqsave(&bank->slock, flags);
  1305. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  1306. data &= ~mask;
  1307. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  1308. spin_unlock_irqrestore(&bank->slock, flags);
  1309. if (type & IRQ_TYPE_EDGE_BOTH)
  1310. irq_set_handler_locked(d, handle_edge_irq);
  1311. else
  1312. irq_set_handler_locked(d, handle_level_irq);
  1313. spin_lock_irqsave(&bank->slock, flags);
  1314. irq_gc_lock(gc);
  1315. level = readl_relaxed(gc->reg_base + GPIO_INTTYPE_LEVEL);
  1316. polarity = readl_relaxed(gc->reg_base + GPIO_INT_POLARITY);
  1317. switch (type) {
  1318. case IRQ_TYPE_EDGE_BOTH:
  1319. bank->toggle_edge_mode |= mask;
  1320. level |= mask;
  1321. /*
  1322. * Determine gpio state. If 1 next interrupt should be falling
  1323. * otherwise rising.
  1324. */
  1325. data = readl(bank->reg_base + GPIO_EXT_PORT);
  1326. if (data & mask)
  1327. polarity &= ~mask;
  1328. else
  1329. polarity |= mask;
  1330. break;
  1331. case IRQ_TYPE_EDGE_RISING:
  1332. bank->toggle_edge_mode &= ~mask;
  1333. level |= mask;
  1334. polarity |= mask;
  1335. break;
  1336. case IRQ_TYPE_EDGE_FALLING:
  1337. bank->toggle_edge_mode &= ~mask;
  1338. level |= mask;
  1339. polarity &= ~mask;
  1340. break;
  1341. case IRQ_TYPE_LEVEL_HIGH:
  1342. bank->toggle_edge_mode &= ~mask;
  1343. level &= ~mask;
  1344. polarity |= mask;
  1345. break;
  1346. case IRQ_TYPE_LEVEL_LOW:
  1347. bank->toggle_edge_mode &= ~mask;
  1348. level &= ~mask;
  1349. polarity &= ~mask;
  1350. break;
  1351. default:
  1352. irq_gc_unlock(gc);
  1353. spin_unlock_irqrestore(&bank->slock, flags);
  1354. clk_disable(bank->clk);
  1355. return -EINVAL;
  1356. }
  1357. writel_relaxed(level, gc->reg_base + GPIO_INTTYPE_LEVEL);
  1358. writel_relaxed(polarity, gc->reg_base + GPIO_INT_POLARITY);
  1359. irq_gc_unlock(gc);
  1360. spin_unlock_irqrestore(&bank->slock, flags);
  1361. clk_disable(bank->clk);
  1362. return 0;
  1363. }
  1364. static void rockchip_irq_suspend(struct irq_data *d)
  1365. {
  1366. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1367. struct rockchip_pin_bank *bank = gc->private;
  1368. clk_enable(bank->clk);
  1369. bank->saved_masks = irq_reg_readl(gc, GPIO_INTMASK);
  1370. irq_reg_writel(gc, ~gc->wake_active, GPIO_INTMASK);
  1371. clk_disable(bank->clk);
  1372. }
  1373. static void rockchip_irq_resume(struct irq_data *d)
  1374. {
  1375. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1376. struct rockchip_pin_bank *bank = gc->private;
  1377. clk_enable(bank->clk);
  1378. irq_reg_writel(gc, bank->saved_masks, GPIO_INTMASK);
  1379. clk_disable(bank->clk);
  1380. }
  1381. static void rockchip_irq_gc_mask_clr_bit(struct irq_data *d)
  1382. {
  1383. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1384. struct rockchip_pin_bank *bank = gc->private;
  1385. clk_enable(bank->clk);
  1386. irq_gc_mask_clr_bit(d);
  1387. }
  1388. void rockchip_irq_gc_mask_set_bit(struct irq_data *d)
  1389. {
  1390. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1391. struct rockchip_pin_bank *bank = gc->private;
  1392. irq_gc_mask_set_bit(d);
  1393. clk_disable(bank->clk);
  1394. }
  1395. static int rockchip_interrupts_register(struct platform_device *pdev,
  1396. struct rockchip_pinctrl *info)
  1397. {
  1398. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1399. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1400. unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN;
  1401. struct irq_chip_generic *gc;
  1402. int ret;
  1403. int i, j;
  1404. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1405. if (!bank->valid) {
  1406. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1407. bank->name);
  1408. continue;
  1409. }
  1410. ret = clk_enable(bank->clk);
  1411. if (ret) {
  1412. dev_err(&pdev->dev, "failed to enable clock for bank %s\n",
  1413. bank->name);
  1414. continue;
  1415. }
  1416. bank->domain = irq_domain_add_linear(bank->of_node, 32,
  1417. &irq_generic_chip_ops, NULL);
  1418. if (!bank->domain) {
  1419. dev_warn(&pdev->dev, "could not initialize irq domain for bank %s\n",
  1420. bank->name);
  1421. clk_disable(bank->clk);
  1422. continue;
  1423. }
  1424. ret = irq_alloc_domain_generic_chips(bank->domain, 32, 1,
  1425. "rockchip_gpio_irq", handle_level_irq,
  1426. clr, 0, IRQ_GC_INIT_MASK_CACHE);
  1427. if (ret) {
  1428. dev_err(&pdev->dev, "could not alloc generic chips for bank %s\n",
  1429. bank->name);
  1430. irq_domain_remove(bank->domain);
  1431. clk_disable(bank->clk);
  1432. continue;
  1433. }
  1434. /*
  1435. * Linux assumes that all interrupts start out disabled/masked.
  1436. * Our driver only uses the concept of masked and always keeps
  1437. * things enabled, so for us that's all masked and all enabled.
  1438. */
  1439. writel_relaxed(0xffffffff, bank->reg_base + GPIO_INTMASK);
  1440. writel_relaxed(0xffffffff, bank->reg_base + GPIO_INTEN);
  1441. gc = irq_get_domain_generic_chip(bank->domain, 0);
  1442. gc->reg_base = bank->reg_base;
  1443. gc->private = bank;
  1444. gc->chip_types[0].regs.mask = GPIO_INTMASK;
  1445. gc->chip_types[0].regs.ack = GPIO_PORTS_EOI;
  1446. gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
  1447. gc->chip_types[0].chip.irq_mask = rockchip_irq_gc_mask_set_bit;
  1448. gc->chip_types[0].chip.irq_unmask =
  1449. rockchip_irq_gc_mask_clr_bit;
  1450. gc->chip_types[0].chip.irq_set_wake = irq_gc_set_wake;
  1451. gc->chip_types[0].chip.irq_suspend = rockchip_irq_suspend;
  1452. gc->chip_types[0].chip.irq_resume = rockchip_irq_resume;
  1453. gc->chip_types[0].chip.irq_set_type = rockchip_irq_set_type;
  1454. gc->wake_enabled = IRQ_MSK(bank->nr_pins);
  1455. irq_set_chained_handler_and_data(bank->irq,
  1456. rockchip_irq_demux, bank);
  1457. /* map the gpio irqs here, when the clock is still running */
  1458. for (j = 0 ; j < 32 ; j++)
  1459. irq_create_mapping(bank->domain, j);
  1460. clk_disable(bank->clk);
  1461. }
  1462. return 0;
  1463. }
  1464. static int rockchip_gpiolib_register(struct platform_device *pdev,
  1465. struct rockchip_pinctrl *info)
  1466. {
  1467. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1468. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1469. struct gpio_chip *gc;
  1470. int ret;
  1471. int i;
  1472. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1473. if (!bank->valid) {
  1474. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1475. bank->name);
  1476. continue;
  1477. }
  1478. bank->gpio_chip = rockchip_gpiolib_chip;
  1479. gc = &bank->gpio_chip;
  1480. gc->base = bank->pin_base;
  1481. gc->ngpio = bank->nr_pins;
  1482. gc->dev = &pdev->dev;
  1483. gc->of_node = bank->of_node;
  1484. gc->label = bank->name;
  1485. ret = gpiochip_add(gc);
  1486. if (ret) {
  1487. dev_err(&pdev->dev, "failed to register gpio_chip %s, error code: %d\n",
  1488. gc->label, ret);
  1489. goto fail;
  1490. }
  1491. }
  1492. rockchip_interrupts_register(pdev, info);
  1493. return 0;
  1494. fail:
  1495. for (--i, --bank; i >= 0; --i, --bank) {
  1496. if (!bank->valid)
  1497. continue;
  1498. gpiochip_remove(&bank->gpio_chip);
  1499. }
  1500. return ret;
  1501. }
  1502. static int rockchip_gpiolib_unregister(struct platform_device *pdev,
  1503. struct rockchip_pinctrl *info)
  1504. {
  1505. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1506. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1507. int i;
  1508. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1509. if (!bank->valid)
  1510. continue;
  1511. gpiochip_remove(&bank->gpio_chip);
  1512. }
  1513. return 0;
  1514. }
  1515. static int rockchip_get_bank_data(struct rockchip_pin_bank *bank,
  1516. struct rockchip_pinctrl *info)
  1517. {
  1518. struct resource res;
  1519. void __iomem *base;
  1520. if (of_address_to_resource(bank->of_node, 0, &res)) {
  1521. dev_err(info->dev, "cannot find IO resource for bank\n");
  1522. return -ENOENT;
  1523. }
  1524. bank->reg_base = devm_ioremap_resource(info->dev, &res);
  1525. if (IS_ERR(bank->reg_base))
  1526. return PTR_ERR(bank->reg_base);
  1527. /*
  1528. * special case, where parts of the pull setting-registers are
  1529. * part of the PMU register space
  1530. */
  1531. if (of_device_is_compatible(bank->of_node,
  1532. "rockchip,rk3188-gpio-bank0")) {
  1533. struct device_node *node;
  1534. node = of_parse_phandle(bank->of_node->parent,
  1535. "rockchip,pmu", 0);
  1536. if (!node) {
  1537. if (of_address_to_resource(bank->of_node, 1, &res)) {
  1538. dev_err(info->dev, "cannot find IO resource for bank\n");
  1539. return -ENOENT;
  1540. }
  1541. base = devm_ioremap_resource(info->dev, &res);
  1542. if (IS_ERR(base))
  1543. return PTR_ERR(base);
  1544. rockchip_regmap_config.max_register =
  1545. resource_size(&res) - 4;
  1546. rockchip_regmap_config.name =
  1547. "rockchip,rk3188-gpio-bank0-pull";
  1548. bank->regmap_pull = devm_regmap_init_mmio(info->dev,
  1549. base,
  1550. &rockchip_regmap_config);
  1551. }
  1552. }
  1553. bank->irq = irq_of_parse_and_map(bank->of_node, 0);
  1554. bank->clk = of_clk_get(bank->of_node, 0);
  1555. if (IS_ERR(bank->clk))
  1556. return PTR_ERR(bank->clk);
  1557. return clk_prepare(bank->clk);
  1558. }
  1559. static const struct of_device_id rockchip_pinctrl_dt_match[];
  1560. /* retrieve the soc specific data */
  1561. static struct rockchip_pin_ctrl *rockchip_pinctrl_get_soc_data(
  1562. struct rockchip_pinctrl *d,
  1563. struct platform_device *pdev)
  1564. {
  1565. const struct of_device_id *match;
  1566. struct device_node *node = pdev->dev.of_node;
  1567. struct device_node *np;
  1568. struct rockchip_pin_ctrl *ctrl;
  1569. struct rockchip_pin_bank *bank;
  1570. int grf_offs, pmu_offs, i, j;
  1571. match = of_match_node(rockchip_pinctrl_dt_match, node);
  1572. ctrl = (struct rockchip_pin_ctrl *)match->data;
  1573. for_each_child_of_node(node, np) {
  1574. if (!of_find_property(np, "gpio-controller", NULL))
  1575. continue;
  1576. bank = ctrl->pin_banks;
  1577. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1578. if (!strcmp(bank->name, np->name)) {
  1579. bank->of_node = np;
  1580. if (!rockchip_get_bank_data(bank, d))
  1581. bank->valid = true;
  1582. break;
  1583. }
  1584. }
  1585. }
  1586. grf_offs = ctrl->grf_mux_offset;
  1587. pmu_offs = ctrl->pmu_mux_offset;
  1588. bank = ctrl->pin_banks;
  1589. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1590. int bank_pins = 0;
  1591. spin_lock_init(&bank->slock);
  1592. bank->drvdata = d;
  1593. bank->pin_base = ctrl->nr_pins;
  1594. ctrl->nr_pins += bank->nr_pins;
  1595. /* calculate iomux offsets */
  1596. for (j = 0; j < 4; j++) {
  1597. struct rockchip_iomux *iom = &bank->iomux[j];
  1598. int inc;
  1599. if (bank_pins >= bank->nr_pins)
  1600. break;
  1601. /* preset offset value, set new start value */
  1602. if (iom->offset >= 0) {
  1603. if (iom->type & IOMUX_SOURCE_PMU)
  1604. pmu_offs = iom->offset;
  1605. else
  1606. grf_offs = iom->offset;
  1607. } else { /* set current offset */
  1608. iom->offset = (iom->type & IOMUX_SOURCE_PMU) ?
  1609. pmu_offs : grf_offs;
  1610. }
  1611. dev_dbg(d->dev, "bank %d, iomux %d has offset 0x%x\n",
  1612. i, j, iom->offset);
  1613. /*
  1614. * Increase offset according to iomux width.
  1615. * 4bit iomux'es are spread over two registers.
  1616. */
  1617. inc = (iom->type & IOMUX_WIDTH_4BIT) ? 8 : 4;
  1618. if (iom->type & IOMUX_SOURCE_PMU)
  1619. pmu_offs += inc;
  1620. else
  1621. grf_offs += inc;
  1622. bank_pins += 8;
  1623. }
  1624. }
  1625. return ctrl;
  1626. }
  1627. #define RK3288_GRF_GPIO6C_IOMUX 0x64
  1628. #define GPIO6C6_SEL_WRITE_ENABLE BIT(28)
  1629. static u32 rk3288_grf_gpio6c_iomux;
  1630. static int __maybe_unused rockchip_pinctrl_suspend(struct device *dev)
  1631. {
  1632. struct rockchip_pinctrl *info = dev_get_drvdata(dev);
  1633. int ret = pinctrl_force_sleep(info->pctl_dev);
  1634. if (ret)
  1635. return ret;
  1636. /*
  1637. * RK3288 GPIO6_C6 mux would be modified by Maskrom when resume, so save
  1638. * the setting here, and restore it at resume.
  1639. */
  1640. if (info->ctrl->type == RK3288) {
  1641. ret = regmap_read(info->regmap_base, RK3288_GRF_GPIO6C_IOMUX,
  1642. &rk3288_grf_gpio6c_iomux);
  1643. if (ret) {
  1644. pinctrl_force_default(info->pctl_dev);
  1645. return ret;
  1646. }
  1647. }
  1648. return 0;
  1649. }
  1650. static int __maybe_unused rockchip_pinctrl_resume(struct device *dev)
  1651. {
  1652. struct rockchip_pinctrl *info = dev_get_drvdata(dev);
  1653. int ret = regmap_write(info->regmap_base, RK3288_GRF_GPIO6C_IOMUX,
  1654. rk3288_grf_gpio6c_iomux |
  1655. GPIO6C6_SEL_WRITE_ENABLE);
  1656. if (ret)
  1657. return ret;
  1658. return pinctrl_force_default(info->pctl_dev);
  1659. }
  1660. static SIMPLE_DEV_PM_OPS(rockchip_pinctrl_dev_pm_ops, rockchip_pinctrl_suspend,
  1661. rockchip_pinctrl_resume);
  1662. static int rockchip_pinctrl_probe(struct platform_device *pdev)
  1663. {
  1664. struct rockchip_pinctrl *info;
  1665. struct device *dev = &pdev->dev;
  1666. struct rockchip_pin_ctrl *ctrl;
  1667. struct device_node *np = pdev->dev.of_node, *node;
  1668. struct resource *res;
  1669. void __iomem *base;
  1670. int ret;
  1671. if (!dev->of_node) {
  1672. dev_err(dev, "device tree node not found\n");
  1673. return -ENODEV;
  1674. }
  1675. info = devm_kzalloc(dev, sizeof(struct rockchip_pinctrl), GFP_KERNEL);
  1676. if (!info)
  1677. return -ENOMEM;
  1678. info->dev = dev;
  1679. ctrl = rockchip_pinctrl_get_soc_data(info, pdev);
  1680. if (!ctrl) {
  1681. dev_err(dev, "driver data not available\n");
  1682. return -EINVAL;
  1683. }
  1684. info->ctrl = ctrl;
  1685. node = of_parse_phandle(np, "rockchip,grf", 0);
  1686. if (node) {
  1687. info->regmap_base = syscon_node_to_regmap(node);
  1688. if (IS_ERR(info->regmap_base))
  1689. return PTR_ERR(info->regmap_base);
  1690. } else {
  1691. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1692. base = devm_ioremap_resource(&pdev->dev, res);
  1693. if (IS_ERR(base))
  1694. return PTR_ERR(base);
  1695. rockchip_regmap_config.max_register = resource_size(res) - 4;
  1696. rockchip_regmap_config.name = "rockchip,pinctrl";
  1697. info->regmap_base = devm_regmap_init_mmio(&pdev->dev, base,
  1698. &rockchip_regmap_config);
  1699. /* to check for the old dt-bindings */
  1700. info->reg_size = resource_size(res);
  1701. /* Honor the old binding, with pull registers as 2nd resource */
  1702. if (ctrl->type == RK3188 && info->reg_size < 0x200) {
  1703. res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  1704. base = devm_ioremap_resource(&pdev->dev, res);
  1705. if (IS_ERR(base))
  1706. return PTR_ERR(base);
  1707. rockchip_regmap_config.max_register =
  1708. resource_size(res) - 4;
  1709. rockchip_regmap_config.name = "rockchip,pinctrl-pull";
  1710. info->regmap_pull = devm_regmap_init_mmio(&pdev->dev,
  1711. base,
  1712. &rockchip_regmap_config);
  1713. }
  1714. }
  1715. /* try to find the optional reference to the pmu syscon */
  1716. node = of_parse_phandle(np, "rockchip,pmu", 0);
  1717. if (node) {
  1718. info->regmap_pmu = syscon_node_to_regmap(node);
  1719. if (IS_ERR(info->regmap_pmu))
  1720. return PTR_ERR(info->regmap_pmu);
  1721. }
  1722. ret = rockchip_gpiolib_register(pdev, info);
  1723. if (ret)
  1724. return ret;
  1725. ret = rockchip_pinctrl_register(pdev, info);
  1726. if (ret) {
  1727. rockchip_gpiolib_unregister(pdev, info);
  1728. return ret;
  1729. }
  1730. platform_set_drvdata(pdev, info);
  1731. return 0;
  1732. }
  1733. static struct rockchip_pin_bank rk2928_pin_banks[] = {
  1734. PIN_BANK(0, 32, "gpio0"),
  1735. PIN_BANK(1, 32, "gpio1"),
  1736. PIN_BANK(2, 32, "gpio2"),
  1737. PIN_BANK(3, 32, "gpio3"),
  1738. };
  1739. static struct rockchip_pin_ctrl rk2928_pin_ctrl = {
  1740. .pin_banks = rk2928_pin_banks,
  1741. .nr_banks = ARRAY_SIZE(rk2928_pin_banks),
  1742. .label = "RK2928-GPIO",
  1743. .type = RK2928,
  1744. .grf_mux_offset = 0xa8,
  1745. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1746. };
  1747. static struct rockchip_pin_bank rk3066a_pin_banks[] = {
  1748. PIN_BANK(0, 32, "gpio0"),
  1749. PIN_BANK(1, 32, "gpio1"),
  1750. PIN_BANK(2, 32, "gpio2"),
  1751. PIN_BANK(3, 32, "gpio3"),
  1752. PIN_BANK(4, 32, "gpio4"),
  1753. PIN_BANK(6, 16, "gpio6"),
  1754. };
  1755. static struct rockchip_pin_ctrl rk3066a_pin_ctrl = {
  1756. .pin_banks = rk3066a_pin_banks,
  1757. .nr_banks = ARRAY_SIZE(rk3066a_pin_banks),
  1758. .label = "RK3066a-GPIO",
  1759. .type = RK2928,
  1760. .grf_mux_offset = 0xa8,
  1761. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1762. };
  1763. static struct rockchip_pin_bank rk3066b_pin_banks[] = {
  1764. PIN_BANK(0, 32, "gpio0"),
  1765. PIN_BANK(1, 32, "gpio1"),
  1766. PIN_BANK(2, 32, "gpio2"),
  1767. PIN_BANK(3, 32, "gpio3"),
  1768. };
  1769. static struct rockchip_pin_ctrl rk3066b_pin_ctrl = {
  1770. .pin_banks = rk3066b_pin_banks,
  1771. .nr_banks = ARRAY_SIZE(rk3066b_pin_banks),
  1772. .label = "RK3066b-GPIO",
  1773. .type = RK3066B,
  1774. .grf_mux_offset = 0x60,
  1775. };
  1776. static struct rockchip_pin_bank rk3188_pin_banks[] = {
  1777. PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_GPIO_ONLY, 0, 0, 0),
  1778. PIN_BANK(1, 32, "gpio1"),
  1779. PIN_BANK(2, 32, "gpio2"),
  1780. PIN_BANK(3, 32, "gpio3"),
  1781. };
  1782. static struct rockchip_pin_ctrl rk3188_pin_ctrl = {
  1783. .pin_banks = rk3188_pin_banks,
  1784. .nr_banks = ARRAY_SIZE(rk3188_pin_banks),
  1785. .label = "RK3188-GPIO",
  1786. .type = RK3188,
  1787. .grf_mux_offset = 0x60,
  1788. .pull_calc_reg = rk3188_calc_pull_reg_and_bit,
  1789. };
  1790. static struct rockchip_pin_bank rk3288_pin_banks[] = {
  1791. PIN_BANK_IOMUX_FLAGS(0, 24, "gpio0", IOMUX_SOURCE_PMU,
  1792. IOMUX_SOURCE_PMU,
  1793. IOMUX_SOURCE_PMU,
  1794. IOMUX_UNROUTED
  1795. ),
  1796. PIN_BANK_IOMUX_FLAGS(1, 32, "gpio1", IOMUX_UNROUTED,
  1797. IOMUX_UNROUTED,
  1798. IOMUX_UNROUTED,
  1799. 0
  1800. ),
  1801. PIN_BANK_IOMUX_FLAGS(2, 32, "gpio2", 0, 0, 0, IOMUX_UNROUTED),
  1802. PIN_BANK_IOMUX_FLAGS(3, 32, "gpio3", 0, 0, 0, IOMUX_WIDTH_4BIT),
  1803. PIN_BANK_IOMUX_FLAGS(4, 32, "gpio4", IOMUX_WIDTH_4BIT,
  1804. IOMUX_WIDTH_4BIT,
  1805. 0,
  1806. 0
  1807. ),
  1808. PIN_BANK_IOMUX_FLAGS(5, 32, "gpio5", IOMUX_UNROUTED,
  1809. 0,
  1810. 0,
  1811. IOMUX_UNROUTED
  1812. ),
  1813. PIN_BANK_IOMUX_FLAGS(6, 32, "gpio6", 0, 0, 0, IOMUX_UNROUTED),
  1814. PIN_BANK_IOMUX_FLAGS(7, 32, "gpio7", 0,
  1815. 0,
  1816. IOMUX_WIDTH_4BIT,
  1817. IOMUX_UNROUTED
  1818. ),
  1819. PIN_BANK(8, 16, "gpio8"),
  1820. };
  1821. static struct rockchip_pin_ctrl rk3288_pin_ctrl = {
  1822. .pin_banks = rk3288_pin_banks,
  1823. .nr_banks = ARRAY_SIZE(rk3288_pin_banks),
  1824. .label = "RK3288-GPIO",
  1825. .type = RK3288,
  1826. .grf_mux_offset = 0x0,
  1827. .pmu_mux_offset = 0x84,
  1828. .pull_calc_reg = rk3288_calc_pull_reg_and_bit,
  1829. .drv_calc_reg = rk3288_calc_drv_reg_and_bit,
  1830. };
  1831. static struct rockchip_pin_bank rk3368_pin_banks[] = {
  1832. PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU,
  1833. IOMUX_SOURCE_PMU,
  1834. IOMUX_SOURCE_PMU,
  1835. IOMUX_SOURCE_PMU
  1836. ),
  1837. PIN_BANK(1, 32, "gpio1"),
  1838. PIN_BANK(2, 32, "gpio2"),
  1839. PIN_BANK(3, 32, "gpio3"),
  1840. };
  1841. static struct rockchip_pin_ctrl rk3368_pin_ctrl = {
  1842. .pin_banks = rk3368_pin_banks,
  1843. .nr_banks = ARRAY_SIZE(rk3368_pin_banks),
  1844. .label = "RK3368-GPIO",
  1845. .type = RK3368,
  1846. .grf_mux_offset = 0x0,
  1847. .pmu_mux_offset = 0x0,
  1848. .pull_calc_reg = rk3368_calc_pull_reg_and_bit,
  1849. .drv_calc_reg = rk3368_calc_drv_reg_and_bit,
  1850. };
  1851. static const struct of_device_id rockchip_pinctrl_dt_match[] = {
  1852. { .compatible = "rockchip,rk2928-pinctrl",
  1853. .data = (void *)&rk2928_pin_ctrl },
  1854. { .compatible = "rockchip,rk3066a-pinctrl",
  1855. .data = (void *)&rk3066a_pin_ctrl },
  1856. { .compatible = "rockchip,rk3066b-pinctrl",
  1857. .data = (void *)&rk3066b_pin_ctrl },
  1858. { .compatible = "rockchip,rk3188-pinctrl",
  1859. .data = (void *)&rk3188_pin_ctrl },
  1860. { .compatible = "rockchip,rk3288-pinctrl",
  1861. .data = (void *)&rk3288_pin_ctrl },
  1862. { .compatible = "rockchip,rk3368-pinctrl",
  1863. .data = (void *)&rk3368_pin_ctrl },
  1864. {},
  1865. };
  1866. MODULE_DEVICE_TABLE(of, rockchip_pinctrl_dt_match);
  1867. static struct platform_driver rockchip_pinctrl_driver = {
  1868. .probe = rockchip_pinctrl_probe,
  1869. .driver = {
  1870. .name = "rockchip-pinctrl",
  1871. .pm = &rockchip_pinctrl_dev_pm_ops,
  1872. .of_match_table = rockchip_pinctrl_dt_match,
  1873. },
  1874. };
  1875. static int __init rockchip_pinctrl_drv_register(void)
  1876. {
  1877. return platform_driver_register(&rockchip_pinctrl_driver);
  1878. }
  1879. postcore_initcall(rockchip_pinctrl_drv_register);
  1880. MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
  1881. MODULE_DESCRIPTION("Rockchip pinctrl driver");
  1882. MODULE_LICENSE("GPL v2");