pinctrl-rockchip.c 57 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248
  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 void rockchip_gpio_set(struct gpio_chip *gc, unsigned offset, int value)
  1159. {
  1160. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1161. void __iomem *reg = bank->reg_base + GPIO_SWPORT_DR;
  1162. unsigned long flags;
  1163. u32 data;
  1164. clk_enable(bank->clk);
  1165. spin_lock_irqsave(&bank->slock, flags);
  1166. data = readl(reg);
  1167. data &= ~BIT(offset);
  1168. if (value)
  1169. data |= BIT(offset);
  1170. writel(data, reg);
  1171. spin_unlock_irqrestore(&bank->slock, flags);
  1172. clk_disable(bank->clk);
  1173. }
  1174. /*
  1175. * Returns the level of the pin for input direction and setting of the DR
  1176. * register for output gpios.
  1177. */
  1178. static int rockchip_gpio_get(struct gpio_chip *gc, unsigned offset)
  1179. {
  1180. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1181. u32 data;
  1182. clk_enable(bank->clk);
  1183. data = readl(bank->reg_base + GPIO_EXT_PORT);
  1184. clk_disable(bank->clk);
  1185. data >>= offset;
  1186. data &= 1;
  1187. return data;
  1188. }
  1189. /*
  1190. * gpiolib gpio_direction_input callback function. The setting of the pin
  1191. * mux function as 'gpio input' will be handled by the pinctrl susbsystem
  1192. * interface.
  1193. */
  1194. static int rockchip_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
  1195. {
  1196. return pinctrl_gpio_direction_input(gc->base + offset);
  1197. }
  1198. /*
  1199. * gpiolib gpio_direction_output callback function. The setting of the pin
  1200. * mux function as 'gpio output' will be handled by the pinctrl susbsystem
  1201. * interface.
  1202. */
  1203. static int rockchip_gpio_direction_output(struct gpio_chip *gc,
  1204. unsigned offset, int value)
  1205. {
  1206. rockchip_gpio_set(gc, offset, value);
  1207. return pinctrl_gpio_direction_output(gc->base + offset);
  1208. }
  1209. /*
  1210. * gpiolib gpio_to_irq callback function. Creates a mapping between a GPIO pin
  1211. * and a virtual IRQ, if not already present.
  1212. */
  1213. static int rockchip_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
  1214. {
  1215. struct rockchip_pin_bank *bank = gc_to_pin_bank(gc);
  1216. unsigned int virq;
  1217. if (!bank->domain)
  1218. return -ENXIO;
  1219. virq = irq_create_mapping(bank->domain, offset);
  1220. return (virq) ? : -ENXIO;
  1221. }
  1222. static const struct gpio_chip rockchip_gpiolib_chip = {
  1223. .request = gpiochip_generic_request,
  1224. .free = gpiochip_generic_free,
  1225. .set = rockchip_gpio_set,
  1226. .get = rockchip_gpio_get,
  1227. .direction_input = rockchip_gpio_direction_input,
  1228. .direction_output = rockchip_gpio_direction_output,
  1229. .to_irq = rockchip_gpio_to_irq,
  1230. .owner = THIS_MODULE,
  1231. };
  1232. /*
  1233. * Interrupt handling
  1234. */
  1235. static void rockchip_irq_demux(struct irq_desc *desc)
  1236. {
  1237. struct irq_chip *chip = irq_desc_get_chip(desc);
  1238. struct rockchip_pin_bank *bank = irq_desc_get_handler_data(desc);
  1239. u32 pend;
  1240. dev_dbg(bank->drvdata->dev, "got irq for bank %s\n", bank->name);
  1241. chained_irq_enter(chip, desc);
  1242. pend = readl_relaxed(bank->reg_base + GPIO_INT_STATUS);
  1243. while (pend) {
  1244. unsigned int irq, virq;
  1245. irq = __ffs(pend);
  1246. pend &= ~BIT(irq);
  1247. virq = irq_linear_revmap(bank->domain, irq);
  1248. if (!virq) {
  1249. dev_err(bank->drvdata->dev, "unmapped irq %d\n", irq);
  1250. continue;
  1251. }
  1252. dev_dbg(bank->drvdata->dev, "handling irq %d\n", irq);
  1253. /*
  1254. * Triggering IRQ on both rising and falling edge
  1255. * needs manual intervention.
  1256. */
  1257. if (bank->toggle_edge_mode & BIT(irq)) {
  1258. u32 data, data_old, polarity;
  1259. unsigned long flags;
  1260. data = readl_relaxed(bank->reg_base + GPIO_EXT_PORT);
  1261. do {
  1262. spin_lock_irqsave(&bank->slock, flags);
  1263. polarity = readl_relaxed(bank->reg_base +
  1264. GPIO_INT_POLARITY);
  1265. if (data & BIT(irq))
  1266. polarity &= ~BIT(irq);
  1267. else
  1268. polarity |= BIT(irq);
  1269. writel(polarity,
  1270. bank->reg_base + GPIO_INT_POLARITY);
  1271. spin_unlock_irqrestore(&bank->slock, flags);
  1272. data_old = data;
  1273. data = readl_relaxed(bank->reg_base +
  1274. GPIO_EXT_PORT);
  1275. } while ((data & BIT(irq)) != (data_old & BIT(irq)));
  1276. }
  1277. generic_handle_irq(virq);
  1278. }
  1279. chained_irq_exit(chip, desc);
  1280. }
  1281. static int rockchip_irq_set_type(struct irq_data *d, unsigned int type)
  1282. {
  1283. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1284. struct rockchip_pin_bank *bank = gc->private;
  1285. u32 mask = BIT(d->hwirq);
  1286. u32 polarity;
  1287. u32 level;
  1288. u32 data;
  1289. unsigned long flags;
  1290. int ret;
  1291. /* make sure the pin is configured as gpio input */
  1292. ret = rockchip_set_mux(bank, d->hwirq, RK_FUNC_GPIO);
  1293. if (ret < 0)
  1294. return ret;
  1295. clk_enable(bank->clk);
  1296. spin_lock_irqsave(&bank->slock, flags);
  1297. data = readl_relaxed(bank->reg_base + GPIO_SWPORT_DDR);
  1298. data &= ~mask;
  1299. writel_relaxed(data, bank->reg_base + GPIO_SWPORT_DDR);
  1300. spin_unlock_irqrestore(&bank->slock, flags);
  1301. if (type & IRQ_TYPE_EDGE_BOTH)
  1302. irq_set_handler_locked(d, handle_edge_irq);
  1303. else
  1304. irq_set_handler_locked(d, handle_level_irq);
  1305. spin_lock_irqsave(&bank->slock, flags);
  1306. irq_gc_lock(gc);
  1307. level = readl_relaxed(gc->reg_base + GPIO_INTTYPE_LEVEL);
  1308. polarity = readl_relaxed(gc->reg_base + GPIO_INT_POLARITY);
  1309. switch (type) {
  1310. case IRQ_TYPE_EDGE_BOTH:
  1311. bank->toggle_edge_mode |= mask;
  1312. level |= mask;
  1313. /*
  1314. * Determine gpio state. If 1 next interrupt should be falling
  1315. * otherwise rising.
  1316. */
  1317. data = readl(bank->reg_base + GPIO_EXT_PORT);
  1318. if (data & mask)
  1319. polarity &= ~mask;
  1320. else
  1321. polarity |= mask;
  1322. break;
  1323. case IRQ_TYPE_EDGE_RISING:
  1324. bank->toggle_edge_mode &= ~mask;
  1325. level |= mask;
  1326. polarity |= mask;
  1327. break;
  1328. case IRQ_TYPE_EDGE_FALLING:
  1329. bank->toggle_edge_mode &= ~mask;
  1330. level |= mask;
  1331. polarity &= ~mask;
  1332. break;
  1333. case IRQ_TYPE_LEVEL_HIGH:
  1334. bank->toggle_edge_mode &= ~mask;
  1335. level &= ~mask;
  1336. polarity |= mask;
  1337. break;
  1338. case IRQ_TYPE_LEVEL_LOW:
  1339. bank->toggle_edge_mode &= ~mask;
  1340. level &= ~mask;
  1341. polarity &= ~mask;
  1342. break;
  1343. default:
  1344. irq_gc_unlock(gc);
  1345. spin_unlock_irqrestore(&bank->slock, flags);
  1346. clk_disable(bank->clk);
  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. clk_disable(bank->clk);
  1354. return 0;
  1355. }
  1356. static void rockchip_irq_suspend(struct irq_data *d)
  1357. {
  1358. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1359. struct rockchip_pin_bank *bank = gc->private;
  1360. clk_enable(bank->clk);
  1361. bank->saved_masks = irq_reg_readl(gc, GPIO_INTMASK);
  1362. irq_reg_writel(gc, ~gc->wake_active, GPIO_INTMASK);
  1363. clk_disable(bank->clk);
  1364. }
  1365. static void rockchip_irq_resume(struct irq_data *d)
  1366. {
  1367. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1368. struct rockchip_pin_bank *bank = gc->private;
  1369. clk_enable(bank->clk);
  1370. irq_reg_writel(gc, bank->saved_masks, GPIO_INTMASK);
  1371. clk_disable(bank->clk);
  1372. }
  1373. static void rockchip_irq_gc_mask_clr_bit(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_gc_mask_clr_bit(d);
  1379. }
  1380. void rockchip_irq_gc_mask_set_bit(struct irq_data *d)
  1381. {
  1382. struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
  1383. struct rockchip_pin_bank *bank = gc->private;
  1384. irq_gc_mask_set_bit(d);
  1385. clk_disable(bank->clk);
  1386. }
  1387. static int rockchip_interrupts_register(struct platform_device *pdev,
  1388. struct rockchip_pinctrl *info)
  1389. {
  1390. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1391. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1392. unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN;
  1393. struct irq_chip_generic *gc;
  1394. int ret;
  1395. int i, j;
  1396. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1397. if (!bank->valid) {
  1398. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1399. bank->name);
  1400. continue;
  1401. }
  1402. ret = clk_enable(bank->clk);
  1403. if (ret) {
  1404. dev_err(&pdev->dev, "failed to enable clock for bank %s\n",
  1405. bank->name);
  1406. continue;
  1407. }
  1408. bank->domain = irq_domain_add_linear(bank->of_node, 32,
  1409. &irq_generic_chip_ops, NULL);
  1410. if (!bank->domain) {
  1411. dev_warn(&pdev->dev, "could not initialize irq domain for bank %s\n",
  1412. bank->name);
  1413. clk_disable(bank->clk);
  1414. continue;
  1415. }
  1416. ret = irq_alloc_domain_generic_chips(bank->domain, 32, 1,
  1417. "rockchip_gpio_irq", handle_level_irq,
  1418. clr, 0, IRQ_GC_INIT_MASK_CACHE);
  1419. if (ret) {
  1420. dev_err(&pdev->dev, "could not alloc generic chips for bank %s\n",
  1421. bank->name);
  1422. irq_domain_remove(bank->domain);
  1423. clk_disable(bank->clk);
  1424. continue;
  1425. }
  1426. /*
  1427. * Linux assumes that all interrupts start out disabled/masked.
  1428. * Our driver only uses the concept of masked and always keeps
  1429. * things enabled, so for us that's all masked and all enabled.
  1430. */
  1431. writel_relaxed(0xffffffff, bank->reg_base + GPIO_INTMASK);
  1432. writel_relaxed(0xffffffff, bank->reg_base + GPIO_INTEN);
  1433. gc = irq_get_domain_generic_chip(bank->domain, 0);
  1434. gc->reg_base = bank->reg_base;
  1435. gc->private = bank;
  1436. gc->chip_types[0].regs.mask = GPIO_INTMASK;
  1437. gc->chip_types[0].regs.ack = GPIO_PORTS_EOI;
  1438. gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
  1439. gc->chip_types[0].chip.irq_mask = rockchip_irq_gc_mask_set_bit;
  1440. gc->chip_types[0].chip.irq_unmask =
  1441. rockchip_irq_gc_mask_clr_bit;
  1442. gc->chip_types[0].chip.irq_set_wake = irq_gc_set_wake;
  1443. gc->chip_types[0].chip.irq_suspend = rockchip_irq_suspend;
  1444. gc->chip_types[0].chip.irq_resume = rockchip_irq_resume;
  1445. gc->chip_types[0].chip.irq_set_type = rockchip_irq_set_type;
  1446. gc->wake_enabled = IRQ_MSK(bank->nr_pins);
  1447. irq_set_chained_handler_and_data(bank->irq,
  1448. rockchip_irq_demux, bank);
  1449. /* map the gpio irqs here, when the clock is still running */
  1450. for (j = 0 ; j < 32 ; j++)
  1451. irq_create_mapping(bank->domain, j);
  1452. clk_disable(bank->clk);
  1453. }
  1454. return 0;
  1455. }
  1456. static int rockchip_gpiolib_register(struct platform_device *pdev,
  1457. struct rockchip_pinctrl *info)
  1458. {
  1459. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1460. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1461. struct gpio_chip *gc;
  1462. int ret;
  1463. int i;
  1464. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1465. if (!bank->valid) {
  1466. dev_warn(&pdev->dev, "bank %s is not valid\n",
  1467. bank->name);
  1468. continue;
  1469. }
  1470. bank->gpio_chip = rockchip_gpiolib_chip;
  1471. gc = &bank->gpio_chip;
  1472. gc->base = bank->pin_base;
  1473. gc->ngpio = bank->nr_pins;
  1474. gc->dev = &pdev->dev;
  1475. gc->of_node = bank->of_node;
  1476. gc->label = bank->name;
  1477. ret = gpiochip_add(gc);
  1478. if (ret) {
  1479. dev_err(&pdev->dev, "failed to register gpio_chip %s, error code: %d\n",
  1480. gc->label, ret);
  1481. goto fail;
  1482. }
  1483. }
  1484. rockchip_interrupts_register(pdev, info);
  1485. return 0;
  1486. fail:
  1487. for (--i, --bank; i >= 0; --i, --bank) {
  1488. if (!bank->valid)
  1489. continue;
  1490. gpiochip_remove(&bank->gpio_chip);
  1491. }
  1492. return ret;
  1493. }
  1494. static int rockchip_gpiolib_unregister(struct platform_device *pdev,
  1495. struct rockchip_pinctrl *info)
  1496. {
  1497. struct rockchip_pin_ctrl *ctrl = info->ctrl;
  1498. struct rockchip_pin_bank *bank = ctrl->pin_banks;
  1499. int i;
  1500. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1501. if (!bank->valid)
  1502. continue;
  1503. gpiochip_remove(&bank->gpio_chip);
  1504. }
  1505. return 0;
  1506. }
  1507. static int rockchip_get_bank_data(struct rockchip_pin_bank *bank,
  1508. struct rockchip_pinctrl *info)
  1509. {
  1510. struct resource res;
  1511. void __iomem *base;
  1512. if (of_address_to_resource(bank->of_node, 0, &res)) {
  1513. dev_err(info->dev, "cannot find IO resource for bank\n");
  1514. return -ENOENT;
  1515. }
  1516. bank->reg_base = devm_ioremap_resource(info->dev, &res);
  1517. if (IS_ERR(bank->reg_base))
  1518. return PTR_ERR(bank->reg_base);
  1519. /*
  1520. * special case, where parts of the pull setting-registers are
  1521. * part of the PMU register space
  1522. */
  1523. if (of_device_is_compatible(bank->of_node,
  1524. "rockchip,rk3188-gpio-bank0")) {
  1525. struct device_node *node;
  1526. node = of_parse_phandle(bank->of_node->parent,
  1527. "rockchip,pmu", 0);
  1528. if (!node) {
  1529. if (of_address_to_resource(bank->of_node, 1, &res)) {
  1530. dev_err(info->dev, "cannot find IO resource for bank\n");
  1531. return -ENOENT;
  1532. }
  1533. base = devm_ioremap_resource(info->dev, &res);
  1534. if (IS_ERR(base))
  1535. return PTR_ERR(base);
  1536. rockchip_regmap_config.max_register =
  1537. resource_size(&res) - 4;
  1538. rockchip_regmap_config.name =
  1539. "rockchip,rk3188-gpio-bank0-pull";
  1540. bank->regmap_pull = devm_regmap_init_mmio(info->dev,
  1541. base,
  1542. &rockchip_regmap_config);
  1543. }
  1544. }
  1545. bank->irq = irq_of_parse_and_map(bank->of_node, 0);
  1546. bank->clk = of_clk_get(bank->of_node, 0);
  1547. if (IS_ERR(bank->clk))
  1548. return PTR_ERR(bank->clk);
  1549. return clk_prepare(bank->clk);
  1550. }
  1551. static const struct of_device_id rockchip_pinctrl_dt_match[];
  1552. /* retrieve the soc specific data */
  1553. static struct rockchip_pin_ctrl *rockchip_pinctrl_get_soc_data(
  1554. struct rockchip_pinctrl *d,
  1555. struct platform_device *pdev)
  1556. {
  1557. const struct of_device_id *match;
  1558. struct device_node *node = pdev->dev.of_node;
  1559. struct device_node *np;
  1560. struct rockchip_pin_ctrl *ctrl;
  1561. struct rockchip_pin_bank *bank;
  1562. int grf_offs, pmu_offs, i, j;
  1563. match = of_match_node(rockchip_pinctrl_dt_match, node);
  1564. ctrl = (struct rockchip_pin_ctrl *)match->data;
  1565. for_each_child_of_node(node, np) {
  1566. if (!of_find_property(np, "gpio-controller", NULL))
  1567. continue;
  1568. bank = ctrl->pin_banks;
  1569. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1570. if (!strcmp(bank->name, np->name)) {
  1571. bank->of_node = np;
  1572. if (!rockchip_get_bank_data(bank, d))
  1573. bank->valid = true;
  1574. break;
  1575. }
  1576. }
  1577. }
  1578. grf_offs = ctrl->grf_mux_offset;
  1579. pmu_offs = ctrl->pmu_mux_offset;
  1580. bank = ctrl->pin_banks;
  1581. for (i = 0; i < ctrl->nr_banks; ++i, ++bank) {
  1582. int bank_pins = 0;
  1583. spin_lock_init(&bank->slock);
  1584. bank->drvdata = d;
  1585. bank->pin_base = ctrl->nr_pins;
  1586. ctrl->nr_pins += bank->nr_pins;
  1587. /* calculate iomux offsets */
  1588. for (j = 0; j < 4; j++) {
  1589. struct rockchip_iomux *iom = &bank->iomux[j];
  1590. int inc;
  1591. if (bank_pins >= bank->nr_pins)
  1592. break;
  1593. /* preset offset value, set new start value */
  1594. if (iom->offset >= 0) {
  1595. if (iom->type & IOMUX_SOURCE_PMU)
  1596. pmu_offs = iom->offset;
  1597. else
  1598. grf_offs = iom->offset;
  1599. } else { /* set current offset */
  1600. iom->offset = (iom->type & IOMUX_SOURCE_PMU) ?
  1601. pmu_offs : grf_offs;
  1602. }
  1603. dev_dbg(d->dev, "bank %d, iomux %d has offset 0x%x\n",
  1604. i, j, iom->offset);
  1605. /*
  1606. * Increase offset according to iomux width.
  1607. * 4bit iomux'es are spread over two registers.
  1608. */
  1609. inc = (iom->type & IOMUX_WIDTH_4BIT) ? 8 : 4;
  1610. if (iom->type & IOMUX_SOURCE_PMU)
  1611. pmu_offs += inc;
  1612. else
  1613. grf_offs += inc;
  1614. bank_pins += 8;
  1615. }
  1616. }
  1617. return ctrl;
  1618. }
  1619. #define RK3288_GRF_GPIO6C_IOMUX 0x64
  1620. #define GPIO6C6_SEL_WRITE_ENABLE BIT(28)
  1621. static u32 rk3288_grf_gpio6c_iomux;
  1622. static int __maybe_unused rockchip_pinctrl_suspend(struct device *dev)
  1623. {
  1624. struct rockchip_pinctrl *info = dev_get_drvdata(dev);
  1625. int ret = pinctrl_force_sleep(info->pctl_dev);
  1626. if (ret)
  1627. return ret;
  1628. /*
  1629. * RK3288 GPIO6_C6 mux would be modified by Maskrom when resume, so save
  1630. * the setting here, and restore it at resume.
  1631. */
  1632. if (info->ctrl->type == RK3288) {
  1633. ret = regmap_read(info->regmap_base, RK3288_GRF_GPIO6C_IOMUX,
  1634. &rk3288_grf_gpio6c_iomux);
  1635. if (ret) {
  1636. pinctrl_force_default(info->pctl_dev);
  1637. return ret;
  1638. }
  1639. }
  1640. return 0;
  1641. }
  1642. static int __maybe_unused rockchip_pinctrl_resume(struct device *dev)
  1643. {
  1644. struct rockchip_pinctrl *info = dev_get_drvdata(dev);
  1645. int ret = regmap_write(info->regmap_base, RK3288_GRF_GPIO6C_IOMUX,
  1646. rk3288_grf_gpio6c_iomux |
  1647. GPIO6C6_SEL_WRITE_ENABLE);
  1648. if (ret)
  1649. return ret;
  1650. return pinctrl_force_default(info->pctl_dev);
  1651. }
  1652. static SIMPLE_DEV_PM_OPS(rockchip_pinctrl_dev_pm_ops, rockchip_pinctrl_suspend,
  1653. rockchip_pinctrl_resume);
  1654. static int rockchip_pinctrl_probe(struct platform_device *pdev)
  1655. {
  1656. struct rockchip_pinctrl *info;
  1657. struct device *dev = &pdev->dev;
  1658. struct rockchip_pin_ctrl *ctrl;
  1659. struct device_node *np = pdev->dev.of_node, *node;
  1660. struct resource *res;
  1661. void __iomem *base;
  1662. int ret;
  1663. if (!dev->of_node) {
  1664. dev_err(dev, "device tree node not found\n");
  1665. return -ENODEV;
  1666. }
  1667. info = devm_kzalloc(dev, sizeof(struct rockchip_pinctrl), GFP_KERNEL);
  1668. if (!info)
  1669. return -ENOMEM;
  1670. info->dev = dev;
  1671. ctrl = rockchip_pinctrl_get_soc_data(info, pdev);
  1672. if (!ctrl) {
  1673. dev_err(dev, "driver data not available\n");
  1674. return -EINVAL;
  1675. }
  1676. info->ctrl = ctrl;
  1677. node = of_parse_phandle(np, "rockchip,grf", 0);
  1678. if (node) {
  1679. info->regmap_base = syscon_node_to_regmap(node);
  1680. if (IS_ERR(info->regmap_base))
  1681. return PTR_ERR(info->regmap_base);
  1682. } else {
  1683. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  1684. base = devm_ioremap_resource(&pdev->dev, res);
  1685. if (IS_ERR(base))
  1686. return PTR_ERR(base);
  1687. rockchip_regmap_config.max_register = resource_size(res) - 4;
  1688. rockchip_regmap_config.name = "rockchip,pinctrl";
  1689. info->regmap_base = devm_regmap_init_mmio(&pdev->dev, base,
  1690. &rockchip_regmap_config);
  1691. /* to check for the old dt-bindings */
  1692. info->reg_size = resource_size(res);
  1693. /* Honor the old binding, with pull registers as 2nd resource */
  1694. if (ctrl->type == RK3188 && info->reg_size < 0x200) {
  1695. res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  1696. base = devm_ioremap_resource(&pdev->dev, res);
  1697. if (IS_ERR(base))
  1698. return PTR_ERR(base);
  1699. rockchip_regmap_config.max_register =
  1700. resource_size(res) - 4;
  1701. rockchip_regmap_config.name = "rockchip,pinctrl-pull";
  1702. info->regmap_pull = devm_regmap_init_mmio(&pdev->dev,
  1703. base,
  1704. &rockchip_regmap_config);
  1705. }
  1706. }
  1707. /* try to find the optional reference to the pmu syscon */
  1708. node = of_parse_phandle(np, "rockchip,pmu", 0);
  1709. if (node) {
  1710. info->regmap_pmu = syscon_node_to_regmap(node);
  1711. if (IS_ERR(info->regmap_pmu))
  1712. return PTR_ERR(info->regmap_pmu);
  1713. }
  1714. ret = rockchip_gpiolib_register(pdev, info);
  1715. if (ret)
  1716. return ret;
  1717. ret = rockchip_pinctrl_register(pdev, info);
  1718. if (ret) {
  1719. rockchip_gpiolib_unregister(pdev, info);
  1720. return ret;
  1721. }
  1722. platform_set_drvdata(pdev, info);
  1723. return 0;
  1724. }
  1725. static struct rockchip_pin_bank rk2928_pin_banks[] = {
  1726. PIN_BANK(0, 32, "gpio0"),
  1727. PIN_BANK(1, 32, "gpio1"),
  1728. PIN_BANK(2, 32, "gpio2"),
  1729. PIN_BANK(3, 32, "gpio3"),
  1730. };
  1731. static struct rockchip_pin_ctrl rk2928_pin_ctrl = {
  1732. .pin_banks = rk2928_pin_banks,
  1733. .nr_banks = ARRAY_SIZE(rk2928_pin_banks),
  1734. .label = "RK2928-GPIO",
  1735. .type = RK2928,
  1736. .grf_mux_offset = 0xa8,
  1737. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1738. };
  1739. static struct rockchip_pin_bank rk3036_pin_banks[] = {
  1740. PIN_BANK(0, 32, "gpio0"),
  1741. PIN_BANK(1, 32, "gpio1"),
  1742. PIN_BANK(2, 32, "gpio2"),
  1743. };
  1744. static struct rockchip_pin_ctrl rk3036_pin_ctrl = {
  1745. .pin_banks = rk3036_pin_banks,
  1746. .nr_banks = ARRAY_SIZE(rk3036_pin_banks),
  1747. .label = "RK3036-GPIO",
  1748. .type = RK2928,
  1749. .grf_mux_offset = 0xa8,
  1750. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1751. };
  1752. static struct rockchip_pin_bank rk3066a_pin_banks[] = {
  1753. PIN_BANK(0, 32, "gpio0"),
  1754. PIN_BANK(1, 32, "gpio1"),
  1755. PIN_BANK(2, 32, "gpio2"),
  1756. PIN_BANK(3, 32, "gpio3"),
  1757. PIN_BANK(4, 32, "gpio4"),
  1758. PIN_BANK(6, 16, "gpio6"),
  1759. };
  1760. static struct rockchip_pin_ctrl rk3066a_pin_ctrl = {
  1761. .pin_banks = rk3066a_pin_banks,
  1762. .nr_banks = ARRAY_SIZE(rk3066a_pin_banks),
  1763. .label = "RK3066a-GPIO",
  1764. .type = RK2928,
  1765. .grf_mux_offset = 0xa8,
  1766. .pull_calc_reg = rk2928_calc_pull_reg_and_bit,
  1767. };
  1768. static struct rockchip_pin_bank rk3066b_pin_banks[] = {
  1769. PIN_BANK(0, 32, "gpio0"),
  1770. PIN_BANK(1, 32, "gpio1"),
  1771. PIN_BANK(2, 32, "gpio2"),
  1772. PIN_BANK(3, 32, "gpio3"),
  1773. };
  1774. static struct rockchip_pin_ctrl rk3066b_pin_ctrl = {
  1775. .pin_banks = rk3066b_pin_banks,
  1776. .nr_banks = ARRAY_SIZE(rk3066b_pin_banks),
  1777. .label = "RK3066b-GPIO",
  1778. .type = RK3066B,
  1779. .grf_mux_offset = 0x60,
  1780. };
  1781. static struct rockchip_pin_bank rk3188_pin_banks[] = {
  1782. PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_GPIO_ONLY, 0, 0, 0),
  1783. PIN_BANK(1, 32, "gpio1"),
  1784. PIN_BANK(2, 32, "gpio2"),
  1785. PIN_BANK(3, 32, "gpio3"),
  1786. };
  1787. static struct rockchip_pin_ctrl rk3188_pin_ctrl = {
  1788. .pin_banks = rk3188_pin_banks,
  1789. .nr_banks = ARRAY_SIZE(rk3188_pin_banks),
  1790. .label = "RK3188-GPIO",
  1791. .type = RK3188,
  1792. .grf_mux_offset = 0x60,
  1793. .pull_calc_reg = rk3188_calc_pull_reg_and_bit,
  1794. };
  1795. static struct rockchip_pin_bank rk3288_pin_banks[] = {
  1796. PIN_BANK_IOMUX_FLAGS(0, 24, "gpio0", IOMUX_SOURCE_PMU,
  1797. IOMUX_SOURCE_PMU,
  1798. IOMUX_SOURCE_PMU,
  1799. IOMUX_UNROUTED
  1800. ),
  1801. PIN_BANK_IOMUX_FLAGS(1, 32, "gpio1", IOMUX_UNROUTED,
  1802. IOMUX_UNROUTED,
  1803. IOMUX_UNROUTED,
  1804. 0
  1805. ),
  1806. PIN_BANK_IOMUX_FLAGS(2, 32, "gpio2", 0, 0, 0, IOMUX_UNROUTED),
  1807. PIN_BANK_IOMUX_FLAGS(3, 32, "gpio3", 0, 0, 0, IOMUX_WIDTH_4BIT),
  1808. PIN_BANK_IOMUX_FLAGS(4, 32, "gpio4", IOMUX_WIDTH_4BIT,
  1809. IOMUX_WIDTH_4BIT,
  1810. 0,
  1811. 0
  1812. ),
  1813. PIN_BANK_IOMUX_FLAGS(5, 32, "gpio5", IOMUX_UNROUTED,
  1814. 0,
  1815. 0,
  1816. IOMUX_UNROUTED
  1817. ),
  1818. PIN_BANK_IOMUX_FLAGS(6, 32, "gpio6", 0, 0, 0, IOMUX_UNROUTED),
  1819. PIN_BANK_IOMUX_FLAGS(7, 32, "gpio7", 0,
  1820. 0,
  1821. IOMUX_WIDTH_4BIT,
  1822. IOMUX_UNROUTED
  1823. ),
  1824. PIN_BANK(8, 16, "gpio8"),
  1825. };
  1826. static struct rockchip_pin_ctrl rk3288_pin_ctrl = {
  1827. .pin_banks = rk3288_pin_banks,
  1828. .nr_banks = ARRAY_SIZE(rk3288_pin_banks),
  1829. .label = "RK3288-GPIO",
  1830. .type = RK3288,
  1831. .grf_mux_offset = 0x0,
  1832. .pmu_mux_offset = 0x84,
  1833. .pull_calc_reg = rk3288_calc_pull_reg_and_bit,
  1834. .drv_calc_reg = rk3288_calc_drv_reg_and_bit,
  1835. };
  1836. static struct rockchip_pin_bank rk3368_pin_banks[] = {
  1837. PIN_BANK_IOMUX_FLAGS(0, 32, "gpio0", IOMUX_SOURCE_PMU,
  1838. IOMUX_SOURCE_PMU,
  1839. IOMUX_SOURCE_PMU,
  1840. IOMUX_SOURCE_PMU
  1841. ),
  1842. PIN_BANK(1, 32, "gpio1"),
  1843. PIN_BANK(2, 32, "gpio2"),
  1844. PIN_BANK(3, 32, "gpio3"),
  1845. };
  1846. static struct rockchip_pin_ctrl rk3368_pin_ctrl = {
  1847. .pin_banks = rk3368_pin_banks,
  1848. .nr_banks = ARRAY_SIZE(rk3368_pin_banks),
  1849. .label = "RK3368-GPIO",
  1850. .type = RK3368,
  1851. .grf_mux_offset = 0x0,
  1852. .pmu_mux_offset = 0x0,
  1853. .pull_calc_reg = rk3368_calc_pull_reg_and_bit,
  1854. .drv_calc_reg = rk3368_calc_drv_reg_and_bit,
  1855. };
  1856. static const struct of_device_id rockchip_pinctrl_dt_match[] = {
  1857. { .compatible = "rockchip,rk2928-pinctrl",
  1858. .data = (void *)&rk2928_pin_ctrl },
  1859. { .compatible = "rockchip,rk3036-pinctrl",
  1860. .data = (void *)&rk3036_pin_ctrl },
  1861. { .compatible = "rockchip,rk3066a-pinctrl",
  1862. .data = (void *)&rk3066a_pin_ctrl },
  1863. { .compatible = "rockchip,rk3066b-pinctrl",
  1864. .data = (void *)&rk3066b_pin_ctrl },
  1865. { .compatible = "rockchip,rk3188-pinctrl",
  1866. .data = (void *)&rk3188_pin_ctrl },
  1867. { .compatible = "rockchip,rk3288-pinctrl",
  1868. .data = (void *)&rk3288_pin_ctrl },
  1869. { .compatible = "rockchip,rk3368-pinctrl",
  1870. .data = (void *)&rk3368_pin_ctrl },
  1871. {},
  1872. };
  1873. MODULE_DEVICE_TABLE(of, rockchip_pinctrl_dt_match);
  1874. static struct platform_driver rockchip_pinctrl_driver = {
  1875. .probe = rockchip_pinctrl_probe,
  1876. .driver = {
  1877. .name = "rockchip-pinctrl",
  1878. .pm = &rockchip_pinctrl_dev_pm_ops,
  1879. .of_match_table = rockchip_pinctrl_dt_match,
  1880. },
  1881. };
  1882. static int __init rockchip_pinctrl_drv_register(void)
  1883. {
  1884. return platform_driver_register(&rockchip_pinctrl_driver);
  1885. }
  1886. postcore_initcall(rockchip_pinctrl_drv_register);
  1887. MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
  1888. MODULE_DESCRIPTION("Rockchip pinctrl driver");
  1889. MODULE_LICENSE("GPL v2");