[u-boot.git] / drivers / pinctrl / ath79 / pinctrl_ar933x.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (C) 2015-2016 Wills Wang <[email protected]>
 */

#include <common.h>
#include <dm.h>
#include <errno.h>
#include <log.h>
#include <asm/io.h>
#include <dm/pinctrl.h>
#include <mach/ar71xx_regs.h>

DECLARE_GLOBAL_DATA_PTR;

enum periph_id {
	PERIPH_ID_UART0,
	PERIPH_ID_SPI0,
	PERIPH_ID_NONE = -1,
};

struct ar933x_pinctrl_priv {
	void __iomem *regs;
};

static void pinctrl_ar933x_spi_config(struct ar933x_pinctrl_priv *priv, int cs)
{
	switch (cs) {
	case 0:
		clrsetbits_be32(priv->regs + AR71XX_GPIO_REG_OE,
				AR933X_GPIO(4), AR933X_GPIO(3) |
				AR933X_GPIO(5) | AR933X_GPIO(2));
		setbits_be32(priv->regs + AR71XX_GPIO_REG_FUNC,
			     AR933X_GPIO_FUNC_SPI_EN |
			     AR933X_GPIO_FUNC_RES_TRUE);
		break;
	}
}

static void pinctrl_ar933x_uart_config(struct ar933x_pinctrl_priv *priv, int uart_id)
{
	switch (uart_id) {
	case PERIPH_ID_UART0:
		clrsetbits_be32(priv->regs + AR71XX_GPIO_REG_OE,
				AR933X_GPIO(9), AR933X_GPIO(10));
		setbits_be32(priv->regs + AR71XX_GPIO_REG_FUNC,
			     AR933X_GPIO_FUNC_UART_EN |
			     AR933X_GPIO_FUNC_RES_TRUE);
		break;
	}
}

static int ar933x_pinctrl_request(struct udevice *dev, int func, int flags)
{
	struct ar933x_pinctrl_priv *priv = dev_get_priv(dev);

	debug("%s: func=%x, flags=%x\n", __func__, func, flags);
	switch (func) {
	case PERIPH_ID_SPI0:
		pinctrl_ar933x_spi_config(priv, flags);
		break;
	case PERIPH_ID_UART0:
		pinctrl_ar933x_uart_config(priv, func);
		break;
	default:
		return -EINVAL;
	}

	return 0;
}

static int ar933x_pinctrl_get_periph_id(struct udevice *dev,
					struct udevice *periph)
{
	u32 cell[2];
	int ret;

	ret = fdtdec_get_int_array(gd->fdt_blob, dev_of_offset(periph),
				   "interrupts", cell, ARRAY_SIZE(cell));
	if (ret < 0)
		return -EINVAL;

	switch (cell[0]) {
	case 128:
		return PERIPH_ID_UART0;
	case 129:
		return PERIPH_ID_SPI0;
	}
	return -ENOENT;
}

static int ar933x_pinctrl_set_state_simple(struct udevice *dev,
					   struct udevice *periph)
{
	int func;

	func = ar933x_pinctrl_get_periph_id(dev, periph);
	if (func < 0)
		return func;
	return ar933x_pinctrl_request(dev, func, 0);
}

static struct pinctrl_ops ar933x_pinctrl_ops = {
	.set_state_simple	= ar933x_pinctrl_set_state_simple,
	.request	= ar933x_pinctrl_request,
	.get_periph_id	= ar933x_pinctrl_get_periph_id,
};

static int ar933x_pinctrl_probe(struct udevice *dev)
{
	struct ar933x_pinctrl_priv *priv = dev_get_priv(dev);
	fdt_addr_t addr;

	addr = devfdt_get_addr(dev);
	if (addr == FDT_ADDR_T_NONE)
		return -EINVAL;

	priv->regs = map_physmem(addr,
				 AR71XX_GPIO_SIZE,
				 MAP_NOCACHE);
	return 0;
}

static const struct udevice_id ar933x_pinctrl_ids[] = {
	{ .compatible = "qca,ar933x-pinctrl" },
	{ }
};

U_BOOT_DRIVER(pinctrl_ar933x) = {
	.name		= "pinctrl_ar933x",
	.id		= UCLASS_PINCTRL,
	.of_match	= ar933x_pinctrl_ids,
	.priv_auto_alloc_size = sizeof(struct ar933x_pinctrl_priv),
	.ops		= &ar933x_pinctrl_ops,
	.probe		= ar933x_pinctrl_probe,
};
Commit	Line	Data
83d290c5	1	// SPDX-License-Identifier: GPL-2.0+
a79d0643 WW	2	/*
a79d0643 WW	3	* Copyright (C) 2015-2016 Wills Wang <[email protected]>
a79d0643 WW	4	*/
	5
	6	#include <common.h>
	7	#include <dm.h>
	8	#include <errno.h>
