pinctrl-ns2-mux.c 33 KB

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