pinctrl-ns2-mux.c 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* Copyright (C) 2016 Broadcom Corporation
  3. *
  4. * This file contains the Northstar2 IOMUX driver that supports group
  5. * based PINMUX configuration. The PWM is functional only when the
  6. * corresponding mfio pin group is selected as gpio.
  7. */
  8. #include <linux/err.h>
  9. #include <linux/io.h>
  10. #include <linux/of.h>
  11. #include <linux/pinctrl/pinconf.h>
  12. #include <linux/pinctrl/pinconf-generic.h>
  13. #include <linux/pinctrl/pinctrl.h>
  14. #include <linux/pinctrl/pinmux.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/slab.h>
  17. #include "../core.h"
  18. #include "../pinctrl-utils.h"
  19. #define NS2_NUM_IOMUX 19
  20. #define NS2_NUM_PWM_MUX 4
  21. #define NS2_PIN_MUX_BASE0 0x00
  22. #define NS2_PIN_MUX_BASE1 0x01
  23. #define NS2_PIN_CONF_BASE 0x02
  24. #define NS2_MUX_PAD_FUNC1_OFFSET 0x04
  25. #define NS2_PIN_SRC_MASK 0x01
  26. #define NS2_PIN_PULL_MASK 0x03
  27. #define NS2_PIN_DRIVE_STRENGTH_MASK 0x07
  28. #define NS2_PIN_PULL_UP 0x01
  29. #define NS2_PIN_PULL_DOWN 0x02
  30. #define NS2_PIN_INPUT_EN_MASK 0x01
  31. /*
  32. * Northstar2 IOMUX register description
  33. *
  34. * @base: base address number
  35. * @offset: register offset for mux configuration of a group
  36. * @shift: bit shift for mux configuration of a group
  37. * @mask: mask bits
  38. * @alt: alternate function to set to
  39. */
  40. struct ns2_mux {
  41. unsigned int base;
  42. unsigned int offset;
  43. unsigned int shift;
  44. unsigned int mask;
  45. unsigned int alt;
  46. };
  47. /*
  48. * Keep track of Northstar2 IOMUX configuration and prevent double
  49. * configuration
  50. *
  51. * @ns2_mux: Northstar2 IOMUX register description
  52. * @is_configured: flag to indicate whether a mux setting has already
  53. * been configured
  54. */
  55. struct ns2_mux_log {
  56. struct ns2_mux mux;
  57. bool is_configured;
  58. };
  59. /*
  60. * Group based IOMUX configuration
  61. *
  62. * @name: name of the group
  63. * @pins: array of pins used by this group
  64. * @num_pins: total number of pins used by this group
  65. * @mux: Northstar2 group based IOMUX configuration
  66. */
  67. struct ns2_pin_group {
  68. const char *name;
  69. const unsigned int *pins;
  70. const unsigned int num_pins;
  71. const struct ns2_mux mux;
  72. };
  73. /*
  74. * Northstar2 mux function and supported pin groups
  75. *
  76. * @name: name of the function
  77. * @groups: array of groups that can be supported by this function
  78. * @num_groups: total number of groups that can be supported by function
  79. */
  80. struct ns2_pin_function {
  81. const char *name;
  82. const char * const *groups;
  83. const unsigned int num_groups;
  84. };
  85. /*
  86. * Northstar2 IOMUX pinctrl core
  87. *
  88. * @pctl: pointer to pinctrl_dev
  89. * @dev: pointer to device
  90. * @base0: first IOMUX register base
  91. * @base1: second IOMUX register base
  92. * @pinconf_base: configuration register base
  93. * @groups: pointer to array of groups
  94. * @num_groups: total number of groups
  95. * @functions: pointer to array of functions
  96. * @num_functions: total number of functions
  97. * @mux_log: pointer to the array of mux logs
  98. * @lock: lock to protect register access
  99. */
  100. struct ns2_pinctrl {
  101. struct pinctrl_dev *pctl;
  102. struct device *dev;
  103. void __iomem *base0;
  104. void __iomem *base1;
  105. void __iomem *pinconf_base;
  106. const struct ns2_pin_group *groups;
  107. unsigned int num_groups;
  108. const struct ns2_pin_function *functions;
  109. unsigned int num_functions;
  110. struct ns2_mux_log *mux_log;
  111. spinlock_t lock;
  112. };
  113. /*
  114. * Pin configuration info
  115. *
  116. * @base: base address number
  117. * @offset: register offset from base
  118. * @src_shift: slew rate control bit shift in the register
  119. * @input_en: input enable control bit shift
  120. * @pull_shift: pull-up/pull-down control bit shift in the register
  121. * @drive_shift: drive strength control bit shift in the register
  122. */
  123. struct ns2_pinconf {
  124. unsigned int base;
  125. unsigned int offset;
  126. unsigned int src_shift;
  127. unsigned int input_en;
  128. unsigned int pull_shift;
  129. unsigned int drive_shift;
  130. };
  131. /*
  132. * Description of a pin in Northstar2
  133. *
  134. * @pin: pin number
  135. * @name: pin name
  136. * @pin_conf: pin configuration structure
  137. */
  138. struct ns2_pin {
  139. unsigned int pin;
  140. char *name;
  141. struct ns2_pinconf pin_conf;
  142. };
  143. #define NS2_PIN_DESC(p, n, b, o, s, i, pu, d) \
  144. { \
  145. .pin = p, \
  146. .name = n, \
  147. .pin_conf = { \
  148. .base = b, \
  149. .offset = o, \
  150. .src_shift = s, \
  151. .input_en = i, \
  152. .pull_shift = pu, \
  153. .drive_shift = d, \
  154. } \
  155. }
  156. /*
  157. * List of pins in Northstar2
  158. */
  159. static struct ns2_pin ns2_pins[] = {
  160. NS2_PIN_DESC(0, "mfio_0", -1, 0, 0, 0, 0, 0),
  161. NS2_PIN_DESC(1, "mfio_1", -1, 0, 0, 0, 0, 0),
  162. NS2_PIN_DESC(2, "mfio_2", -1, 0, 0, 0, 0, 0),
  163. NS2_PIN_DESC(3, "mfio_3", -1, 0, 0, 0, 0, 0),
  164. NS2_PIN_DESC(4, "mfio_4", -1, 0, 0, 0, 0, 0),
  165. NS2_PIN_DESC(5, "mfio_5", -1, 0, 0, 0, 0, 0),
  166. NS2_PIN_DESC(6, "mfio_6", -1, 0, 0, 0, 0, 0),
  167. NS2_PIN_DESC(7, "mfio_7", -1, 0, 0, 0, 0, 0),
  168. NS2_PIN_DESC(8, "mfio_8", -1, 0, 0, 0, 0, 0),
  169. NS2_PIN_DESC(9, "mfio_9", -1, 0, 0, 0, 0, 0),
  170. NS2_PIN_DESC(10, "mfio_10", -1, 0, 0, 0, 0, 0),
  171. NS2_PIN_DESC(11, "mfio_11", -1, 0, 0, 0, 0, 0),
  172. NS2_PIN_DESC(12, "mfio_12", -1, 0, 0, 0, 0, 0),
  173. NS2_PIN_DESC(13, "mfio_13", -1, 0, 0, 0, 0, 0),
  174. NS2_PIN_DESC(14, "mfio_14", -1, 0, 0, 0, 0, 0),
  175. NS2_PIN_DESC(15, "mfio_15", -1, 0, 0, 0, 0, 0),
  176. NS2_PIN_DESC(16, "mfio_16", -1, 0, 0, 0, 0, 0),
  177. NS2_PIN_DESC(17, "mfio_17", -1, 0, 0, 0, 0, 0),
  178. NS2_PIN_DESC(18, "mfio_18", -1, 0, 0, 0, 0, 0),
  179. NS2_PIN_DESC(19, "mfio_19", -1, 0, 0, 0, 0, 0),
  180. NS2_PIN_DESC(20, "mfio_20", -1, 0, 0, 0, 0, 0),
  181. NS2_PIN_DESC(21, "mfio_21", -1, 0, 0, 0, 0, 0),
  182. NS2_PIN_DESC(22, "mfio_22", -1, 0, 0, 0, 0, 0),
  183. NS2_PIN_DESC(23, "mfio_23", -1, 0, 0, 0, 0, 0),
  184. NS2_PIN_DESC(24, "mfio_24", -1, 0, 0, 0, 0, 0),
  185. NS2_PIN_DESC(25, "mfio_25", -1, 0, 0, 0, 0, 0),
  186. NS2_PIN_DESC(26, "mfio_26", -1, 0, 0, 0, 0, 0),
  187. NS2_PIN_DESC(27, "mfio_27", -1, 0, 0, 0, 0, 0),
  188. NS2_PIN_DESC(28, "mfio_28", -1, 0, 0, 0, 0, 0),
  189. NS2_PIN_DESC(29, "mfio_29", -1, 0, 0, 0, 0, 0),
  190. NS2_PIN_DESC(30, "mfio_30", -1, 0, 0, 0, 0, 0),
  191. NS2_PIN_DESC(31, "mfio_31", -1, 0, 0, 0, 0, 0),
  192. NS2_PIN_DESC(32, "mfio_32", -1, 0, 0, 0, 0, 0),
  193. NS2_PIN_DESC(33, "mfio_33", -1, 0, 0, 0, 0, 0),
  194. NS2_PIN_DESC(34, "mfio_34", -1, 0, 0, 0, 0, 0),
  195. NS2_PIN_DESC(35, "mfio_35", -1, 0, 0, 0, 0, 0),
  196. NS2_PIN_DESC(36, "mfio_36", -1, 0, 0, 0, 0, 0),
  197. NS2_PIN_DESC(37, "mfio_37", -1, 0, 0, 0, 0, 0),
  198. NS2_PIN_DESC(38, "mfio_38", -1, 0, 0, 0, 0, 0),
  199. NS2_PIN_DESC(39, "mfio_39", -1, 0, 0, 0, 0, 0),
  200. NS2_PIN_DESC(40, "mfio_40", -1, 0, 0, 0, 0, 0),
  201. NS2_PIN_DESC(41, "mfio_41", -1, 0, 0, 0, 0, 0),
  202. NS2_PIN_DESC(42, "mfio_42", -1, 0, 0, 0, 0, 0),
  203. NS2_PIN_DESC(43, "mfio_43", -1, 0, 0, 0, 0, 0),
  204. NS2_PIN_DESC(44, "mfio_44", -1, 0, 0, 0, 0, 0),
  205. NS2_PIN_DESC(45, "mfio_45", -1, 0, 0, 0, 0, 0),
  206. NS2_PIN_DESC(46, "mfio_46", -1, 0, 0, 0, 0, 0),
  207. NS2_PIN_DESC(47, "mfio_47", -1, 0, 0, 0, 0, 0),
  208. NS2_PIN_DESC(48, "mfio_48", -1, 0, 0, 0, 0, 0),
  209. NS2_PIN_DESC(49, "mfio_49", -1, 0, 0, 0, 0, 0),
  210. NS2_PIN_DESC(50, "mfio_50", -1, 0, 0, 0, 0, 0),
  211. NS2_PIN_DESC(51, "mfio_51", -1, 0, 0, 0, 0, 0),
  212. NS2_PIN_DESC(52, "mfio_52", -1, 0, 0, 0, 0, 0),
  213. NS2_PIN_DESC(53, "mfio_53", -1, 0, 0, 0, 0, 0),
  214. NS2_PIN_DESC(54, "mfio_54", -1, 0, 0, 0, 0, 0),
  215. NS2_PIN_DESC(55, "mfio_55", -1, 0, 0, 0, 0, 0),
  216. NS2_PIN_DESC(56, "mfio_56", -1, 0, 0, 0, 0, 0),
  217. NS2_PIN_DESC(57, "mfio_57", -1, 0, 0, 0, 0, 0),
  218. NS2_PIN_DESC(58, "mfio_58", -1, 0, 0, 0, 0, 0),
  219. NS2_PIN_DESC(59, "mfio_59", -1, 0, 0, 0, 0, 0),
  220. NS2_PIN_DESC(60, "mfio_60", -1, 0, 0, 0, 0, 0),
  221. NS2_PIN_DESC(61, "mfio_61", -1, 0, 0, 0, 0, 0),
  222. NS2_PIN_DESC(62, "mfio_62", -1, 0, 0, 0, 0, 0),
  223. NS2_PIN_DESC(63, "qspi_wp", 2, 0x0, 31, 30, 27, 24),
  224. NS2_PIN_DESC(64, "qspi_hold", 2, 0x0, 23, 22, 19, 16),
  225. NS2_PIN_DESC(65, "qspi_cs", 2, 0x0, 15, 14, 11, 8),
  226. NS2_PIN_DESC(66, "qspi_sck", 2, 0x0, 7, 6, 3, 0),
  227. NS2_PIN_DESC(67, "uart3_sin", 2, 0x04, 31, 30, 27, 24),
  228. NS2_PIN_DESC(68, "uart3_sout", 2, 0x04, 23, 22, 19, 16),
  229. NS2_PIN_DESC(69, "qspi_mosi", 2, 0x04, 15, 14, 11, 8),
  230. NS2_PIN_DESC(70, "qspi_miso", 2, 0x04, 7, 6, 3, 0),
  231. NS2_PIN_DESC(71, "spi0_fss", 2, 0x08, 31, 30, 27, 24),
  232. NS2_PIN_DESC(72, "spi0_rxd", 2, 0x08, 23, 22, 19, 16),
  233. NS2_PIN_DESC(73, "spi0_txd", 2, 0x08, 15, 14, 11, 8),
  234. NS2_PIN_DESC(74, "spi0_sck", 2, 0x08, 7, 6, 3, 0),
  235. NS2_PIN_DESC(75, "spi1_fss", 2, 0x0c, 31, 30, 27, 24),
  236. NS2_PIN_DESC(76, "spi1_rxd", 2, 0x0c, 23, 22, 19, 16),
  237. NS2_PIN_DESC(77, "spi1_txd", 2, 0x0c, 15, 14, 11, 8),
  238. NS2_PIN_DESC(78, "spi1_sck", 2, 0x0c, 7, 6, 3, 0),
  239. NS2_PIN_DESC(79, "sdio0_data7", 2, 0x10, 31, 30, 27, 24),
  240. NS2_PIN_DESC(80, "sdio0_emmc_rst", 2, 0x10, 23, 22, 19, 16),
  241. NS2_PIN_DESC(81, "sdio0_led_on", 2, 0x10, 15, 14, 11, 8),
  242. NS2_PIN_DESC(82, "sdio0_wp", 2, 0x10, 7, 6, 3, 0),
  243. NS2_PIN_DESC(83, "sdio0_data3", 2, 0x14, 31, 30, 27, 24),
  244. NS2_PIN_DESC(84, "sdio0_data4", 2, 0x14, 23, 22, 19, 16),
  245. NS2_PIN_DESC(85, "sdio0_data5", 2, 0x14, 15, 14, 11, 8),
  246. NS2_PIN_DESC(86, "sdio0_data6", 2, 0x14, 7, 6, 3, 0),
  247. NS2_PIN_DESC(87, "sdio0_cmd", 2, 0x18, 31, 30, 27, 24),
  248. NS2_PIN_DESC(88, "sdio0_data0", 2, 0x18, 23, 22, 19, 16),
  249. NS2_PIN_DESC(89, "sdio0_data1", 2, 0x18, 15, 14, 11, 8),
  250. NS2_PIN_DESC(90, "sdio0_data2", 2, 0x18, 7, 6, 3, 0),
  251. NS2_PIN_DESC(91, "sdio1_led_on", 2, 0x1c, 31, 30, 27, 24),
  252. NS2_PIN_DESC(92, "sdio1_wp", 2, 0x1c, 23, 22, 19, 16),
  253. NS2_PIN_DESC(93, "sdio0_cd_l", 2, 0x1c, 15, 14, 11, 8),
  254. NS2_PIN_DESC(94, "sdio0_clk", 2, 0x1c, 7, 6, 3, 0),
  255. NS2_PIN_DESC(95, "sdio1_data5", 2, 0x20, 31, 30, 27, 24),
  256. NS2_PIN_DESC(96, "sdio1_data6", 2, 0x20, 23, 22, 19, 16),
  257. NS2_PIN_DESC(97, "sdio1_data7", 2, 0x20, 15, 14, 11, 8),
  258. NS2_PIN_DESC(98, "sdio1_emmc_rst", 2, 0x20, 7, 6, 3, 0),
  259. NS2_PIN_DESC(99, "sdio1_data1", 2, 0x24, 31, 30, 27, 24),
  260. NS2_PIN_DESC(100, "sdio1_data2", 2, 0x24, 23, 22, 19, 16),
  261. NS2_PIN_DESC(101, "sdio1_data3", 2, 0x24, 15, 14, 11, 8),
  262. NS2_PIN_DESC(102, "sdio1_data4", 2, 0x24, 7, 6, 3, 0),
  263. NS2_PIN_DESC(103, "sdio1_cd_l", 2, 0x28, 31, 30, 27, 24),
  264. NS2_PIN_DESC(104, "sdio1_clk", 2, 0x28, 23, 22, 19, 16),
  265. NS2_PIN_DESC(105, "sdio1_cmd", 2, 0x28, 15, 14, 11, 8),
  266. NS2_PIN_DESC(106, "sdio1_data0", 2, 0x28, 7, 6, 3, 0),
  267. NS2_PIN_DESC(107, "ext_mdio_0", 2, 0x2c, 15, 14, 11, 8),
  268. NS2_PIN_DESC(108, "ext_mdc_0", 2, 0x2c, 7, 6, 3, 0),
  269. NS2_PIN_DESC(109, "usb3_p1_vbus_ppc", 2, 0x34, 31, 30, 27, 24),
  270. NS2_PIN_DESC(110, "usb3_p1_overcurrent", 2, 0x34, 23, 22, 19, 16),
  271. NS2_PIN_DESC(111, "usb3_p0_vbus_ppc", 2, 0x34, 15, 14, 11, 8),
  272. NS2_PIN_DESC(112, "usb3_p0_overcurrent", 2, 0x34, 7, 6, 3, 0),
  273. NS2_PIN_DESC(113, "usb2_presence_indication", 2, 0x38, 31, 30, 27, 24),
  274. NS2_PIN_DESC(114, "usb2_vbus_present", 2, 0x38, 23, 22, 19, 16),
  275. NS2_PIN_DESC(115, "usb2_vbus_ppc", 2, 0x38, 15, 14, 11, 8),
  276. NS2_PIN_DESC(116, "usb2_overcurrent", 2, 0x38, 7, 6, 3, 0),
  277. NS2_PIN_DESC(117, "sata_led1", 2, 0x3c, 15, 14, 11, 8),
  278. NS2_PIN_DESC(118, "sata_led0", 2, 0x3c, 7, 6, 3, 0),
  279. };
  280. /*
  281. * List of groups of pins
  282. */
  283. static const unsigned int nand_pins[] = {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10,
  284. 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23};
  285. static const unsigned int nor_data_pins[] = {0, 1, 2, 3, 4, 5, 6, 7, 8, 9,
  286. 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25};
  287. static const unsigned int gpio_0_1_pins[] = {24, 25};
  288. static const unsigned int pwm_0_pins[] = {24};
  289. static const unsigned int pwm_1_pins[] = {25};
  290. static const unsigned int uart1_ext_clk_pins[] = {26};
  291. static const unsigned int nor_adv_pins[] = {26};
  292. static const unsigned int gpio_2_5_pins[] = {27, 28, 29, 30};
  293. static const unsigned int pcie_ab1_clk_wak_pins[] = {27, 28, 29, 30};
  294. static const unsigned int nor_addr_0_3_pins[] = {27, 28, 29, 30};
  295. static const unsigned int pwm_2_pins[] = {27};
  296. static const unsigned int pwm_3_pins[] = {28};
  297. static const unsigned int gpio_6_7_pins[] = {31, 32};
  298. static const unsigned int pcie_a3_clk_wak_pins[] = {31, 32};
  299. static const unsigned int nor_addr_4_5_pins[] = {31, 32};
  300. static const unsigned int gpio_8_9_pins[] = {33, 34};
  301. static const unsigned int pcie_b3_clk_wak_pins[] = {33, 34};
  302. static const unsigned int nor_addr_6_7_pins[] = {33, 34};
  303. static const unsigned int gpio_10_11_pins[] = {35, 36};
  304. static const unsigned int pcie_b2_clk_wak_pins[] = {35, 36};
  305. static const unsigned int nor_addr_8_9_pins[] = {35, 36};
  306. static const unsigned int gpio_12_13_pins[] = {37, 38};
  307. static const unsigned int pcie_a2_clk_wak_pins[] = {37, 38};
  308. static const unsigned int nor_addr_10_11_pins[] = {37, 38};
  309. static const unsigned int gpio_14_17_pins[] = {39, 40, 41, 42};
  310. static const unsigned int uart0_modem_pins[] = {39, 40, 41, 42};
  311. static const unsigned int nor_addr_12_15_pins[] = {39, 40, 41, 42};
  312. static const unsigned int gpio_18_19_pins[] = {43, 44};
  313. static const unsigned int uart0_rts_cts_pins[] = {43, 44};
  314. static const unsigned int gpio_20_21_pins[] = {45, 46};
  315. static const unsigned int uart0_in_out_pins[] = {45, 46};
  316. static const unsigned int gpio_22_23_pins[] = {47, 48};
  317. static const unsigned int uart1_dcd_dsr_pins[] = {47, 48};
  318. static const unsigned int gpio_24_25_pins[] = {49, 50};
  319. static const unsigned int uart1_ri_dtr_pins[] = {49, 50};
  320. static const unsigned int gpio_26_27_pins[] = {51, 52};
  321. static const unsigned int uart1_rts_cts_pins[] = {51, 52};
  322. static const unsigned int gpio_28_29_pins[] = {53, 54};
  323. static const unsigned int uart1_in_out_pins[] = {53, 54};
  324. static const unsigned int gpio_30_31_pins[] = {55, 56};
  325. static const unsigned int uart2_rts_cts_pins[] = {55, 56};
  326. #define NS2_PIN_GROUP(group_name, ba, off, sh, ma, al) \
  327. { \
  328. .name = __stringify(group_name) "_grp", \
  329. .pins = group_name ## _pins, \
  330. .num_pins = ARRAY_SIZE(group_name ## _pins), \
  331. .mux = { \
  332. .base = ba, \
  333. .offset = off, \
  334. .shift = sh, \
  335. .mask = ma, \
  336. .alt = al, \
  337. } \
  338. }
  339. /*
  340. * List of Northstar2 pin groups
  341. */
  342. static const struct ns2_pin_group ns2_pin_groups[] = {
  343. NS2_PIN_GROUP(nand, 0, 0, 31, 1, 0),
  344. NS2_PIN_GROUP(nor_data, 0, 0, 31, 1, 1),
  345. NS2_PIN_GROUP(gpio_0_1, 0, 0, 31, 1, 0),
  346. NS2_PIN_GROUP(uart1_ext_clk, 0, 4, 30, 3, 1),
  347. NS2_PIN_GROUP(nor_adv, 0, 4, 30, 3, 2),
  348. NS2_PIN_GROUP(gpio_2_5, 0, 4, 28, 3, 0),
  349. NS2_PIN_GROUP(pcie_ab1_clk_wak, 0, 4, 28, 3, 1),
  350. NS2_PIN_GROUP(nor_addr_0_3, 0, 4, 28, 3, 2),
  351. NS2_PIN_GROUP(gpio_6_7, 0, 4, 26, 3, 0),
  352. NS2_PIN_GROUP(pcie_a3_clk_wak, 0, 4, 26, 3, 1),
  353. NS2_PIN_GROUP(nor_addr_4_5, 0, 4, 26, 3, 2),
  354. NS2_PIN_GROUP(gpio_8_9, 0, 4, 24, 3, 0),
  355. NS2_PIN_GROUP(pcie_b3_clk_wak, 0, 4, 24, 3, 1),
  356. NS2_PIN_GROUP(nor_addr_6_7, 0, 4, 24, 3, 2),
  357. NS2_PIN_GROUP(gpio_10_11, 0, 4, 22, 3, 0),
  358. NS2_PIN_GROUP(pcie_b2_clk_wak, 0, 4, 22, 3, 1),
  359. NS2_PIN_GROUP(nor_addr_8_9, 0, 4, 22, 3, 2),
  360. NS2_PIN_GROUP(gpio_12_13, 0, 4, 20, 3, 0),
  361. NS2_PIN_GROUP(pcie_a2_clk_wak, 0, 4, 20, 3, 1),
  362. NS2_PIN_GROUP(nor_addr_10_11, 0, 4, 20, 3, 2),
  363. NS2_PIN_GROUP(gpio_14_17, 0, 4, 18, 3, 0),
  364. NS2_PIN_GROUP(uart0_modem, 0, 4, 18, 3, 1),
  365. NS2_PIN_GROUP(nor_addr_12_15, 0, 4, 18, 3, 2),
  366. NS2_PIN_GROUP(gpio_18_19, 0, 4, 16, 3, 0),
  367. NS2_PIN_GROUP(uart0_rts_cts, 0, 4, 16, 3, 1),
  368. NS2_PIN_GROUP(gpio_20_21, 0, 4, 14, 3, 0),
  369. NS2_PIN_GROUP(uart0_in_out, 0, 4, 14, 3, 1),
  370. NS2_PIN_GROUP(gpio_22_23, 0, 4, 12, 3, 0),
  371. NS2_PIN_GROUP(uart1_dcd_dsr, 0, 4, 12, 3, 1),
  372. NS2_PIN_GROUP(gpio_24_25, 0, 4, 10, 3, 0),
  373. NS2_PIN_GROUP(uart1_ri_dtr, 0, 4, 10, 3, 1),
  374. NS2_PIN_GROUP(gpio_26_27, 0, 4, 8, 3, 0),
  375. NS2_PIN_GROUP(uart1_rts_cts, 0, 4, 8, 3, 1),
  376. NS2_PIN_GROUP(gpio_28_29, 0, 4, 6, 3, 0),
  377. NS2_PIN_GROUP(uart1_in_out, 0, 4, 6, 3, 1),
  378. NS2_PIN_GROUP(gpio_30_31, 0, 4, 4, 3, 0),
  379. NS2_PIN_GROUP(uart2_rts_cts, 0, 4, 4, 3, 1),
  380. NS2_PIN_GROUP(pwm_0, 1, 0, 0, 1, 1),
  381. NS2_PIN_GROUP(pwm_1, 1, 0, 1, 1, 1),
  382. NS2_PIN_GROUP(pwm_2, 1, 0, 2, 1, 1),
  383. NS2_PIN_GROUP(pwm_3, 1, 0, 3, 1, 1),
  384. };
  385. /*
  386. * List of groups supported by functions
  387. */
  388. static const char * const nand_grps[] = {"nand_grp"};
  389. static const char * const nor_grps[] = {"nor_data_grp", "nor_adv_grp",
  390. "nor_addr_0_3_grp", "nor_addr_4_5_grp", "nor_addr_6_7_grp",
  391. "nor_addr_8_9_grp", "nor_addr_10_11_grp", "nor_addr_12_15_grp"};
  392. static const char * const gpio_grps[] = {"gpio_0_1_grp", "gpio_2_5_grp",
  393. "gpio_6_7_grp", "gpio_8_9_grp", "gpio_10_11_grp", "gpio_12_13_grp",
  394. "gpio_14_17_grp", "gpio_18_19_grp", "gpio_20_21_grp", "gpio_22_23_grp",
  395. "gpio_24_25_grp", "gpio_26_27_grp", "gpio_28_29_grp",
  396. "gpio_30_31_grp"};
  397. static const char * const pcie_grps[] = {"pcie_ab1_clk_wak_grp",
  398. "pcie_a3_clk_wak_grp", "pcie_b3_clk_wak_grp", "pcie_b2_clk_wak_grp",
  399. "pcie_a2_clk_wak_grp"};
  400. static const char * const uart0_grps[] = {"uart0_modem_grp",
  401. "uart0_rts_cts_grp", "uart0_in_out_grp"};
  402. static const char * const uart1_grps[] = {"uart1_ext_clk_grp",
  403. "uart1_dcd_dsr_grp", "uart1_ri_dtr_grp", "uart1_rts_cts_grp",
  404. "uart1_in_out_grp"};
  405. static const char * const uart2_grps[] = {"uart2_rts_cts_grp"};
  406. static const char * const pwm_grps[] = {"pwm_0_grp", "pwm_1_grp",
  407. "pwm_2_grp", "pwm_3_grp"};
  408. #define NS2_PIN_FUNCTION(func) \
  409. { \
  410. .name = #func, \
  411. .groups = func ## _grps, \
  412. .num_groups = ARRAY_SIZE(func ## _grps), \
  413. }
  414. /*
  415. * List of supported functions
  416. */
  417. static const struct ns2_pin_function ns2_pin_functions[] = {
  418. NS2_PIN_FUNCTION(nand),
  419. NS2_PIN_FUNCTION(nor),
  420. NS2_PIN_FUNCTION(gpio),
  421. NS2_PIN_FUNCTION(pcie),
  422. NS2_PIN_FUNCTION(uart0),
  423. NS2_PIN_FUNCTION(uart1),
  424. NS2_PIN_FUNCTION(uart2),
  425. NS2_PIN_FUNCTION(pwm),
  426. };
  427. static int ns2_get_groups_count(struct pinctrl_dev *pctrl_dev)
  428. {
  429. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  430. return pinctrl->num_groups;
  431. }
  432. static const char *ns2_get_group_name(struct pinctrl_dev *pctrl_dev,
  433. unsigned int selector)
  434. {
  435. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  436. return pinctrl->groups[selector].name;
  437. }
  438. static int ns2_get_group_pins(struct pinctrl_dev *pctrl_dev,
  439. unsigned int selector, const unsigned int **pins,
  440. unsigned int *num_pins)
  441. {
  442. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  443. *pins = pinctrl->groups[selector].pins;
  444. *num_pins = pinctrl->groups[selector].num_pins;
  445. return 0;
  446. }
  447. static void ns2_pin_dbg_show(struct pinctrl_dev *pctrl_dev,
  448. struct seq_file *s, unsigned int offset)
  449. {
  450. seq_printf(s, " %s", dev_name(pctrl_dev->dev));
  451. }
  452. static const struct pinctrl_ops ns2_pinctrl_ops = {
  453. .get_groups_count = ns2_get_groups_count,
  454. .get_group_name = ns2_get_group_name,
  455. .get_group_pins = ns2_get_group_pins,
  456. .pin_dbg_show = ns2_pin_dbg_show,
  457. .dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
  458. .dt_free_map = pinctrl_utils_free_map,
  459. };
  460. static int ns2_get_functions_count(struct pinctrl_dev *pctrl_dev)
  461. {
  462. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  463. return pinctrl->num_functions;
  464. }
  465. static const char *ns2_get_function_name(struct pinctrl_dev *pctrl_dev,
  466. unsigned int selector)
  467. {
  468. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  469. return pinctrl->functions[selector].name;
  470. }
  471. static int ns2_get_function_groups(struct pinctrl_dev *pctrl_dev,
  472. unsigned int selector,
  473. const char * const **groups,
  474. unsigned int * const num_groups)
  475. {
  476. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  477. *groups = pinctrl->functions[selector].groups;
  478. *num_groups = pinctrl->functions[selector].num_groups;
  479. return 0;
  480. }
  481. static int ns2_pinmux_set(struct ns2_pinctrl *pinctrl,
  482. const struct ns2_pin_function *func,
  483. const struct ns2_pin_group *grp,
  484. struct ns2_mux_log *mux_log)
  485. {
  486. const struct ns2_mux *mux = &grp->mux;
  487. int i;
  488. u32 val, mask;
  489. unsigned long flags;
  490. void __iomem *base_address;
  491. for (i = 0; i < NS2_NUM_IOMUX; i++) {
  492. if ((mux->shift != mux_log[i].mux.shift) ||
  493. (mux->base != mux_log[i].mux.base) ||
  494. (mux->offset != mux_log[i].mux.offset))
  495. continue;
  496. /* if this is a new configuration, just do it! */
  497. if (!mux_log[i].is_configured)
  498. break;
  499. /*
  500. * IOMUX has been configured previously and one is trying to
  501. * configure it to a different function
  502. */
  503. if (mux_log[i].mux.alt != mux->alt) {
  504. dev_err(pinctrl->dev,
  505. "double configuration error detected!\n");
  506. dev_err(pinctrl->dev, "func:%s grp:%s\n",
  507. func->name, grp->name);
  508. return -EINVAL;
  509. }
  510. return 0;
  511. }
  512. if (i == NS2_NUM_IOMUX)
  513. return -EINVAL;
  514. mask = mux->mask;
  515. mux_log[i].mux.alt = mux->alt;
  516. mux_log[i].is_configured = true;
  517. switch (mux->base) {
  518. case NS2_PIN_MUX_BASE0:
  519. base_address = pinctrl->base0;
  520. break;
  521. case NS2_PIN_MUX_BASE1:
  522. base_address = pinctrl->base1;
  523. break;
  524. default:
  525. return -EINVAL;
  526. }
  527. spin_lock_irqsave(&pinctrl->lock, flags);
  528. val = readl(base_address + grp->mux.offset);
  529. val &= ~(mask << grp->mux.shift);
  530. val |= grp->mux.alt << grp->mux.shift;
  531. writel(val, (base_address + grp->mux.offset));
  532. spin_unlock_irqrestore(&pinctrl->lock, flags);
  533. return 0;
  534. }
  535. static int ns2_pinmux_enable(struct pinctrl_dev *pctrl_dev,
  536. unsigned int func_select, unsigned int grp_select)
  537. {
  538. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrl_dev);
  539. const struct ns2_pin_function *func;
  540. const struct ns2_pin_group *grp;
  541. if (grp_select >= pinctrl->num_groups ||
  542. func_select >= pinctrl->num_functions)
  543. return -EINVAL;
  544. func = &pinctrl->functions[func_select];
  545. grp = &pinctrl->groups[grp_select];
  546. dev_dbg(pctrl_dev->dev, "func:%u name:%s grp:%u name:%s\n",
  547. func_select, func->name, grp_select, grp->name);
  548. dev_dbg(pctrl_dev->dev, "offset:0x%08x shift:%u alt:%u\n",
  549. grp->mux.offset, grp->mux.shift, grp->mux.alt);
  550. return ns2_pinmux_set(pinctrl, func, grp, pinctrl->mux_log);
  551. }
  552. static int ns2_pin_set_enable(struct pinctrl_dev *pctrldev, unsigned int pin,
  553. u16 enable)
  554. {
  555. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  556. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  557. unsigned long flags;
  558. u32 val;
  559. void __iomem *base_address;
  560. base_address = pinctrl->pinconf_base;
  561. spin_lock_irqsave(&pinctrl->lock, flags);
  562. val = readl(base_address + pin_data->pin_conf.offset);
  563. val &= ~(NS2_PIN_SRC_MASK << pin_data->pin_conf.input_en);
  564. if (!enable)
  565. val |= NS2_PIN_INPUT_EN_MASK << pin_data->pin_conf.input_en;
  566. writel(val, (base_address + pin_data->pin_conf.offset));
  567. spin_unlock_irqrestore(&pinctrl->lock, flags);
  568. dev_dbg(pctrldev->dev, "pin:%u set enable:%d\n", pin, enable);
  569. return 0;
  570. }
  571. static int ns2_pin_get_enable(struct pinctrl_dev *pctrldev, unsigned int pin)
  572. {
  573. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  574. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  575. unsigned long flags;
  576. int enable;
  577. spin_lock_irqsave(&pinctrl->lock, flags);
  578. enable = readl(pinctrl->pinconf_base + pin_data->pin_conf.offset);
  579. enable = (enable >> pin_data->pin_conf.input_en) &
  580. NS2_PIN_INPUT_EN_MASK;
  581. spin_unlock_irqrestore(&pinctrl->lock, flags);
  582. if (!enable)
  583. enable = NS2_PIN_INPUT_EN_MASK;
  584. else
  585. enable = 0;
  586. dev_dbg(pctrldev->dev, "pin:%u get disable:%d\n", pin, enable);
  587. return enable;
  588. }
  589. static int ns2_pin_set_slew(struct pinctrl_dev *pctrldev, unsigned int pin,
  590. u32 slew)
  591. {
  592. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  593. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  594. unsigned long flags;
  595. u32 val;
  596. void __iomem *base_address;
  597. base_address = pinctrl->pinconf_base;
  598. spin_lock_irqsave(&pinctrl->lock, flags);
  599. val = readl(base_address + pin_data->pin_conf.offset);
  600. val &= ~(NS2_PIN_SRC_MASK << pin_data->pin_conf.src_shift);
  601. if (slew)
  602. val |= NS2_PIN_SRC_MASK << pin_data->pin_conf.src_shift;
  603. writel(val, (base_address + pin_data->pin_conf.offset));
  604. spin_unlock_irqrestore(&pinctrl->lock, flags);
  605. dev_dbg(pctrldev->dev, "pin:%u set slew:%d\n", pin, slew);
  606. return 0;
  607. }
  608. static int ns2_pin_get_slew(struct pinctrl_dev *pctrldev, unsigned int pin,
  609. u16 *slew)
  610. {
  611. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  612. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  613. unsigned long flags;
  614. u32 val;
  615. spin_lock_irqsave(&pinctrl->lock, flags);
  616. val = readl(pinctrl->pinconf_base + pin_data->pin_conf.offset);
  617. *slew = (val >> pin_data->pin_conf.src_shift) & NS2_PIN_SRC_MASK;
  618. spin_unlock_irqrestore(&pinctrl->lock, flags);
  619. dev_dbg(pctrldev->dev, "pin:%u get slew:%d\n", pin, *slew);
  620. return 0;
  621. }
  622. static int ns2_pin_set_pull(struct pinctrl_dev *pctrldev, unsigned int pin,
  623. bool pull_up, bool pull_down)
  624. {
  625. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  626. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  627. unsigned long flags;
  628. u32 val;
  629. void __iomem *base_address;
  630. base_address = pinctrl->pinconf_base;
  631. spin_lock_irqsave(&pinctrl->lock, flags);
  632. val = readl(base_address + pin_data->pin_conf.offset);
  633. val &= ~(NS2_PIN_PULL_MASK << pin_data->pin_conf.pull_shift);
  634. if (pull_up == true)
  635. val |= NS2_PIN_PULL_UP << pin_data->pin_conf.pull_shift;
  636. if (pull_down == true)
  637. val |= NS2_PIN_PULL_DOWN << pin_data->pin_conf.pull_shift;
  638. writel(val, (base_address + pin_data->pin_conf.offset));
  639. spin_unlock_irqrestore(&pinctrl->lock, flags);
  640. dev_dbg(pctrldev->dev, "pin:%u set pullup:%d pulldown: %d\n",
  641. pin, pull_up, pull_down);
  642. return 0;
  643. }
  644. static void ns2_pin_get_pull(struct pinctrl_dev *pctrldev,
  645. unsigned int pin, bool *pull_up,
  646. bool *pull_down)
  647. {
  648. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  649. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  650. unsigned long flags;
  651. u32 val;
  652. spin_lock_irqsave(&pinctrl->lock, flags);
  653. val = readl(pinctrl->pinconf_base + pin_data->pin_conf.offset);
  654. val = (val >> pin_data->pin_conf.pull_shift) & NS2_PIN_PULL_MASK;
  655. *pull_up = false;
  656. *pull_down = false;
  657. if (val == NS2_PIN_PULL_UP)
  658. *pull_up = true;
  659. if (val == NS2_PIN_PULL_DOWN)
  660. *pull_down = true;
  661. spin_unlock_irqrestore(&pinctrl->lock, flags);
  662. }
  663. static int ns2_pin_set_strength(struct pinctrl_dev *pctrldev, unsigned int pin,
  664. u32 strength)
  665. {
  666. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  667. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  668. u32 val;
  669. unsigned long flags;
  670. void __iomem *base_address;
  671. /* make sure drive strength is supported */
  672. if (strength < 2 || strength > 16 || (strength % 2))
  673. return -ENOTSUPP;
  674. base_address = pinctrl->pinconf_base;
  675. spin_lock_irqsave(&pinctrl->lock, flags);
  676. val = readl(base_address + pin_data->pin_conf.offset);
  677. val &= ~(NS2_PIN_DRIVE_STRENGTH_MASK << pin_data->pin_conf.drive_shift);
  678. val |= ((strength / 2) - 1) << pin_data->pin_conf.drive_shift;
  679. writel(val, (base_address + pin_data->pin_conf.offset));
  680. spin_unlock_irqrestore(&pinctrl->lock, flags);
  681. dev_dbg(pctrldev->dev, "pin:%u set drive strength:%d mA\n",
  682. pin, strength);
  683. return 0;
  684. }
  685. static int ns2_pin_get_strength(struct pinctrl_dev *pctrldev, unsigned int pin,
  686. u16 *strength)
  687. {
  688. struct ns2_pinctrl *pinctrl = pinctrl_dev_get_drvdata(pctrldev);
  689. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  690. u32 val;
  691. unsigned long flags;
  692. spin_lock_irqsave(&pinctrl->lock, flags);
  693. val = readl(pinctrl->pinconf_base + pin_data->pin_conf.offset);
  694. *strength = (val >> pin_data->pin_conf.drive_shift) &
  695. NS2_PIN_DRIVE_STRENGTH_MASK;
  696. *strength = (*strength + 1) * 2;
  697. spin_unlock_irqrestore(&pinctrl->lock, flags);
  698. dev_dbg(pctrldev->dev, "pin:%u get drive strength:%d mA\n",
  699. pin, *strength);
  700. return 0;
  701. }
  702. static int ns2_pin_config_get(struct pinctrl_dev *pctldev, unsigned int pin,
  703. unsigned long *config)
  704. {
  705. struct ns2_pin *pin_data = pctldev->desc->pins[pin].drv_data;
  706. enum pin_config_param param = pinconf_to_config_param(*config);
  707. bool pull_up, pull_down;
  708. u16 arg = 0;
  709. int ret;
  710. if (pin_data->pin_conf.base == -1)
  711. return -ENOTSUPP;
  712. switch (param) {
  713. case PIN_CONFIG_BIAS_DISABLE:
  714. ns2_pin_get_pull(pctldev, pin, &pull_up, &pull_down);
  715. if (!pull_up && !pull_down)
  716. return 0;
  717. else
  718. return -EINVAL;
  719. case PIN_CONFIG_BIAS_PULL_UP:
  720. ns2_pin_get_pull(pctldev, pin, &pull_up, &pull_down);
  721. if (pull_up)
  722. return 0;
  723. else
  724. return -EINVAL;
  725. case PIN_CONFIG_BIAS_PULL_DOWN:
  726. ns2_pin_get_pull(pctldev, pin, &pull_up, &pull_down);
  727. if (pull_down)
  728. return 0;
  729. else
  730. return -EINVAL;
  731. case PIN_CONFIG_DRIVE_STRENGTH:
  732. ret = ns2_pin_get_strength(pctldev, pin, &arg);
  733. if (ret)
  734. return ret;
  735. *config = pinconf_to_config_packed(param, arg);
  736. return 0;
  737. case PIN_CONFIG_SLEW_RATE:
  738. ret = ns2_pin_get_slew(pctldev, pin, &arg);
  739. if (ret)
  740. return ret;
  741. *config = pinconf_to_config_packed(param, arg);
  742. return 0;
  743. case PIN_CONFIG_INPUT_ENABLE:
  744. ret = ns2_pin_get_enable(pctldev, pin);
  745. if (ret)
  746. return 0;
  747. else
  748. return -EINVAL;
  749. default:
  750. return -ENOTSUPP;
  751. }
  752. }
  753. static int ns2_pin_config_set(struct pinctrl_dev *pctrldev, unsigned int pin,
  754. unsigned long *configs, unsigned int num_configs)
  755. {
  756. struct ns2_pin *pin_data = pctrldev->desc->pins[pin].drv_data;
  757. enum pin_config_param param;
  758. unsigned int i;
  759. u32 arg;
  760. int ret = -ENOTSUPP;
  761. if (pin_data->pin_conf.base == -1)
  762. return -ENOTSUPP;
  763. for (i = 0; i < num_configs; i++) {
  764. param = pinconf_to_config_param(configs[i]);
  765. arg = pinconf_to_config_argument(configs[i]);
  766. switch (param) {
  767. case PIN_CONFIG_BIAS_DISABLE:
  768. ret = ns2_pin_set_pull(pctrldev, pin, false, false);
  769. if (ret < 0)
  770. goto out;
  771. break;
  772. case PIN_CONFIG_BIAS_PULL_UP:
  773. ret = ns2_pin_set_pull(pctrldev, pin, true, false);
  774. if (ret < 0)
  775. goto out;
  776. break;
  777. case PIN_CONFIG_BIAS_PULL_DOWN:
  778. ret = ns2_pin_set_pull(pctrldev, pin, false, true);
  779. if (ret < 0)
  780. goto out;
  781. break;
  782. case PIN_CONFIG_DRIVE_STRENGTH:
  783. ret = ns2_pin_set_strength(pctrldev, pin, arg);
  784. if (ret < 0)
  785. goto out;
  786. break;
  787. case PIN_CONFIG_SLEW_RATE:
  788. ret = ns2_pin_set_slew(pctrldev, pin, arg);
  789. if (ret < 0)
  790. goto out;
  791. break;
  792. case PIN_CONFIG_INPUT_ENABLE:
  793. ret = ns2_pin_set_enable(pctrldev, pin, arg);
  794. if (ret < 0)
  795. goto out;
  796. break;
  797. default:
  798. dev_err(pctrldev->dev, "invalid configuration\n");
  799. return -ENOTSUPP;
  800. }
  801. }
  802. out:
  803. return ret;
  804. }
  805. static const struct pinmux_ops ns2_pinmux_ops = {
  806. .get_functions_count = ns2_get_functions_count,
  807. .get_function_name = ns2_get_function_name,
  808. .get_function_groups = ns2_get_function_groups,
  809. .set_mux = ns2_pinmux_enable,
  810. };
  811. static const struct pinconf_ops ns2_pinconf_ops = {
  812. .is_generic = true,
  813. .pin_config_get = ns2_pin_config_get,
  814. .pin_config_set = ns2_pin_config_set,
  815. };
  816. static struct pinctrl_desc ns2_pinctrl_desc = {
  817. .name = "ns2-pinmux",
  818. .pctlops = &ns2_pinctrl_ops,
  819. .pmxops = &ns2_pinmux_ops,
  820. .confops = &ns2_pinconf_ops,
  821. };
  822. static int ns2_mux_log_init(struct ns2_pinctrl *pinctrl)
  823. {
  824. struct ns2_mux_log *log;
  825. unsigned int i;
  826. pinctrl->mux_log = devm_kcalloc(pinctrl->dev, NS2_NUM_IOMUX,
  827. sizeof(struct ns2_mux_log),
  828. GFP_KERNEL);
  829. if (!pinctrl->mux_log)
  830. return -ENOMEM;
  831. for (i = 0; i < NS2_NUM_IOMUX; i++)
  832. pinctrl->mux_log[i].is_configured = false;
  833. /* Group 0 uses bit 31 in the IOMUX_PAD_FUNCTION_0 register */
  834. log = &pinctrl->mux_log[0];
  835. log->mux.base = NS2_PIN_MUX_BASE0;
  836. log->mux.offset = 0;
  837. log->mux.shift = 31;
  838. log->mux.alt = 0;
  839. /*
  840. * Groups 1 through 14 use two bits each in the
  841. * IOMUX_PAD_FUNCTION_1 register starting with
  842. * bit position 30.
  843. */
  844. for (i = 1; i < (NS2_NUM_IOMUX - NS2_NUM_PWM_MUX); i++) {
  845. log = &pinctrl->mux_log[i];
  846. log->mux.base = NS2_PIN_MUX_BASE0;
  847. log->mux.offset = NS2_MUX_PAD_FUNC1_OFFSET;
  848. log->mux.shift = 32 - (i * 2);
  849. log->mux.alt = 0;
  850. }
  851. /*
  852. * Groups 15 through 18 use one bit each in the
  853. * AUX_SEL register.
  854. */
  855. for (i = 0; i < NS2_NUM_PWM_MUX; i++) {
  856. log = &pinctrl->mux_log[(NS2_NUM_IOMUX - NS2_NUM_PWM_MUX) + i];
  857. log->mux.base = NS2_PIN_MUX_BASE1;
  858. log->mux.offset = 0;
  859. log->mux.shift = i;
  860. log->mux.alt = 0;
  861. }
  862. return 0;
  863. }
  864. static int ns2_pinmux_probe(struct platform_device *pdev)
  865. {
  866. struct ns2_pinctrl *pinctrl;
  867. struct resource *res;
  868. int i, ret;
  869. struct pinctrl_pin_desc *pins;
  870. unsigned int num_pins = ARRAY_SIZE(ns2_pins);
  871. pinctrl = devm_kzalloc(&pdev->dev, sizeof(*pinctrl), GFP_KERNEL);
  872. if (!pinctrl)
  873. return -ENOMEM;
  874. pinctrl->dev = &pdev->dev;
  875. platform_set_drvdata(pdev, pinctrl);
  876. spin_lock_init(&pinctrl->lock);
  877. pinctrl->base0 = devm_platform_ioremap_resource(pdev, 0);
  878. if (IS_ERR(pinctrl->base0))
  879. return PTR_ERR(pinctrl->base0);
  880. res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  881. if (!res)
  882. return -EINVAL;
  883. pinctrl->base1 = devm_ioremap(&pdev->dev, res->start,
  884. resource_size(res));
  885. if (!pinctrl->base1) {
  886. dev_err(&pdev->dev, "unable to map I/O space\n");
  887. return -ENOMEM;
  888. }
  889. pinctrl->pinconf_base = devm_platform_ioremap_resource(pdev, 2);
  890. if (IS_ERR(pinctrl->pinconf_base))
  891. return PTR_ERR(pinctrl->pinconf_base);
  892. ret = ns2_mux_log_init(pinctrl);
  893. if (ret) {
  894. dev_err(&pdev->dev, "unable to initialize IOMUX log\n");
  895. return ret;
  896. }
  897. pins = devm_kcalloc(&pdev->dev, num_pins, sizeof(*pins), GFP_KERNEL);
  898. if (!pins)
  899. return -ENOMEM;
  900. for (i = 0; i < num_pins; i++) {
  901. pins[i].number = ns2_pins[i].pin;
  902. pins[i].name = ns2_pins[i].name;
  903. pins[i].drv_data = &ns2_pins[i];
  904. }
  905. pinctrl->groups = ns2_pin_groups;
  906. pinctrl->num_groups = ARRAY_SIZE(ns2_pin_groups);
  907. pinctrl->functions = ns2_pin_functions;
  908. pinctrl->num_functions = ARRAY_SIZE(ns2_pin_functions);
  909. ns2_pinctrl_desc.pins = pins;
  910. ns2_pinctrl_desc.npins = num_pins;
  911. pinctrl->pctl = pinctrl_register(&ns2_pinctrl_desc, &pdev->dev,
  912. pinctrl);
  913. if (IS_ERR(pinctrl->pctl)) {
  914. dev_err(&pdev->dev, "unable to register IOMUX pinctrl\n");
  915. return PTR_ERR(pinctrl->pctl);
  916. }
  917. return 0;
  918. }
  919. static const struct of_device_id ns2_pinmux_of_match[] = {
  920. {.compatible = "brcm,ns2-pinmux"},
  921. { }
  922. };
  923. static struct platform_driver ns2_pinmux_driver = {
  924. .driver = {
  925. .name = "ns2-pinmux",
  926. .of_match_table = ns2_pinmux_of_match,
  927. },
  928. .probe = ns2_pinmux_probe,
  929. };
  930. static int __init ns2_pinmux_init(void)
  931. {
  932. return platform_driver_register(&ns2_pinmux_driver);
  933. }
  934. arch_initcall(ns2_pinmux_init);