f7ae49fc	9	#include <log.h>
a79d0643 WW	10	#include <asm/io.h>
	11	#include <dm/pinctrl.h>
	12	#include <mach/ar71xx_regs.h>
	13
	14	DECLARE_GLOBAL_DATA_PTR;
	15
	16	enum periph_id {
	17	PERIPH_ID_UART0,
	18	PERIPH_ID_SPI0,
	19	PERIPH_ID_NONE = -1,
	20	};
	21
	22	struct ar933x_pinctrl_priv {
	23	void __iomem *regs;
	24	};
	25
	26	static void pinctrl_ar933x_spi_config(struct ar933x_pinctrl_priv *priv, int cs)
	27	{
	28	switch (cs) {
	29	case 0:
	30	clrsetbits_be32(priv->regs + AR71XX_GPIO_REG_OE,
	31	AR933X_GPIO(4), AR933X_GPIO(3) \|
	32	AR933X_GPIO(5) \| AR933X_GPIO(2));
	33	setbits_be32(priv->regs + AR71XX_GPIO_REG_FUNC,
	34	AR933X_GPIO_FUNC_SPI_EN \|
	35	AR933X_GPIO_FUNC_RES_TRUE);
	36	break;
	37	}
	38	}
	39
	40	static void pinctrl_ar933x_uart_config(struct ar933x_pinctrl_priv *priv, int uart_id)
	41	{
	42	switch (uart_id) {
	43	case PERIPH_ID_UART0:
	44	clrsetbits_be32(priv->regs + AR71XX_GPIO_REG_OE,
	45	AR933X_GPIO(9), AR933X_GPIO(10));
	46	setbits_be32(priv->regs + AR71XX_GPIO_REG_FUNC,
	47	AR933X_GPIO_FUNC_UART_EN \|
	48	AR933X_GPIO_FUNC_RES_TRUE);
	49	break;
	50	}
	51	}
	52
	53	static int ar933x_pinctrl_request(struct udevice *dev, int func, int flags)
	54	{
	55	struct ar933x_pinctrl_priv *priv = dev_get_priv(dev);
	56
	57	debug("%s: func=%x, flags=%x\n", __func__, func, flags);
	58	switch (func) {
	59	case PERIPH_ID_SPI0:
	60	pinctrl_ar933x_spi_config(priv, flags);
	61	break;
	62	case PERIPH_ID_UART0:
	63	pinctrl_ar933x_uart_config(priv, func);
	64	break;
	65	default:
	66	return -EINVAL;
	67	}
	68
	69	return 0;
	70	}
	71
	72	static int ar933x_pinctrl_get_periph_id(struct udevice *dev,
	73	struct udevice *periph)
74	{
75	u32 cell[2];
76	int ret;
77
e160f7d4	78	ret = fdtdec_get_int_array(gd->fdt_blob, dev_of_offset(periph),
a79d0643 WW	79	"interrupts", cell, ARRAY_SIZE(cell));
	80	if (ret < 0)
	81	return -EINVAL;
	82
	83	switch (cell[0]) {
	84	case 128:
	85	return PERIPH_ID_UART0;
	86	case 129:
	87	return PERIPH_ID_SPI0;
	88	}
	89	return -ENOENT;
	90	}
	91
	92	static int ar933x_pinctrl_set_state_simple(struct udevice *dev,
	93	struct udevice *periph)
	94	{
	95	int func;
	96
	97	func = ar933x_pinctrl_get_periph_id(dev, periph);
	98	if (func < 0)
	99	return func;
	100	return ar933x_pinctrl_request(dev, func, 0);
	101	}
	102
	103	static struct pinctrl_ops ar933x_pinctrl_ops = {
	104	.set_state_simple = ar933x_pinctrl_set_state_simple,
	105	.request = ar933x_pinctrl_request,
	106	.get_periph_id = ar933x_pinctrl_get_periph_id,
	107	};
	108
	109	static int ar933x_pinctrl_probe(struct udevice *dev)
	110	{
	111	struct ar933x_pinctrl_priv *priv = dev_get_priv(dev);
	112	fdt_addr_t addr;
	113
a821c4af	114	addr = devfdt_get_addr(dev);
a79d0643 WW	115	if (addr == FDT_ADDR_T_NONE)
	116	return -EINVAL;
	117
	118	priv->regs = map_physmem(addr,
	119	AR71XX_GPIO_SIZE,
	120	MAP_NOCACHE);
	121	return 0;
	122	}
	123
	124	static const struct udevice_id ar933x_pinctrl_ids[] = {
	125	{ .compatible = "qca,ar933x-pinctrl" },
	126	{ }
	127	};
	128
	129	U_BOOT_DRIVER(pinctrl_ar933x) = {
	130	.name = "pinctrl_ar933x",
	131	.id = UCLASS_PINCTRL,
	132	.of_match = ar933x_pinctrl_ids,
	133	.priv_auto_alloc_size = sizeof(struct ar933x_pinctrl_priv),
	134	.ops = &ar933x_pinctrl_ops,
	135	.probe = ar933x_pinctrl_probe,
	136	};