rt-thread/bsp/raspberry-pi/raspi3-64/driver/drv_gpio.c

474 lines
12 KiB
C
Raw Normal View History

2020-01-10 10:38:21 +08:00
/*
* Copyright (c) 2006-2019, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2019-07-29 zdzn first version
*/
#include "raspi.h"
#include "drv_gpio.h"
#ifdef BSP_USING_PIN
struct rpi_pin_index
{
rt_uint8_t phy_id;
rt_uint8_t bcm_id;
rt_uint8_t signal_name;
rt_uint8_t magic;
};
//raspi phy id and bcm id
static struct rpi_pin_index phypin_index[] =
{
{0, 0, 0, 0},
{1, 0, 0, 0},
{2, 0, 0, 0},
{3, BCM_GPIO_PIN_2, RPI_SDA1, PIN_MAGIC},
{4, 0, 0, 0},
{5, BCM_GPIO_PIN_3, RPI_SCL1, PIN_MAGIC},
{6, 0, 0, 0},
{7, BCM_GPIO_PIN_4, RPI_GPIO_GCLK, PIN_MAGIC},
{8, BCM_GPIO_PIN_14, RPI_TXD0, PIN_MAGIC},
{9, 0, 0, 0},
{10, BCM_GPIO_PIN_15, RPI_RXD0, PIN_MAGIC},
{11, BCM_GPIO_PIN_17, RPI_GPIO_GEN0, PIN_MAGIC},
{12, BCM_GPIO_PIN_18, RPI_GPIO_GEN1, PIN_MAGIC},
{13, BCM_GPIO_PIN_27, RPI_GPIO_GEN2, PIN_MAGIC},
{14, 0, 0, 0},
{15, BCM_GPIO_PIN_22, RPI_GPIO_GEN3, PIN_MAGIC},
{16, BCM_GPIO_PIN_23, RPI_GPIO_GEN4, PIN_MAGIC},
{17, 0, 0, 0},
{18, BCM_GPIO_PIN_24, RPI_GPIO_GEN5, PIN_MAGIC},
{19, BCM_GPIO_PIN_10, RPI_SPI_MOSI, PIN_MAGIC},
{20, 0, 0, 0},
{21, BCM_GPIO_PIN_9, RPI_SPI_MISO, PIN_MAGIC},
{22, BCM_GPIO_PIN_25, RPI_GPIO_GEN6, PIN_MAGIC},
{23, BCM_GPIO_PIN_11, RPI_SPI_SCLK, PIN_MAGIC},
{24, BCM_GPIO_PIN_8, RPI_SPI_CE0_N, PIN_MAGIC},
{25, 0, 0, 0},
{26, BCM_GPIO_PIN_7, RPI_SPI_CE1_N, PIN_MAGIC},
{27, BCM_GPIO_PIN_0, RPI_SDA0, PIN_MAGIC},
{28, BCM_GPIO_PIN_1, RPI_SCL0, PIN_MAGIC},
{29, BCM_GPIO_PIN_5, RPI_CAM_CLK, PIN_MAGIC},
{30, 0, 0, 0},
{31, BCM_GPIO_PIN_6, RPI_LAN_RUN, PIN_MAGIC},
{32, BCM_GPIO_PIN_12, 0, PIN_MAGIC},
{33, BCM_GPIO_PIN_13, 0, PIN_MAGIC},
{34, 0, 0, 0},
{35, BCM_GPIO_PIN_19, 0, PIN_MAGIC},
{36, BCM_GPIO_PIN_16, RPI_STATUS_LED_N, PIN_MAGIC},
{37, BCM_GPIO_PIN_26, 0, PIN_MAGIC},
{38, BCM_GPIO_PIN_20, 0, PIN_MAGIC},
{39, 0, 0, 0},
{40, BCM_GPIO_PIN_21, RPI_CAM_GPIO, PIN_MAGIC},
};
/*
* gpio_int[0] for BANK0 (pins 0-27)
* gpio_int[1] for BANK1 (pins 28-45)
* gpio_int[2] for BANK2 (pins 46-53)
*/
static struct gpio_irq_def _g_gpio_irq_tbl[GPIO_IRQ_NUM];
int gpio_set_func(enum gpio_code code, enum bcm_gpio_pin pin, rt_uint8_t func)
{
RT_ASSERT((GPIO_CODE_PHY <= code) && (code < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
if (func & 0x8)
{
rt_kprintf("[line]:%d There is a warning with parameter input", __LINE__);
return RT_EINVAL;
}
switch(func)
{
case 0x00:
bcm283x_gpio_fsel(pin, BCM283X_GPIO_FSEL_OUTP);
break;
case 0x01:
bcm283x_gpio_fsel(pin, BCM283X_GPIO_FSEL_INPT);
break;
case 0x02:
bcm283x_gpio_set_pud(pin, BCM283X_GPIO_PUD_UP);
bcm283x_gpio_fsel(pin, BCM283X_GPIO_FSEL_INPT);
break;
case 0x03:
bcm283x_gpio_set_pud(pin, BCM283X_GPIO_PUD_DOWN);
bcm283x_gpio_fsel(pin, BCM283X_GPIO_FSEL_INPT);
break;
case 0x04:
bcm283x_gpio_set_pud(pin, BCM283X_GPIO_PUD_OFF);
bcm283x_gpio_fsel(pin, BCM283X_GPIO_FSEL_OUTP);
break;
}
return RT_EOK;
}
int gpio_set_value(enum gpio_code code, enum bcm_gpio_pin pin, rt_uint8_t value)
{
RT_ASSERT((GPIO_CODE_PHY <= code) && (code < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
if (value & 0xE)
{
rt_kprintf("[line]:%d There is a warning with parameter input", __LINE__);
return RT_EINVAL;
}
bcm283x_gpio_write(pin, value);
return RT_EOK;
}
int gpio_get_value(enum gpio_code code, enum bcm_gpio_pin pin)
{
rt_uint8_t data;
RT_ASSERT((GPIO_CODE_PHY <= code) && (code < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
data = bcm283x_gpio_lev(pin);
return data;
}
void gpio_set_irq_callback(enum gpio_code port, enum bcm_gpio_pin pin, void (*irq_cb)(void *), void *irq_arg)
{
RT_ASSERT((GPIO_CODE_PHY < port) && (port < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
rt_uint8_t index;
if (pin <= 27)
{
index = 0;
}
else if (pin <= 45)
{
index = 1;
}
else{
index = 2;
}
_g_gpio_irq_tbl[index].irq_cb[pin] = irq_cb;
_g_gpio_irq_tbl[index].irq_arg[pin] = irq_arg;
}
void gpio_set_irq_type(enum gpio_code port, enum bcm_gpio_pin pin, rt_uint8_t irq_type)
{
RT_ASSERT((GPIO_CODE_PHY < port) && (port < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
rt_uint8_t index;
if (pin <= 27)
{
index = 0;
}
else if (pin <= 45)
{
index = 1;
}
else{
index = 2;
}
_g_gpio_irq_tbl[index].irq_type[pin] = irq_type;
switch(irq_type)
{
case 0x00:
bcm283x_gpio_ren(pin);
break;
case 0x01:
bcm283x_gpio_fen(pin);
break;
case 0x02:
bcm283x_gpio_aren(pin);
bcm283x_gpio_afen(pin);
break;
case 0x03:
bcm283x_gpio_hen(pin);
break;
case 0x04:
bcm283x_gpio_len(pin);
break;
}
}
static void gpio_ack_irq(int irq, enum bcm_gpio_pin pin)
{
rt_uint32_t data;
data = IRQ_PEND2;
data &= (0x0 << (irq - 32));
IRQ_PEND2 = data;
data = IRQ_DISABLE2;
data |= (0x1 << (irq - 32));
IRQ_DISABLE2 = data;
}
void gpio_irq_disable(enum gpio_code port, enum bcm_gpio_pin pin)
{
rt_uint8_t index;
int irq = 0;
RT_ASSERT((GPIO_CODE_PHY < port) && (port < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
if (pin <= 27)
{
index = 0;
irq = IRQ_GPIO0;
}else if (pin <= 45){
index = 1;
irq = IRQ_GPIO1;
}else{
index = 2;
irq = IRQ_GPIO2;
}
gpio_ack_irq(irq, pin);
rt_uint8_t irq_type = _g_gpio_irq_tbl[index].irq_type[pin];
switch(irq_type)
{
case 0x00:
bcm283x_gpio_clr_ren(pin);
break;
case 0x01:
bcm283x_gpio_clr_fen(pin);
break;
case 0x02:
bcm283x_gpio_clr_aren(pin);
bcm283x_gpio_clr_afen(pin);
break;
case 0x03:
bcm283x_gpio_clr_hen(pin);
break;
case 0x04:
bcm283x_gpio_clr_len(pin);
break;
}
}
void gpio_clear_irq_callback(enum gpio_code port, enum bcm_gpio_pin pin)
{
rt_uint8_t index;
gpio_irq_disable(port, pin);
if (pin <= 27)
{
index = 0;
}
else if (pin <= 45)
{
index = 1;
}
else
{
index = 2;
}
_g_gpio_irq_tbl[index].irq_cb[pin] = RT_NULL;
_g_gpio_irq_tbl[index].irq_arg[pin] = RT_NULL;
_g_gpio_irq_tbl[index].irq_type[pin] = RT_NULL;
}
void gpio_irq_enable(enum gpio_code port, enum bcm_gpio_pin pin)
{
rt_uint32_t offset;
rt_uint32_t data;
RT_ASSERT((GPIO_CODE_PHY < port) && (port < GPIO_CODE_NUM));
RT_ASSERT((BCM_GPIO_PIN_0 <= pin) && (pin < BCM_GPIO_PIN_53));
offset = pin;
if (pin <= 27)
{
offset = IRQ_GPIO0 - 32;
}
else if (pin <= 45)
{
offset = IRQ_GPIO1 - 32;
}
else
{
offset = IRQ_GPIO2 - 32;
}
data = IRQ_ENABLE2;
data |= 0x1 << offset;
IRQ_ENABLE2 = data;
}
//gpio_int[0] for BANK0 (pins 0-27)
//gpio_int[1] for BANK1 (pins 28-45)
//gpio_int[2] for BANK2 (pins 46-53)
static void gpio_irq_handler(int irq, void *param)
{
struct gpio_irq_def *irq_def = (struct gpio_irq_def *)param;
rt_uint32_t pin;
rt_uint32_t addr;
rt_uint32_t value;
rt_uint32_t tmpvalue;
if (irq == IRQ_GPIO0)
{
/* 0~27 */
addr = BCM283X_GPIO_BASE + BCM283X_GPIO_GPEDS0; // 0~31
value = bcm283x_peri_read(addr);
value &= 0x0fffffff;
pin = 0;
}
else if (irq == IRQ_GPIO1)
{
/* 28-45 */
addr = BCM283X_GPIO_BASE + BCM283X_GPIO_GPEDS0;
tmpvalue = bcm283x_peri_read(addr);
tmpvalue &= (~0x0fffffff);
addr = BCM283X_GPIO_BASE + BCM283X_GPIO_GPEDS1;
value = bcm283x_peri_read(addr);
value &= 0x3fff;
value = (value<<4) | tmpvalue;
pin = 28;
}
else if (irq == IRQ_GPIO2)
{
/* 46-53 */
addr = BCM283X_GPIO_BASE + BCM283X_GPIO_GPEDS1;
value = bcm283x_peri_read(addr);
value &= (~0x3fff);
value &= 0xff600000;
pin = 46;
}
bcm283x_peri_write(addr,0);
while (value)
{
if ((value & 0x1) && (irq_def->irq_cb[pin] != RT_NULL))
{
irq_def->irq_cb[pin](irq_def->irq_arg[pin]);
gpio_ack_irq(irq,pin);
}
pin++;
value = value >> 1;
}
}
static void pin_mode(struct rt_device *dev, rt_base_t pin, rt_base_t mode)
{
if ((pin > PIN_NUM(phypin_index)) || (phypin_index[pin].magic != PIN_MAGIC))
{
rt_kprintf("pin:%d value wrongful", pin);
return;
}
gpio_set_func(GPIO_CODE_BCM, phypin_index[pin].bcm_id, mode);
}
static void pin_write(struct rt_device *dev, rt_base_t pin, rt_base_t value)
{
if ((pin > PIN_NUM(phypin_index)) || (phypin_index[pin].magic != PIN_MAGIC))
{
rt_kprintf("pin:%d value wrongful", pin);
return;
}
gpio_set_value(GPIO_CODE_BCM, phypin_index[pin].bcm_id, value);
}
static int pin_read(struct rt_device *device, rt_base_t pin)
{
if ((pin > PIN_NUM(phypin_index)) || (phypin_index[pin].magic != PIN_MAGIC))
{
rt_kprintf("pin:%d value wrongful", pin);
return 0;
}
return gpio_get_value(GPIO_CODE_BCM, phypin_index[pin].bcm_id);
}
static rt_err_t pin_attach_irq(struct rt_device *device, rt_int32_t pin, rt_uint32_t mode, void (*hdr)(void *args), void *args)
{
if ((pin > PIN_NUM(phypin_index)) || (phypin_index[pin].magic != PIN_MAGIC))
{
rt_kprintf("pin:%d value wrongful", pin);
return RT_ERROR;
}
gpio_set_irq_callback(GPIO_CODE_BCM , phypin_index[pin].bcm_id, hdr, args);
gpio_set_irq_type(GPIO_CODE_BCM, phypin_index[pin].bcm_id, mode);
return RT_EOK;
}
static rt_err_t pin_detach_irq(struct rt_device *device, rt_int32_t pin)
{
if ((pin > PIN_NUM(phypin_index)) || (phypin_index[pin].magic != PIN_MAGIC))
{
rt_kprintf("pin:%d value wrongful", pin);
return RT_ERROR;
}
gpio_clear_irq_callback(GPIO_CODE_BCM, phypin_index[pin].bcm_id);
return RT_EOK;
}
rt_err_t pin_irq_enable(struct rt_device *device, rt_base_t pin, rt_uint32_t enabled)
{
if ((pin > PIN_NUM(phypin_index)) || (phypin_index[pin].magic != PIN_MAGIC))
{
rt_kprintf("pin:%d value wrongful", pin);
return RT_ERROR;
}
if (enabled)
gpio_irq_enable(GPIO_CODE_BCM, phypin_index[pin].bcm_id);
else
gpio_irq_disable(GPIO_CODE_BCM, phypin_index[pin].bcm_id);
return RT_EOK;
}
static const struct rt_pin_ops ops =
{
pin_mode,
pin_write,
pin_read,
pin_attach_irq,
pin_detach_irq,
pin_irq_enable,
};
#endif
int rt_hw_gpio_init(void)
{
#ifdef BSP_USING_PIN
rt_device_pin_register("gpio", &ops, RT_NULL);
#endif
/* install ISR */
rt_hw_interrupt_install(IRQ_GPIO0, gpio_irq_handler, &_g_gpio_irq_tbl[0], "gpio0_irq");
rt_hw_interrupt_umask(IRQ_GPIO0);
rt_hw_interrupt_install(IRQ_GPIO1, gpio_irq_handler, &_g_gpio_irq_tbl[1], "gpio1_irq");
rt_hw_interrupt_umask(IRQ_GPIO1);
rt_hw_interrupt_install(IRQ_GPIO2, gpio_irq_handler, &_g_gpio_irq_tbl[2], "gpio2_irq");
rt_hw_interrupt_umask(IRQ_GPIO2);
return 0;
}
INIT_DEVICE_EXPORT(rt_hw_gpio_init);