s3c2410_gpio_setpin()與s3c2410_gpio_cfgpin()函數定義
snailszzy的s3c2410_gpio_setpin()與s3c2410_gpio_cfgpin()函數定義
s3c2410_gpio_setpin()在gpio.c中
作用:設置相應GPIO口的值,
如pin=S3C2410_GPB5 to=0 則:設置S3C2410_GPB5的輸出值為0
如pin=S3C2410_GPB5 to=1 則:設置S3C2410_GPB5的輸出值為1
void s3c2410_gpio_setpin(unsigned int pin, unsigned int to)
{
void __iomem *base = S3C2410_GPIO_BASE(pin);
unsigned long offs = S3C2410_GPIO_OFFSET(pin);
unsigned long flags;
unsigned long dat;
local_irq_save(flags);
dat = __raw_readl(base + 0x04);
dat &= ~(1 << offs);
dat |= to << offs;
__raw_writel(dat, base + 0x04);
local_irq_restore(flags);
}
EXPORT_SYMBOL(s3c2410_gpio_setpin);
說明:
1.
S3C2410_GPIO_BASE(pin)-------------
在linux/include/asm/hardware/s3c2410/regs-gpio.h中
#define S3C2410_GPIO_BASE(pin) ((((pin) & ~31) >> 1) +S3C24XX_VA_GPIO)
S3C24XX_VA_GPIO------------
在linux/include/asm-arm/arch-s3c2410/map.h中
#define S3C24XX_VA_GPIO S3C2410_ADDR(0x00E00000)
----GPIO的虛擬偏移地址:0x00E00000
#define S3C2410_ADDR(x) (0xF0000000 + (x))
----所有寄存器的虛擬首地址:0xF0000000
則:
S3C24XX_VA_GPIO =0xF0E0 0000 ----GPIO的虛擬首地址
如:pin = S3C2410_GPB5
而在linux/include/asm/hardware/s3c2410/regs-gpio.h中
#define S3C2410_GPB5 S3C2410_GPIONO(S3C2410_GPIO_BANKB, 5)
#define S3C2410_GPIONO(bank,offset) ((bank) + (offset))
#define S3C2410_GPIO_BANKB (32*1)
則:
S3C2410_GPB5 =32*1+5=37
由:
#define S3C2410_GPIO_BASE(pin) ((((pin) & ~31) >> 1) +S3C24XX_VA_GPIO)
pin = S3C2410_GPB5 = 37
S3C24XX_VA_GPIO =0xF0E0 0000
則:
S3C2410_GPIO_BASE(S3C2410_GPB5) ((((S3C2410_GPB5) & ~31) >> 1) +0xF0E0 0000 )
S3C2410_GPIO_BASE(37) ((((37) & ~31) >> 1) +0xF0E0 0000 )
S3C2410_GPIO_BASE(37) =((10 0101 &0 0000)>>1)+0xF0E0 0000
= 1 0000+0xF0E0 0000
= 0xF0E1 0000
~31主要是為了清除S3C2410_GPB5的后5位,
2.
S3C2410_GPIO_OFFSET(pin);
s3c2410_gpio_cfgpin函數的定義:
void s3c2410_gpio_cfgpin(unsigned int pin, unsigned int function)
{
void __iomem *base = S3C24XX_GPIO_BASE(pin);
unsigned long mask;
unsigned long con;
unsigned long flags;
if (pin < S3C2410_GPIO_BANKB) {
mask = 1 << S3C2410_GPIO_OFFSET(pin);
} else {
mask = 3 << S3C2410_GPIO_OFFSET(pin)*2;
}
switch (function) {
case S3C2410_GPIO_LEAVE:
mask = 0;
function = 0;
break;
case S3C2410_GPIO_INPUT:
case S3C2410_GPIO_OUTPUT:
case S3C2410_GPIO_SFN2:
case S3C2410_GPIO_SFN3:
if (pin < S3C2410_GPIO_BANKB) {
function -= 1;
function &= 1;
function <<= S3C2410_GPIO_OFFSET(pin);
} else {
function &= 3;
function <<= S3C2410_GPIO_OFFSET(pin)*2;
}
}
/* modify the specified register wwith IRQs off */
local_irq_save(flags);
con = __raw_readl(base + 0x00);
con &= ~mask;
con |= function;
__raw_writel(con, base + 0x00);
local_irq_restore(flags);
}
EXPORT_SYMBOL(s3c2410_gpio_cfgpin);
以下是s3c2410_gpio_cfgpin中部分引用代碼的定義:
#define S3C2410_GPIO_BANKB (32*1)
#define S3C2410_GPIO_OFFSET(pin) ((pin) & 31)
#define S3C2410_GPIO_OUTPUT (0xFFFFFFF1)
2 分析源代碼
在分析s3c2410_gpio_setpin時已經得知B組的基地址是0xfb000010,在datasheet中得知GPBCON的虛擬地址就是 B組的基地址,即0xfb000010,GPBDAT的虛擬地址就是B組基地址加4,即0xfb000014,所以對base+0x00的讀寫就是對GPBCON的讀寫,如源代碼中的 con = __raw_readl(base + 0x00); __raw_writel(con, base + 0x00);把GPBCON中讀出來的數據放入con變量中,然后對con進行修改,之后從新寫入GPBCON之中,對con做了如下修改: con &= ~mask; con |= function;
對于我們的GPB5來說,它的BANK號為32,偏移量為5,所以可以計算GPB5對應的mask:
mask = 3 << S3C2410_GPIO_OFFSET(pin)*2;
計算結果是0b1100000000,也就是GPBCON中對應的[11,10]位
同時可以計算得知GPB5的function:
function &= 3; //在mini2440_leds.c 驅動中我們的function配置為S3C2410_GPIO_OUTPUT,即(0xFFFFFFF1)
function <<= S3C2410_GPIO_OFFSET(pin)*2;
計算結果是 0b0100000000 即對應GPBCON中的[11,10]位,而在datasheet中我們可以看到GPBCON中不同位的功能作用:
GPB5 [11:10] 00=Input 01=Output 10=nXBACK 11=reserved
GPB6 [13:12] 00=Input 01=Output 10=nXBREQ 11=reserved
GPB7 [15:14] 00=Input 01=Output 10=nXDACK1 11=reserved
GPB8 [17:16] 00=Input 01=Output 10=nXDREQ1 11=reserved
到這里,我們就明白在mini2440_led.c 驅動中對led的配置了。