brintos

brintos / linux-shallow public Read only

0
0
Text · 25.6 KiB · dd93f12 Raw
999 lines · c
1/*2 * Driver for the Axis ARTPEC-6 pin controller3 *4 * Author: Chris Paterson <chris.paterson@linux.pieboy.co.uk>5 *6 * This file is licensed under the terms of the GNU General Public7 * License version 2. This program is licensed "as is" without any8 * warranty of any kind, whether express or implied.9 */10 11#include <linux/device.h>12#include <linux/err.h>13#include <linux/init.h>14#include <linux/io.h>15#include <linux/of.h>16#include <linux/platform_device.h>17#include <linux/pinctrl/pinctrl.h>18#include <linux/pinctrl/pinconf-generic.h>19#include <linux/pinctrl/pinconf.h>20#include <linux/pinctrl/pinmux.h>21#include <linux/slab.h>22#include "core.h"23#include "pinconf.h"24#include "pinctrl-utils.h"25 26#define ARTPEC6_LAST_PIN	97	/* 97 pins in pinmux */27#define ARTPEC6_MAX_MUXABLE	35	/* Last pin with muxable function */28 29/* Pinmux control register bit definitions */30#define ARTPEC6_PINMUX_UDC0_MASK	0x0000000131#define ARTPEC6_PINMUX_UDC0_SHIFT	032#define ARTPEC6_PINMUX_UDC1_MASK	0x0000000233#define ARTPEC6_PINMUX_UDC1_SHIFT	134#define ARTPEC6_PINMUX_DRV_MASK		0x0000006035#define ARTPEC6_PINMUX_DRV_SHIFT	536#define ARTPEC6_PINMUX_SEL_MASK		0x0000300037#define ARTPEC6_PINMUX_SEL_SHIFT	1238 39/* Pinmux configurations */40#define ARTPEC6_CONFIG_0		041#define ARTPEC6_CONFIG_1		142#define ARTPEC6_CONFIG_2		243#define ARTPEC6_CONFIG_3		344 45/* Pin drive strength options */46#define ARTPEC6_DRIVE_4mA		447#define ARTPEC6_DRIVE_4mA_SET		048#define ARTPEC6_DRIVE_6mA		649#define ARTPEC6_DRIVE_6mA_SET		150#define ARTPEC6_DRIVE_8mA		851#define ARTPEC6_DRIVE_8mA_SET		252#define ARTPEC6_DRIVE_9mA		953#define ARTPEC6_DRIVE_9mA_SET		354 55struct artpec6_pmx {56	struct device			*dev;57	struct pinctrl_dev		*pctl;58	void __iomem			*base;59	struct pinctrl_pin_desc		*pins;60	unsigned int			num_pins;61	const struct artpec6_pin_group	*pin_groups;62	unsigned int			num_pin_groups;63	const struct artpec6_pmx_func	*functions;64	unsigned int			num_functions;65};66 67struct artpec6_pin_group {68	const char	   *name;69	const unsigned int *pins;70	const unsigned int num_pins;71	unsigned char	   config;72};73 74struct artpec6_pmx_func {75	const char	   *name;76	const char * const *groups;77	const unsigned int num_groups;78};79 80/* pins */81static struct pinctrl_pin_desc artpec6_pins[] = {82	PINCTRL_PIN(0, "GPIO0"),83	PINCTRL_PIN(1, "GPIO1"),84	PINCTRL_PIN(2, "GPIO2"),85	PINCTRL_PIN(3, "GPIO3"),86	PINCTRL_PIN(4, "GPIO4"),87	PINCTRL_PIN(5, "GPIO5"),88	PINCTRL_PIN(6, "GPIO6"),89	PINCTRL_PIN(7, "GPIO7"),90	PINCTRL_PIN(8, "GPIO8"),91	PINCTRL_PIN(9, "GPIO9"),92	PINCTRL_PIN(10, "GPIO10"),93	PINCTRL_PIN(11, "GPIO11"),94	PINCTRL_PIN(12, "GPIO12"),95	PINCTRL_PIN(13, "GPIO13"),96	PINCTRL_PIN(14, "GPIO14"),97	PINCTRL_PIN(15, "GPIO15"),98	PINCTRL_PIN(16, "GPIO16"),99	PINCTRL_PIN(17, "GPIO17"),100	PINCTRL_PIN(18, "GPIO18"),101	PINCTRL_PIN(19, "GPIO19"),102	PINCTRL_PIN(20, "GPIO20"),103	PINCTRL_PIN(21, "GPIO21"),104	PINCTRL_PIN(22, "GPIO22"),105	PINCTRL_PIN(23, "GPIO23"),106	PINCTRL_PIN(24, "GPIO24"),107	PINCTRL_PIN(25, "GPIO25"),108	PINCTRL_PIN(26, "GPIO26"),109	PINCTRL_PIN(27, "GPIO27"),110	PINCTRL_PIN(28, "GPIO28"),111	PINCTRL_PIN(29, "GPIO29"),112	PINCTRL_PIN(30, "GPIO30"),113	PINCTRL_PIN(31, "GPIO31"),114	PINCTRL_PIN(32, "UART3_TXD"),115	PINCTRL_PIN(33, "UART3_RXD"),116	PINCTRL_PIN(34, "UART3_RTS"),117	PINCTRL_PIN(35, "UART3_CTS"),118	PINCTRL_PIN(36, "NF_ALE"),119	PINCTRL_PIN(37, "NF_CE0_N"),120	PINCTRL_PIN(38, "NF_CE1_N"),121	PINCTRL_PIN(39, "NF_CLE"),122	PINCTRL_PIN(40, "NF_RE_N"),123	PINCTRL_PIN(41, "NF_WE_N"),124	PINCTRL_PIN(42, "NF_WP0_N"),125	PINCTRL_PIN(43, "NF_WP1_N"),126	PINCTRL_PIN(44, "NF_IO0"),127	PINCTRL_PIN(45, "NF_IO1"),128	PINCTRL_PIN(46, "NF_IO2"),129	PINCTRL_PIN(47, "NF_IO3"),130	PINCTRL_PIN(48, "NF_IO4"),131	PINCTRL_PIN(49, "NF_IO5"),132	PINCTRL_PIN(50, "NF_IO6"),133	PINCTRL_PIN(51, "NF_IO7"),134	PINCTRL_PIN(52, "NF_RB0_N"),135	PINCTRL_PIN(53, "SDIO0_CLK"),136	PINCTRL_PIN(54, "SDIO0_CMD"),137	PINCTRL_PIN(55, "SDIO0_DAT0"),138	PINCTRL_PIN(56, "SDIO0_DAT1"),139	PINCTRL_PIN(57, "SDIO0_DAT2"),140	PINCTRL_PIN(58, "SDIO0_DAT3"),141	PINCTRL_PIN(59, "SDI0_CD"),142	PINCTRL_PIN(60, "SDI0_WP"),143	PINCTRL_PIN(61, "SDIO1_CLK"),144	PINCTRL_PIN(62, "SDIO1_CMD"),145	PINCTRL_PIN(63, "SDIO1_DAT0"),146	PINCTRL_PIN(64, "SDIO1_DAT1"),147	PINCTRL_PIN(65, "SDIO1_DAT2"),148	PINCTRL_PIN(66, "SDIO1_DAT3"),149	PINCTRL_PIN(67, "SDIO1_CD"),150	PINCTRL_PIN(68, "SDIO1_WP"),151	PINCTRL_PIN(69, "GBE_REFCLk"),152	PINCTRL_PIN(70, "GBE_GTX_CLK"),153	PINCTRL_PIN(71, "GBE_TX_CLK"),154	PINCTRL_PIN(72, "GBE_TX_EN"),155	PINCTRL_PIN(73, "GBE_TX_ER"),156	PINCTRL_PIN(74, "GBE_TXD0"),157	PINCTRL_PIN(75, "GBE_TXD1"),158	PINCTRL_PIN(76, "GBE_TXD2"),159	PINCTRL_PIN(77, "GBE_TXD3"),160	PINCTRL_PIN(78, "GBE_TXD4"),161	PINCTRL_PIN(79, "GBE_TXD5"),162	PINCTRL_PIN(80, "GBE_TXD6"),163	PINCTRL_PIN(81, "GBE_TXD7"),164	PINCTRL_PIN(82, "GBE_RX_CLK"),165	PINCTRL_PIN(83, "GBE_RX_DV"),166	PINCTRL_PIN(84, "GBE_RX_ER"),167	PINCTRL_PIN(85, "GBE_RXD0"),168	PINCTRL_PIN(86, "GBE_RXD1"),169	PINCTRL_PIN(87, "GBE_RXD2"),170	PINCTRL_PIN(88, "GBE_RXD3"),171	PINCTRL_PIN(89, "GBE_RXD4"),172	PINCTRL_PIN(90, "GBE_RXD5"),173	PINCTRL_PIN(91, "GBE_RXD6"),174	PINCTRL_PIN(92, "GBE_RXD7"),175	PINCTRL_PIN(93, "GBE_CRS"),176	PINCTRL_PIN(94, "GBE_COL"),177	PINCTRL_PIN(95, "GBE_MDC"),178	PINCTRL_PIN(96, "GBE_MDIO"),179};180 181static const unsigned int cpuclkout_pins0[] = { 0 };182static const unsigned int udlclkout_pins0[] = { 1 };183static const unsigned int i2c1_pins0[] = { 2, 3 };184static const unsigned int i2c2_pins0[] = { 4, 5 };185static const unsigned int i2c3_pins0[] = { 6, 7 };186static const unsigned int i2s0_pins0[] = { 8, 9, 10, 11 };187static const unsigned int i2s1_pins0[] = { 12, 13, 14, 15 };188static const unsigned int i2srefclk_pins0[] = { 19 };189static const unsigned int spi0_pins0[] = { 12, 13, 14, 15 };190static const unsigned int spi1_pins0[] = { 16, 17, 18, 19 };191static const unsigned int pciedebug_pins0[] = { 12, 13, 14, 15 };192static const unsigned int uart0_pins0[] = { 16, 17, 18, 19, 20,193					    21, 22, 23, 24, 25 };194static const unsigned int uart0_pins1[] = { 20, 21, 22, 23 };195static const unsigned int uart1_pins0[] = { 24, 25, 26, 27 };196static const unsigned int uart2_pins0[] = { 26, 27, 28, 29, 30,197					    31, 32, 33, 34, 35 };198static const unsigned int uart2_pins1[] = { 28, 29, 30, 31 };199static const unsigned int uart3_pins0[] = { 32, 33, 34, 35 };200static const unsigned int uart4_pins0[] = { 20, 21, 22, 23 };201static const unsigned int uart5_pins0[] = { 28, 29, 30, 31 };202static const unsigned int nand_pins0[]  = { 36, 37, 38, 39, 40, 41,203					    42, 43, 44, 45, 46, 47,204					    48, 49, 50, 51, 52 };205static const unsigned int sdio0_pins0[] = { 53, 54, 55, 56, 57, 58, 59, 60 };206static const unsigned int sdio1_pins0[] = { 61, 62, 63, 64, 65, 66, 67, 68 };207static const unsigned int ethernet_pins0[]  = { 69, 70, 71, 72, 73, 74, 75,208						76, 77, 78, 79, 80, 81, 82,209						83, 84,	85, 86, 87, 88, 89,210						90, 91, 92, 93, 94, 95, 96 };211 212static const struct artpec6_pin_group artpec6_pin_groups[] = {213	{214		.name = "cpuclkoutgrp0",215		.pins = cpuclkout_pins0,216		.num_pins = ARRAY_SIZE(cpuclkout_pins0),217		.config = ARTPEC6_CONFIG_1,218	},219	{220		.name = "udlclkoutgrp0",221		.pins = udlclkout_pins0,222		.num_pins = ARRAY_SIZE(udlclkout_pins0),223		.config = ARTPEC6_CONFIG_1,224	},225	{226		.name = "i2c1grp0",227		.pins = i2c1_pins0,228		.num_pins = ARRAY_SIZE(i2c1_pins0),229		.config = ARTPEC6_CONFIG_1,230	},231	{232		.name = "i2c2grp0",233		.pins = i2c2_pins0,234		.num_pins = ARRAY_SIZE(i2c2_pins0),235		.config = ARTPEC6_CONFIG_1,236	},237	{238		.name = "i2c3grp0",239		.pins = i2c3_pins0,240		.num_pins = ARRAY_SIZE(i2c3_pins0),241		.config = ARTPEC6_CONFIG_1,242	},243	{244		.name = "i2s0grp0",245		.pins = i2s0_pins0,246		.num_pins = ARRAY_SIZE(i2s0_pins0),247		.config = ARTPEC6_CONFIG_1,248	},249	{250		.name = "i2s1grp0",251		.pins = i2s1_pins0,252		.num_pins = ARRAY_SIZE(i2s1_pins0),253		.config = ARTPEC6_CONFIG_1,254	},255	{256		.name = "i2srefclkgrp0",257		.pins = i2srefclk_pins0,258		.num_pins = ARRAY_SIZE(i2srefclk_pins0),259		.config = ARTPEC6_CONFIG_3,260	},261	{262		.name = "spi0grp0",263		.pins = spi0_pins0,264		.num_pins = ARRAY_SIZE(spi0_pins0),265		.config = ARTPEC6_CONFIG_2,266	},267	{268		.name = "spi1grp0",269		.pins = spi1_pins0,270		.num_pins = ARRAY_SIZE(spi1_pins0),271		.config = ARTPEC6_CONFIG_2,272	},273	{274		.name = "pciedebuggrp0",275		.pins = pciedebug_pins0,276		.num_pins = ARRAY_SIZE(pciedebug_pins0),277		.config = ARTPEC6_CONFIG_3,278	},279	{280		.name = "uart0grp0",	/* All pins. */281		.pins = uart0_pins0,282		.num_pins = ARRAY_SIZE(uart0_pins0),283		.config = ARTPEC6_CONFIG_1,284	},285	{286		.name = "uart0grp1",	/* RX/TX and RTS/CTS */287		.pins = uart0_pins1,288		.num_pins = ARRAY_SIZE(uart0_pins1),289		.config = ARTPEC6_CONFIG_1,290	},291	{292		.name = "uart0grp2",	/* Only RX/TX pins. */293		.pins = uart0_pins1,294		.num_pins = ARRAY_SIZE(uart0_pins1) - 2,295		.config = ARTPEC6_CONFIG_1,296	},297	{298		.name = "uart1grp0",	/* RX/TX and RTS/CTS */299		.pins = uart1_pins0,300		.num_pins = ARRAY_SIZE(uart1_pins0),301		.config = ARTPEC6_CONFIG_2,302	},303	{304		.name = "uart1grp1",	/* Only RX/TX pins. */305		.pins = uart1_pins0,306		.num_pins = 2,307		.config = ARTPEC6_CONFIG_2,308	},309	{310		.name = "uart2grp0",	/* Full pinout */311		.pins = uart2_pins0,312		.num_pins = ARRAY_SIZE(uart2_pins0),313		.config = ARTPEC6_CONFIG_1,314	},315	{316		.name = "uart2grp1",	/* RX/TX and RTS/CTS */317		.pins = uart2_pins1,318		.num_pins = ARRAY_SIZE(uart2_pins1),319		.config = ARTPEC6_CONFIG_1,320	},321	{322		.name = "uart2grp2",	/* Only RX/TX */323		.pins = uart2_pins1,324		.num_pins = 2,325		.config = ARTPEC6_CONFIG_1,326	},327	{328		.name = "uart3grp0",	/* RX/TX and CTS/RTS */329		.pins = uart3_pins0,330		.num_pins = ARRAY_SIZE(uart3_pins0),331		.config = ARTPEC6_CONFIG_0,332	},333	{334		.name = "uart3grp1",	/* Only RX/TX */335		.pins = uart3_pins0,336		.num_pins = ARRAY_SIZE(uart3_pins0),337		.config = ARTPEC6_CONFIG_0,338	},339	{340		.name = "uart4grp0",341		.pins = uart4_pins0,342		.num_pins = ARRAY_SIZE(uart4_pins0),343		.config = ARTPEC6_CONFIG_2,344	},345	{346		.name = "uart5grp0",	/* TX/RX and RTS/CTS */347		.pins = uart5_pins0,348		.num_pins = ARRAY_SIZE(uart5_pins0),349		.config = ARTPEC6_CONFIG_2,350	},351	{352		.name = "uart5grp1",	/* Only TX/RX */353		.pins = uart5_pins0,354		.num_pins = 2,355		.config = ARTPEC6_CONFIG_2,356	},357	{358		.name = "uart5nocts",	/* TX/RX/RTS */359		.pins = uart5_pins0,360		.num_pins = ARRAY_SIZE(uart5_pins0) - 1,361		.config = ARTPEC6_CONFIG_2,362	},363	{364		.name = "nandgrp0",365		.pins = nand_pins0,366		.num_pins = ARRAY_SIZE(nand_pins0),367		.config = ARTPEC6_CONFIG_0,368	},369	{370		.name = "sdio0grp0",371		.pins = sdio0_pins0,372		.num_pins = ARRAY_SIZE(sdio0_pins0),373		.config = ARTPEC6_CONFIG_0,374	},375	{376		.name = "sdio1grp0",377		.pins = sdio1_pins0,378		.num_pins = ARRAY_SIZE(sdio1_pins0),379		.config = ARTPEC6_CONFIG_0,380	},381	{382		.name = "ethernetgrp0",383		.pins = ethernet_pins0,384		.num_pins = ARRAY_SIZE(ethernet_pins0),385		.config = ARTPEC6_CONFIG_0,386	},387};388 389struct pin_register {390	unsigned int start;391	unsigned int end;392	unsigned int reg_base;393};394 395/*396 * The register map has two holes where the pin number397 * no longer fits directly with the register offset.398 * This table allows us to map this easily.399 */400static const struct pin_register pin_register[] = {401	{ 0, 35, 0x0 },		/* 0x0 - 0x8c */402	{ 36, 52, 0x100 },	/* 0x100 - 0x140 */403	{ 53, 96, 0x180 },	/* 0x180 - 0x22c */404};405 406static unsigned int artpec6_pmx_reg_offset(unsigned int pin)407{408	int i;409 410	for (i = 0; i < ARRAY_SIZE(pin_register); i++) {411		if (pin <= pin_register[i].end) {412			return (pin - pin_register[i].start) * 4 +413				pin_register[i].reg_base;414		}415	}416	/*417	 * Anything we return here is wrong, but we can only418	 * get here if pin is outside registered range.419	 */420	pr_err("%s: Impossible pin %d\n", __func__, pin);421	return 0;422}423 424static int artpec6_get_groups_count(struct pinctrl_dev *pctldev)425{426	return ARRAY_SIZE(artpec6_pin_groups);427}428 429static const char *artpec6_get_group_name(struct pinctrl_dev *pctldev,430					  unsigned int group)431{432	return artpec6_pin_groups[group].name;433}434 435static int artpec6_get_group_pins(struct pinctrl_dev *pctldev,436				  unsigned int group,437				  const unsigned int **pins,438				  unsigned int *num_pins)439{440	*pins = (unsigned int *)artpec6_pin_groups[group].pins;441	*num_pins = artpec6_pin_groups[group].num_pins;442	return 0;443}444 445static int artpec6_pconf_drive_mA_to_field(unsigned int mA)446{447	switch (mA) {448	case ARTPEC6_DRIVE_4mA:449		return ARTPEC6_DRIVE_4mA_SET;450	case ARTPEC6_DRIVE_6mA:451		return ARTPEC6_DRIVE_6mA_SET;452	case ARTPEC6_DRIVE_8mA:453		return ARTPEC6_DRIVE_8mA_SET;454	case ARTPEC6_DRIVE_9mA:455		return ARTPEC6_DRIVE_9mA_SET;456	default:457		return -EINVAL;458	}459}460 461static unsigned int artpec6_pconf_drive_field_to_mA(int field)462{463	switch (field) {464	case ARTPEC6_DRIVE_4mA_SET:465		return ARTPEC6_DRIVE_4mA;466	case ARTPEC6_DRIVE_6mA_SET:467		return ARTPEC6_DRIVE_6mA;468	case ARTPEC6_DRIVE_8mA_SET:469		return ARTPEC6_DRIVE_8mA;470	case ARTPEC6_DRIVE_9mA_SET:471		return ARTPEC6_DRIVE_9mA;472	default:473		/* Shouldn't happen */474		return 0;475	}476}477 478static const struct pinctrl_ops artpec6_pctrl_ops = {479	.get_group_pins		= artpec6_get_group_pins,480	.get_groups_count	= artpec6_get_groups_count,481	.get_group_name		= artpec6_get_group_name,482	.dt_node_to_map		= pinconf_generic_dt_node_to_map_all,483	.dt_free_map		= pinctrl_utils_free_map,484};485 486static const char * const gpiogrps[] = {487	"cpuclkoutgrp0", "udlclkoutgrp0", "i2c1grp0", "i2c2grp0",488	"i2c3grp0", "i2s0grp0", "i2s1grp0", "i2srefclkgrp0",489	"spi0grp0", "spi1grp0", "pciedebuggrp0", "uart0grp0",490	"uart0grp1", "uart0grp2", "uart1grp0", "uart1grp1",491	"uart2grp0", "uart2grp1", "uart2grp2", "uart4grp0", "uart5grp0",492	"uart5grp1", "uart5nocts",493};494static const char * const cpuclkoutgrps[] = { "cpuclkoutgrp0" };495static const char * const udlclkoutgrps[] = { "udlclkoutgrp0" };496static const char * const i2c1grps[]	  = { "i2c1grp0" };497static const char * const i2c2grps[]	  = { "i2c2grp0" };498static const char * const i2c3grps[]	  = { "i2c3grp0" };499static const char * const i2s0grps[]	  = { "i2s0grp0" };500static const char * const i2s1grps[]	  = { "i2s1grp0" };501static const char * const i2srefclkgrps[] = { "i2srefclkgrp0" };502static const char * const spi0grps[]	  = { "spi0grp0" };503static const char * const spi1grps[]	  = { "spi1grp0" };504static const char * const pciedebuggrps[] = { "pciedebuggrp0" };505static const char * const uart0grps[]	  = { "uart0grp0", "uart0grp1",506					      "uart0grp2" };507static const char * const uart1grps[]	  = { "uart1grp0", "uart1grp1" };508static const char * const uart2grps[]	  = { "uart2grp0", "uart2grp1",509					      "uart2grp2" };510static const char * const uart3grps[]	  = { "uart3grp0" };511static const char * const uart4grps[]	  = { "uart4grp0", "uart4grp1" };512static const char * const uart5grps[]	  = { "uart5grp0", "uart5grp1",513					      "uart5nocts" };514static const char * const nandgrps[]	  = { "nandgrp0" };515static const char * const sdio0grps[]	  = { "sdio0grp0" };516static const char * const sdio1grps[]	  = { "sdio1grp0" };517static const char * const ethernetgrps[]  = { "ethernetgrp0" };518 519static const struct artpec6_pmx_func artpec6_pmx_functions[] = {520	{521		.name = "gpio",522		.groups = gpiogrps,523		.num_groups = ARRAY_SIZE(gpiogrps),524	},525	{526		.name = "cpuclkout",527		.groups = cpuclkoutgrps,528		.num_groups = ARRAY_SIZE(cpuclkoutgrps),529	},530	{531		.name = "udlclkout",532		.groups = udlclkoutgrps,533		.num_groups = ARRAY_SIZE(udlclkoutgrps),534	},535	{536		.name = "i2c1",537		.groups = i2c1grps,538		.num_groups = ARRAY_SIZE(i2c1grps),539	},540	{541		.name = "i2c2",542		.groups = i2c2grps,543		.num_groups = ARRAY_SIZE(i2c2grps),544	},545	{546		.name = "i2c3",547		.groups = i2c3grps,548		.num_groups = ARRAY_SIZE(i2c3grps),549	},550	{551		.name = "i2s0",552		.groups = i2s0grps,553		.num_groups = ARRAY_SIZE(i2s0grps),554	},555	{556		.name = "i2s1",557		.groups = i2s1grps,558		.num_groups = ARRAY_SIZE(i2s1grps),559	},560	{561		.name = "i2srefclk",562		.groups = i2srefclkgrps,563		.num_groups = ARRAY_SIZE(i2srefclkgrps),564	},565	{566		.name = "spi0",567		.groups = spi0grps,568		.num_groups = ARRAY_SIZE(spi0grps),569	},570	{571		.name = "spi1",572		.groups = spi1grps,573		.num_groups = ARRAY_SIZE(spi1grps),574	},575	{576		.name = "pciedebug",577		.groups = pciedebuggrps,578		.num_groups = ARRAY_SIZE(pciedebuggrps),579	},580	{581		.name = "uart0",582		.groups = uart0grps,583		.num_groups = ARRAY_SIZE(uart0grps),584	},585	{586		.name = "uart1",587		.groups = uart1grps,588		.num_groups = ARRAY_SIZE(uart1grps),589	},590	{591		.name = "uart2",592		.groups = uart2grps,593		.num_groups = ARRAY_SIZE(uart2grps),594	},595	{596		.name = "uart3",597		.groups = uart3grps,598		.num_groups = ARRAY_SIZE(uart3grps),599	},600	{601		.name = "uart4",602		.groups = uart4grps,603		.num_groups = ARRAY_SIZE(uart4grps),604	},605	{606		.name = "uart5",607		.groups = uart5grps,608		.num_groups = ARRAY_SIZE(uart5grps),609	},610	{611		.name = "nand",612		.groups = nandgrps,613		.num_groups = ARRAY_SIZE(nandgrps),614	},615	{616		.name = "sdio0",617		.groups = sdio0grps,618		.num_groups = ARRAY_SIZE(sdio0grps),619	},620	{621		.name = "sdio1",622		.groups = sdio1grps,623		.num_groups = ARRAY_SIZE(sdio1grps),624	},625	{626		.name = "ethernet",627		.groups = ethernetgrps,628		.num_groups = ARRAY_SIZE(ethernetgrps),629	},630};631 632static int artpec6_pmx_get_functions_count(struct pinctrl_dev *pctldev)633{634	return ARRAY_SIZE(artpec6_pmx_functions);635}636 637static const char *artpec6_pmx_get_fname(struct pinctrl_dev *pctldev,638					 unsigned int function)639{640	return artpec6_pmx_functions[function].name;641}642 643static int artpec6_pmx_get_fgroups(struct pinctrl_dev *pctldev,644				   unsigned int function,645				   const char * const **groups,646				   unsigned int * const num_groups)647{648	*groups = artpec6_pmx_functions[function].groups;649	*num_groups = artpec6_pmx_functions[function].num_groups;650	return 0;651}652 653static void artpec6_pmx_select_func(struct pinctrl_dev *pctldev,654				    unsigned int function, unsigned int group,655				    bool enable)656{657	unsigned int regval, val;658	unsigned int reg;659	int i;660	struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);661 662	for (i = 0; i < artpec6_pin_groups[group].num_pins; i++) {663		/*664		 * Registers for pins above a ARTPEC6_MAX_MUXABLE665		 * do not have a SEL field and are always selected.666		 */667		if (artpec6_pin_groups[group].pins[i] > ARTPEC6_MAX_MUXABLE)668			continue;669 670		if (!strcmp(artpec6_pmx_get_fname(pctldev, function), "gpio")) {671			/* GPIO is always config 0 */672			val = ARTPEC6_CONFIG_0 << ARTPEC6_PINMUX_SEL_SHIFT;673		} else {674			if (enable)675				val = artpec6_pin_groups[group].config676					<< ARTPEC6_PINMUX_SEL_SHIFT;677			else678				val = ARTPEC6_CONFIG_0679					<< ARTPEC6_PINMUX_SEL_SHIFT;680		}681 682		reg = artpec6_pmx_reg_offset(artpec6_pin_groups[group].pins[i]);683 684		regval = readl(pmx->base + reg);685		regval &= ~ARTPEC6_PINMUX_SEL_MASK;686		regval |= val;687		writel(regval, pmx->base + reg);688	}689}690 691static int artpec6_pmx_set(struct pinctrl_dev *pctldev,692			   unsigned int function,693			   unsigned int group)694{695	struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);696 697	dev_dbg(pmx->dev, "enabling %s function for pin group %s\n",698		artpec6_pmx_get_fname(pctldev, function),699		artpec6_get_group_name(pctldev, group));700 701	artpec6_pmx_select_func(pctldev, function, group, true);702 703	return 0;704}705 706static int artpec6_pmx_request_gpio(struct pinctrl_dev *pctldev,707				    struct pinctrl_gpio_range *range,708				    unsigned int pin)709{710	struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);711	unsigned int reg = artpec6_pmx_reg_offset(pin);712	u32 val;713 714	if (pin >= 32)715		return -EINVAL;716 717	val = readl_relaxed(pmx->base + reg);718	val &= ~ARTPEC6_PINMUX_SEL_MASK;719	val |= ARTPEC6_CONFIG_0 << ARTPEC6_PINMUX_SEL_SHIFT;720	writel_relaxed(val, pmx->base + reg);721 722	return 0;723}724 725static const struct pinmux_ops artpec6_pmx_ops = {726	.get_functions_count	= artpec6_pmx_get_functions_count,727	.get_function_name	= artpec6_pmx_get_fname,728	.get_function_groups	= artpec6_pmx_get_fgroups,729	.set_mux		= artpec6_pmx_set,730	.gpio_request_enable = artpec6_pmx_request_gpio,731};732 733static int artpec6_pconf_get(struct pinctrl_dev *pctldev, unsigned int pin,734			     unsigned long *config)735{736	struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);737	enum pin_config_param param = pinconf_to_config_param(*config);738	unsigned int regval;739 740	/* Check for valid pin */741	if (pin >= pmx->num_pins) {742		dev_dbg(pmx->dev, "pinconf is not supported for pin %s\n",743			pmx->pins[pin].name);744		return -ENOTSUPP;745	}746 747	dev_dbg(pmx->dev, "getting configuration for pin %s\n",748		pmx->pins[pin].name);749 750	/* Read pin register values */751	regval = readl(pmx->base + artpec6_pmx_reg_offset(pin));752 753	/* If valid, get configuration for parameter */754	switch (param) {755	case PIN_CONFIG_BIAS_DISABLE:756		if (!(regval & ARTPEC6_PINMUX_UDC1_MASK))757			return -EINVAL;758		break;759 760	case PIN_CONFIG_BIAS_PULL_UP:761	case PIN_CONFIG_BIAS_PULL_DOWN:762		if (regval & ARTPEC6_PINMUX_UDC1_MASK)763			return -EINVAL;764 765		regval = regval & ARTPEC6_PINMUX_UDC0_MASK;766		if ((param == PIN_CONFIG_BIAS_PULL_UP && !regval) ||767		    (param == PIN_CONFIG_BIAS_PULL_DOWN && regval))768			return -EINVAL;769		break;770	case PIN_CONFIG_DRIVE_STRENGTH:771		regval = (regval & ARTPEC6_PINMUX_DRV_MASK)772			>> ARTPEC6_PINMUX_DRV_SHIFT;773		regval = artpec6_pconf_drive_field_to_mA(regval);774		*config = pinconf_to_config_packed(param, regval);775		break;776	default:777		return -ENOTSUPP;778	}779 780	return 0;781}782 783/*784 * Valid combinations of param and arg:785 *786 * param		     arg787 * PIN_CONFIG_BIAS_DISABLE:   x (disable bias)788 * PIN_CONFIG_BIAS_PULL_UP:   1 (pull up bias + enable)789 * PIN_CONFIG_BIAS_PULL_DOWN: 1 (pull down bias + enable)790 * PIN_CONFIG_DRIVE_STRENGTH: x (4mA, 6mA, 8mA, 9mA)791 *792 * All other args are invalid. All other params are not supported.793 */794static int artpec6_pconf_set(struct pinctrl_dev *pctldev, unsigned int pin,795			     unsigned long *configs, unsigned int num_configs)796{797	struct artpec6_pmx *pmx = pinctrl_dev_get_drvdata(pctldev);798	enum pin_config_param param;799	unsigned int arg;800	unsigned int regval;801	void __iomem *reg;802	int i;803 804	/* Check for valid pin */805	if (pin >= pmx->num_pins) {806		dev_dbg(pmx->dev, "pinconf is not supported for pin %s\n",807			pmx->pins[pin].name);808		return -ENOTSUPP;809	}810 811	dev_dbg(pmx->dev, "setting configuration for pin %s\n",812		pmx->pins[pin].name);813 814	reg = pmx->base + artpec6_pmx_reg_offset(pin);815 816	/* For each config */817	for (i = 0; i < num_configs; i++) {818		int drive;819 820		param = pinconf_to_config_param(configs[i]);821		arg = pinconf_to_config_argument(configs[i]);822 823		switch (param) {824		case PIN_CONFIG_BIAS_DISABLE:825			regval = readl(reg);826			regval |= (1 << ARTPEC6_PINMUX_UDC1_SHIFT);827			writel(regval, reg);828			break;829 830		case PIN_CONFIG_BIAS_PULL_UP:831			if (arg != 1) {832				dev_dbg(pctldev->dev, "%s: arg %u out of range\n",833					__func__, arg);834				return -EINVAL;835			}836 837			regval = readl(reg);838			regval |= (arg << ARTPEC6_PINMUX_UDC0_SHIFT);839			regval &= ~ARTPEC6_PINMUX_UDC1_MASK; /* Enable */840			writel(regval, reg);841			break;842 843		case PIN_CONFIG_BIAS_PULL_DOWN:844			if (arg != 1) {845				dev_dbg(pctldev->dev, "%s: arg %u out of range\n",846					__func__, arg);847				return -EINVAL;848			}849 850			regval = readl(reg);851			regval &= ~(arg << ARTPEC6_PINMUX_UDC0_SHIFT);852			regval &= ~ARTPEC6_PINMUX_UDC1_MASK; /* Enable */853			writel(regval, reg);854			break;855 856		case PIN_CONFIG_DRIVE_STRENGTH:857			drive = artpec6_pconf_drive_mA_to_field(arg);858			if (drive < 0) {859				dev_dbg(pctldev->dev, "%s: arg %u out of range\n",860					__func__, arg);861				return -EINVAL;862			}863 864			regval = readl(reg);865			regval &= ~ARTPEC6_PINMUX_DRV_MASK;866			regval |= (drive << ARTPEC6_PINMUX_DRV_SHIFT);867			writel(regval, reg);868			break;869 870		default:871			dev_dbg(pmx->dev, "parameter not supported\n");872			return -ENOTSUPP;873		}874	}875 876	return 0;877}878 879static int artpec6_pconf_group_set(struct pinctrl_dev *pctldev,880				   unsigned int group, unsigned long *configs,881				   unsigned int num_configs)882{883	unsigned int num_pins, current_pin;884	int ret;885 886	dev_dbg(pctldev->dev, "setting group %s configuration\n",887		artpec6_get_group_name(pctldev, group));888 889	num_pins = artpec6_pin_groups[group].num_pins;890 891	for (current_pin = 0; current_pin < num_pins; current_pin++) {892		ret = artpec6_pconf_set(pctldev,893				artpec6_pin_groups[group].pins[current_pin],894				configs, num_configs);895 896		if (ret < 0)897			return ret;898	}899 900	return 0;901}902 903static const struct pinconf_ops artpec6_pconf_ops = {904	.is_generic		= true,905	.pin_config_get		= artpec6_pconf_get,906	.pin_config_set		= artpec6_pconf_set,907	.pin_config_group_set	= artpec6_pconf_group_set,908};909 910static struct pinctrl_desc artpec6_desc = {911	.name	 = "artpec6-pinctrl",912	.owner	 = THIS_MODULE,913	.pins	 = artpec6_pins,914	.npins	 = ARRAY_SIZE(artpec6_pins),915	.pctlops = &artpec6_pctrl_ops,916	.pmxops	 = &artpec6_pmx_ops,917	.confops = &artpec6_pconf_ops,918};919 920/* The reset values say 4mA, but we want 8mA as default. */921static void artpec6_pmx_reset(struct artpec6_pmx *pmx)922{923	void __iomem *base = pmx->base;924	int i;925 926	for (i = 0; i < ARTPEC6_LAST_PIN; i++) {927		u32 val;928 929		val = readl_relaxed(base + artpec6_pmx_reg_offset(i));930		val &= ~ARTPEC6_PINMUX_DRV_MASK;931		val |= ARTPEC6_DRIVE_8mA_SET << ARTPEC6_PINMUX_DRV_SHIFT;932		writel_relaxed(val, base + artpec6_pmx_reg_offset(i));933	}934}935 936static int artpec6_pmx_probe(struct platform_device *pdev)937{938	struct artpec6_pmx *pmx;939 940	pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);941	if (!pmx)942		return -ENOMEM;943 944	pmx->dev = &pdev->dev;945 946	pmx->base = devm_platform_ioremap_resource(pdev, 0);947 948	if (IS_ERR(pmx->base))949		return PTR_ERR(pmx->base);950 951	artpec6_pmx_reset(pmx);952 953	pmx->pins	    = artpec6_pins;954	pmx->num_pins	    = ARRAY_SIZE(artpec6_pins);955	pmx->functions	    = artpec6_pmx_functions;956	pmx->num_functions  = ARRAY_SIZE(artpec6_pmx_functions);957	pmx->pin_groups	    = artpec6_pin_groups;958	pmx->num_pin_groups = ARRAY_SIZE(artpec6_pin_groups);959	pmx->pctl	    = pinctrl_register(&artpec6_desc, &pdev->dev, pmx);960 961	if (IS_ERR(pmx->pctl)) {962		dev_err(&pdev->dev, "could not register pinctrl driver\n");963		return PTR_ERR(pmx->pctl);964	}965 966	platform_set_drvdata(pdev, pmx);967 968	dev_info(&pdev->dev, "initialised Axis ARTPEC-6 pinctrl driver\n");969 970	return 0;971}972 973static void artpec6_pmx_remove(struct platform_device *pdev)974{975	struct artpec6_pmx *pmx = platform_get_drvdata(pdev);976 977	pinctrl_unregister(pmx->pctl);978}979 980static const struct of_device_id artpec6_pinctrl_match[] = {981	{ .compatible = "axis,artpec6-pinctrl" },982	{},983};984 985static struct platform_driver artpec6_pmx_driver = {986	.driver = {987		.name = "artpec6-pinctrl",988		.of_match_table = artpec6_pinctrl_match,989	},990	.probe = artpec6_pmx_probe,991	.remove_new = artpec6_pmx_remove,992};993 994static int __init artpec6_pmx_init(void)995{996	return platform_driver_register(&artpec6_pmx_driver);997}998arch_initcall(artpec6_pmx_init);999