static void bd_alive_init(void)
{
int index, bit;
int mode, out, lv, plup, detect;
U32 gpio;
#ifdef CONFIG_AK_GPIO_CONFIGS
U32 *pads = ALV_PADS_FOR_DEFAULTS;
#else
const U32 pads[] = {
PAD_GPIOALV0, PAD_GPIOALV1, PAD_GPIOALV2,
PAD_GPIOALV3, PAD_GPIOALV4, PAD_GPIOALV5
};
#endif
// index = sizeof(pads)/sizeof(pads[0]);
index = 6;
/* Alive pad function */
for (bit = 0; index > bit; bit++) {
NX_ALIVE_ClearInterruptPending(bit);
gpio = pads[bit];
//printk("GPIO ALV: Pin %d Value %02x\n", bit, gpio);
mode = PAD_GET_MODE(gpio);
lv = PAD_GET_LEVEL(gpio);
plup = PAD_GET_PULLUP(gpio);
switch (mode) {
case PAD_GET_MODE(PAD_MODE_IN ):
case PAD_GET_MODE(PAD_MODE_INT): out = 0; break;
case PAD_GET_MODE(PAD_MODE_OUT): out = 1; break;
case PAD_GET_MODE(PAD_MODE_ALT):
printk("ERROR, alive.%d not support alt function\n", bit);
continue;
default :
printk("ERROR, unknown alive mode (%d=%d)\n", bit, mode);
continue;
}
NX_ALIVE_SetOutputEnable(bit, (out ? CTRUE : CFALSE));
NX_ALIVE_SetOutputValue (bit, (lv));
NX_ALIVE_SetPullUpEnable(bit, (plup & 1 ? CTRUE : CFALSE));
/* set interrupt mode */
for (detect = 0; 6 > detect; detect++) {
if (mode == PAD_GET_MODE(PAD_MODE_INT))
NX_ALIVE_SetDetectMode(detect, bit, (lv == detect ? CTRUE : CFALSE));
else
NX_ALIVE_SetDetectMode(detect, bit, CFALSE);
}
NX_ALIVE_SetDetectEnable(bit, (mode == PAD_MODE_INT ? CTRUE : CFALSE));
}
}
static void init_alive_pad(void)
{
int io_bit;
U32 io_mod, outval, detect, pullup, io_num;
const U32 alv_pad[] = {
PAD_GPIOALV0, PAD_GPIOALV1, PAD_GPIOALV2, PAD_GPIOALV3
};
io_num = sizeof(alv_pad)/sizeof(alv_pad[0]);
/* Alive pad function */
for (io_bit = 0; io_num > io_bit; io_bit++) {
io_mod = PAD_GET_PADMODE(alv_pad[io_bit]);
switch(io_mod) {
case PAD_MODE_IN :
case PAD_MODE_DECT :
NX_ALIVE_SetOutputEnable(io_bit, CFALSE);
break;
case PAD_MODE_OUT :
NX_ALIVE_SetOutputEnable(io_bit, CTRUE);
break;
default :
DBGOUT("\n Unknown GPIO ALIVE Mode(0x%x)\n", io_mod);
continue;
}
outval = PAD_GET_PADMODE(alv_pad[io_bit]);
pullup = PAD_GET_PULLUP(alv_pad[io_bit]);
detect = PAD_GET_DECTMODE(alv_pad[io_bit]);
NX_ALIVE_SetOutputValue (io_bit, (outval ? CTRUE : CFALSE));
NX_ALIVE_SetPullUpEnable(io_bit, (pullup ? CTRUE : CFALSE));
// For wakeup source
NX_ALIVE_SetDetectMode(detect, io_bit, (io_mod == PAD_MODE_DECT ? CTRUE : CFALSE));
NX_ALIVE_SetDetectEnable(io_bit, (io_mod == PAD_MODE_DECT ? CTRUE : CFALSE));
}
}
static void bd_gpio_init(void)
{
int index, bit;
int mode, func, out, lv, plup, stren;
U32 gpio;
const U32 pads[NUMBER_OF_GPIO_MODULE][32] = {
{ /* GPIO_A */
PAD_GPIOA0 , PAD_GPIOA1 , PAD_GPIOA2 , PAD_GPIOA3 , PAD_GPIOA4 , PAD_GPIOA5 , PAD_GPIOA6 , PAD_GPIOA7 , PAD_GPIOA8 , PAD_GPIOA9 ,
PAD_GPIOA10, PAD_GPIOA11, PAD_GPIOA12, PAD_GPIOA13, PAD_GPIOA14, PAD_GPIOA15, PAD_GPIOA16, PAD_GPIOA17, PAD_GPIOA18, PAD_GPIOA19,
PAD_GPIOA20, PAD_GPIOA21, PAD_GPIOA22, PAD_GPIOA23, PAD_GPIOA24, PAD_GPIOA25, PAD_GPIOA26, PAD_GPIOA27, PAD_GPIOA28, PAD_GPIOA29,
PAD_GPIOA30, PAD_GPIOA31
}, { /* GPIO_B */
PAD_GPIOB0 , PAD_GPIOB1 , PAD_GPIOB2 , PAD_GPIOB3 , PAD_GPIOB4 , PAD_GPIOB5 , PAD_GPIOB6 , PAD_GPIOB7 , PAD_GPIOB8 , PAD_GPIOB9 ,
PAD_GPIOB10, PAD_GPIOB11, PAD_GPIOB12, PAD_GPIOB13, PAD_GPIOB14, PAD_GPIOB15, PAD_GPIOB16, PAD_GPIOB17, PAD_GPIOB18, PAD_GPIOB19,
PAD_GPIOB20, PAD_GPIOB21, PAD_GPIOB22, PAD_GPIOB23, PAD_GPIOB24, PAD_GPIOB25, PAD_GPIOB26, PAD_GPIOB27, PAD_GPIOB28, PAD_GPIOB29,
PAD_GPIOB30, PAD_GPIOB31
}, { /* GPIO_C */
PAD_GPIOC0 , PAD_GPIOC1 , PAD_GPIOC2 , PAD_GPIOC3 , PAD_GPIOC4 , PAD_GPIOC5 , PAD_GPIOC6 , PAD_GPIOC7 , PAD_GPIOC8 , PAD_GPIOC9 ,
PAD_GPIOC10, PAD_GPIOC11, PAD_GPIOC12, PAD_GPIOC13, PAD_GPIOC14, PAD_GPIOC15, PAD_GPIOC16, PAD_GPIOC17, PAD_GPIOC18, PAD_GPIOC19,
PAD_GPIOC20, PAD_GPIOC21, PAD_GPIOC22, PAD_GPIOC23, PAD_GPIOC24, PAD_GPIOC25, PAD_GPIOC26, PAD_GPIOC27, PAD_GPIOC28, PAD_GPIOC29,
PAD_GPIOC30, PAD_GPIOC31
}, { /* GPIO_D */
PAD_GPIOD0 , PAD_GPIOD1 , PAD_GPIOD2 , PAD_GPIOD3 , PAD_GPIOD4 , PAD_GPIOD5 , PAD_GPIOD6 , PAD_GPIOD7 , PAD_GPIOD8 , PAD_GPIOD9 ,
PAD_GPIOD10, PAD_GPIOD11, PAD_GPIOD12, PAD_GPIOD13, PAD_GPIOD14, PAD_GPIOD15, PAD_GPIOD16, PAD_GPIOD17, PAD_GPIOD18, PAD_GPIOD19,
PAD_GPIOD20, PAD_GPIOD21, PAD_GPIOD22, PAD_GPIOD23, PAD_GPIOD24, PAD_GPIOD25, PAD_GPIOD26, PAD_GPIOD27, PAD_GPIOD28, PAD_GPIOD29,
PAD_GPIOD30, PAD_GPIOD31
}, { /* GPIO_E */
PAD_GPIOE0 , PAD_GPIOE1 , PAD_GPIOE2 , PAD_GPIOE3 , PAD_GPIOE4 , PAD_GPIOE5 , PAD_GPIOE6 , PAD_GPIOE7 , PAD_GPIOE8 , PAD_GPIOE9 ,
PAD_GPIOE10, PAD_GPIOE11, PAD_GPIOE12, PAD_GPIOE13, PAD_GPIOE14, PAD_GPIOE15, PAD_GPIOE16, PAD_GPIOE17, PAD_GPIOE18, PAD_GPIOE19,
PAD_GPIOE20, PAD_GPIOE21, PAD_GPIOE22, PAD_GPIOE23, PAD_GPIOE24, PAD_GPIOE25, PAD_GPIOE26, PAD_GPIOE27, PAD_GPIOE28, PAD_GPIOE29,
PAD_GPIOE30, PAD_GPIOE31
},
};
/* GPIO pad function */
for (index = 0; NUMBER_OF_GPIO_MODULE > index; index++) {
NX_GPIO_ClearInterruptPendingAll(index);
for (bit = 0; 32 > bit; bit++) {
gpio = pads[index][bit];
func = PAD_GET_FUNC(gpio);
mode = PAD_GET_MODE(gpio);
lv = PAD_GET_LEVEL(gpio);
stren = PAD_GET_STRENGTH(gpio);
plup = PAD_GET_PULLUP(gpio);
/* get pad alternate function (0,1,2,4) */
switch (func) {
case PAD_GET_FUNC(PAD_FUNC_ALT0): func = NX_GPIO_PADFUNC_0; break;
case PAD_GET_FUNC(PAD_FUNC_ALT1): func = NX_GPIO_PADFUNC_1; break;
case PAD_GET_FUNC(PAD_FUNC_ALT2): func = NX_GPIO_PADFUNC_2; break;
case PAD_GET_FUNC(PAD_FUNC_ALT3): func = NX_GPIO_PADFUNC_3; break;
default: printf("ERROR, unknown alt func (%d.%02d=%d)\n", index, bit, func);
continue;
}
switch (mode) {
case PAD_GET_MODE(PAD_MODE_ALT): out = 0;
case PAD_GET_MODE(PAD_MODE_IN ): out = 0;
case PAD_GET_MODE(PAD_MODE_INT): out = 0; break;
case PAD_GET_MODE(PAD_MODE_OUT): out = 1; break;
default: printf("ERROR, unknown io mode (%d.%02d=%d)\n", index, bit, mode);
continue;
}
NX_GPIO_SetPadFunction(index, bit, func);
NX_GPIO_SetOutputEnable(index, bit, (out ? CTRUE : CFALSE));
NX_GPIO_SetOutputValue(index, bit, (lv ? CTRUE : CFALSE));
NX_GPIO_SetInterruptMode(index, bit, (lv));
NX_GPIO_SetPullMode(index, bit, plup);
set_gpio_strenth(index, bit, stren); /* pad strength */
}
NX_GPIO_SetDRV0_DISABLE_DEFAULT(index, 0xFFFFFFFF);
NX_GPIO_SetDRV1_DISABLE_DEFAULT(index, 0xFFFFFFFF);
}
}
/*------------------------------------------------------------------------------
* set nexell soc pad func.
*/
static void init_gpio_pad(void)
{
int io_grp, io_bit;
U32 io_mod, outval, detect, pullup, strength;
const U32 io_pad[NUMBER_OF_GPIO_MODULE][32] = {
/* GPIO group A */
{
PAD_GPIOA0, PAD_GPIOA1, PAD_GPIOA2, PAD_GPIOA3, PAD_GPIOA4, PAD_GPIOA5, PAD_GPIOA6, PAD_GPIOA7, PAD_GPIOA8, PAD_GPIOA9,
PAD_GPIOA10, PAD_GPIOA11, PAD_GPIOA12, PAD_GPIOA13, PAD_GPIOA14, PAD_GPIOA15, PAD_GPIOA16, PAD_GPIOA17, PAD_GPIOA18, PAD_GPIOA19,
PAD_GPIOA20, PAD_GPIOA21, PAD_GPIOA22, PAD_GPIOA23, PAD_GPIOA24, PAD_GPIOA25, PAD_GPIOA26, PAD_GPIOA27, PAD_GPIOA28, PAD_GPIOA29,
PAD_GPIOA30, PAD_GPIOA31
},
/* GPIO group B */
{
PAD_GPIOB0, PAD_GPIOB1 , PAD_GPIOB2 , PAD_GPIOB3, PAD_GPIOB4, PAD_GPIOB5, PAD_GPIOB6, PAD_GPIOB7, PAD_GPIOB8, PAD_GPIOB9,
PAD_GPIOB10, PAD_GPIOB11, PAD_GPIOB12, PAD_GPIOB13, PAD_GPIOB14, PAD_GPIOB15, PAD_GPIOB16, PAD_GPIOB17, PAD_GPIOB18, PAD_GPIOB19,
PAD_GPIOB20, PAD_GPIOB21, PAD_GPIOB22, PAD_GPIOB23, PAD_GPIOB24, PAD_GPIOB25, PAD_GPIOB26, PAD_GPIOB27, PAD_GPIOB28, PAD_GPIOB29,
PAD_GPIOB30, PAD_GPIOB31
},
/* GPIO group C */
{
PAD_GPIOC0, PAD_GPIOC1, PAD_GPIOC2, PAD_GPIOC3, PAD_GPIOC4, PAD_GPIOC5, PAD_GPIOC6, PAD_GPIOC7, PAD_GPIOC8, PAD_GPIOC9,
PAD_GPIOC10, PAD_GPIOC11, PAD_GPIOC12, PAD_GPIOC13, PAD_GPIOC14, PAD_GPIOC15, PAD_GPIOC16, PAD_GPIOC17, PAD_GPIOC18, PAD_GPIOC19,
PAD_GPIOC20, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 0
}
};
/* GPIO pad function */
for (io_grp = 0; NUMBER_OF_GPIO_MODULE > io_grp; io_grp++) {
for (io_bit = 0; 32 > io_bit; io_bit++) {
if (! io_pad[io_grp][io_bit])
continue;
io_mod = PAD_GET_PADMODE(io_pad[io_grp][io_bit]);
switch(io_mod) {
case PAD_MODE_IN:
NX_GPIO_SetPadFunction (io_grp, io_bit, NX_GPIO_PADFUNC_GPIO);
NX_GPIO_SetOutputEnable(io_grp, io_bit, CFALSE);
break;
case PAD_MODE_OUT:
NX_GPIO_SetPadFunction (io_grp, io_bit, NX_GPIO_PADFUNC_GPIO);
NX_GPIO_SetOutputEnable(io_grp, io_bit, CTRUE);
break;
case PAD_MODE_ALT1:
NX_GPIO_SetPadFunction (io_grp, io_bit, NX_GPIO_PADFUNC_1);
NX_GPIO_SetOutputEnable(io_grp, io_bit, CFALSE);
break;
case PAD_MODE_ALT2:
NX_GPIO_SetPadFunction (io_grp, io_bit, NX_GPIO_PADFUNC_2);
NX_GPIO_SetOutputEnable(io_grp, io_bit, CFALSE);
break;
case PAD_MODE_ALT3:
NX_GPIO_SetPadFunction (io_grp, io_bit, NX_GPIO_PADFUNC_3);
NX_GPIO_SetOutputEnable(io_grp, io_bit, CFALSE);
break;
case PAD_MODE_INT:
detect = PAD_GET_DECTMODE(io_pad[io_grp][io_bit]);
NX_GPIO_SetPadFunction(io_grp, io_bit, NX_GPIO_PADFUNC_GPIO);
NX_GPIO_SetOutputEnable(io_grp, io_bit, CFALSE);
NX_GPIO_SetInterruptMode(io_grp, io_bit, detect);
break;
case PAD_MODE_SKIP:
case PAD_NOTEXIST:
default:
continue;
}
outval = PAD_GET_OUTLEVEL(io_pad[io_grp][io_bit]);
pullup = PAD_GET_PULLUP(io_pad[io_grp][io_bit]);
strength = PAD_GET_STRENGTH(io_pad[io_grp][io_bit]);
NX_GPIO_SetOutputValue (io_grp, io_bit, (outval ? CTRUE : CFALSE));
NX_GPIO_SetPullUpEnable(io_grp, io_bit, (pullup ? CTRUE : CFALSE));
NX_CLKPWR_SetGPIOPadStrength(io_grp, io_bit, strength);
}
}
}