1// SPDX-License-Identifier: GPL-2.0+
2
3#include <config.h>
4#include <asm/io.h>
5#include <linux/bitops.h>
6#include <mach/jz4780.h>
7
8int jz47xx_gpio_get_value(unsigned int gpio)
9{
10	void __iomem *gpio_regs = (void __iomem *)GPIO_BASE;
11	int port = gpio / 32;
12	int pin = gpio % 32;
13
14	return readl(gpio_regs + GPIO_PXPIN(port)) & BIT(pin);
15}
16
17void jz47xx_gpio_direction_input(unsigned int gpio)
18{
19	void __iomem *gpio_regs = (void __iomem *)GPIO_BASE;
20	int port = gpio / 32;
21	int pin = gpio % 32;
22
23	writel(BIT(pin), gpio_regs + GPIO_PXINTC(port));
24	writel(BIT(pin), gpio_regs + GPIO_PXMASKS(port));
25	writel(BIT(pin), gpio_regs + GPIO_PXPAT1S(port));
26}
27
28void jz47xx_gpio_direction_output(unsigned int gpio, int value)
29{
30	void __iomem *gpio_regs = (void __iomem *)GPIO_BASE;
31	int port = gpio / 32;
32	int pin = gpio % 32;
33
34	writel(BIT(pin), gpio_regs + GPIO_PXINTC(port));
35	writel(BIT(pin), gpio_regs + GPIO_PXMASKS(port));
36	writel(BIT(pin), gpio_regs + GPIO_PXPAT1C(port));
37	writel(BIT(pin), gpio_regs +
38			 (value ? GPIO_PXPAT0S(port) : GPIO_PXPAT0C(port)));
39}
40