1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2007-2011
4 * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
5 * Tom Cubie <tangliang@allwinnertech.com>
6 */
7
8 #include <common.h>
9 #include <asm/io.h>
10 #include <asm/arch/gpio.h>
11
sunxi_gpio_set_cfgbank(struct sunxi_gpio * pio,int bank_offset,u32 val)12 void sunxi_gpio_set_cfgbank(struct sunxi_gpio *pio, int bank_offset, u32 val)
13 {
14 u32 index = GPIO_CFG_INDEX(bank_offset);
15 u32 offset = GPIO_CFG_OFFSET(bank_offset);
16
17 clrsetbits_le32(&pio->cfg[0] + index, 0xf << offset, val << offset);
18 }
19
sunxi_gpio_set_cfgpin(u32 pin,u32 val)20 void sunxi_gpio_set_cfgpin(u32 pin, u32 val)
21 {
22 u32 bank = GPIO_BANK(pin);
23 struct sunxi_gpio *pio = BANK_TO_GPIO(bank);
24
25 sunxi_gpio_set_cfgbank(pio, pin, val);
26 }
27
sunxi_gpio_get_cfgbank(struct sunxi_gpio * pio,int bank_offset)28 int sunxi_gpio_get_cfgbank(struct sunxi_gpio *pio, int bank_offset)
29 {
30 u32 index = GPIO_CFG_INDEX(bank_offset);
31 u32 offset = GPIO_CFG_OFFSET(bank_offset);
32 u32 cfg;
33
34 cfg = readl(&pio->cfg[0] + index);
35 cfg >>= offset;
36
37 return cfg & 0xf;
38 }
39
sunxi_gpio_get_cfgpin(u32 pin)40 int sunxi_gpio_get_cfgpin(u32 pin)
41 {
42 u32 bank = GPIO_BANK(pin);
43 struct sunxi_gpio *pio = BANK_TO_GPIO(bank);
44
45 return sunxi_gpio_get_cfgbank(pio, pin);
46 }
47
sunxi_gpio_set_drv(u32 pin,u32 val)48 int sunxi_gpio_set_drv(u32 pin, u32 val)
49 {
50 u32 bank = GPIO_BANK(pin);
51 u32 index = GPIO_DRV_INDEX(pin);
52 u32 offset = GPIO_DRV_OFFSET(pin);
53 struct sunxi_gpio *pio = BANK_TO_GPIO(bank);
54
55 clrsetbits_le32(&pio->drv[0] + index, 0x3 << offset, val << offset);
56
57 return 0;
58 }
59
sunxi_gpio_set_pull(u32 pin,u32 val)60 int sunxi_gpio_set_pull(u32 pin, u32 val)
61 {
62 u32 bank = GPIO_BANK(pin);
63 u32 index = GPIO_PULL_INDEX(pin);
64 u32 offset = GPIO_PULL_OFFSET(pin);
65 struct sunxi_gpio *pio = BANK_TO_GPIO(bank);
66
67 clrsetbits_le32(&pio->pull[0] + index, 0x3 << offset, val << offset);
68
69 return 0;
70 }
71