/*conf_data = 0~3*/
void GPO_ModeSetup(kal_uint16 pin, kal_uint16 conf_dada)
{
kal_uint16 mode;
kal_uint32 savedMask;
savedMask = SAVEANDSETIRQMASK();
mode = DRV_Reg(GPIO_MODE4);
mode &= ~(0x0003 << (pin*2));
mode |= (conf_dada << (pin*2));
DRV_WriteReg(GPIO_MODE4,mode);
RESTOREIRQMASK(savedMask);
}
static void pmic_DCM_Enable()
{
kal_uint32 savedMask = 0;
savedMask=SAVEANDSETIRQMASK();
lockDcmCnt--;
if (lockDcmCnt == 0)
{
DCM_Enable(i2cDcmHandle);
}
RestoreIRQMask(savedMask);
}
/*conf_data = 0~3*/
void GPIO_ModeSetup(kal_uint16 pin, kal_uint16 conf_dada)
{
kal_uint16 modeno;
kal_uint16 remainder;
kal_uint32 savedMask;
modeno = pin/8;
remainder = pin % 8;
savedMask = SAVEANDSETIRQMASK();
*(GPIO_MODE(modeno)) &= ~(0x0003 << (remainder*2));
*(GPIO_MODE(modeno)) |= (conf_dada << (remainder*2));
RESTOREIRQMASK(savedMask);
}
/*conf_data = 0~3*/
void GPIO_ModeSetup(kal_uint16 pin, kal_uint16 conf_dada)
{
kal_uint16 modeno;
kal_uint16 remainder;
kal_uint16 data;
kal_uint32 savedMask;
modeno = pin/8;
remainder = pin % 8;
savedMask = SAVEANDSETIRQMASK();
data=DRV_Reg(GPIO_MODE(modeno));
data&=~(0x3 << (2*remainder));
data|= (conf_dada << (remainder*2));
DRV_WriteReg(GPIO_MODE(modeno),data);
RESTOREIRQMASK(savedMask);
}
static void updateRetryCnt(kal_uint32 retryCnt)
{
kal_uint32 savedMask = 0;
if (retryCnt == 0)
return;
savedMask=SAVEANDSETIRQMASK();
if (retryCnt >= 20)
{
aNumOfRetryCnt[0]++;
if (retryCnt > maxRetryCnt)
maxRetryCnt = retryCnt;
}
else if (retryCnt > 0)
{
aNumOfRetryCnt[retryCnt]++;
}
RestoreIRQMask(savedMask);
}
kal_uint16 modeno;
kal_uint16 remainder;
kal_uint16 data;
kal_uint32 savedMask;
#ifdef __CUST_NEW__
pin &= (~GPIO_MAGIC_NUM);
if (gpio_debug_enable == KAL_TRUE)
{
ASSERT((gpio_mode_allowed[pin>>5][conf_dada & 3]) & (1<<(pin & 0x1f)));
}
#endif /* __CUST_NEW__ */
modeno = pin/8;
remainder = pin % 8;
savedMask = SAVEANDSETIRQMASK();
data=DRV_Reg(GPIO_MODE(modeno));
data&=~(0x3 << (2*remainder));
data|= (conf_dada << (remainder*2));
DRV_WriteReg(GPIO_MODE(modeno),data);
RESTOREIRQMASK(savedMask);
//DRV_WriteReg(GPIO_MODE_CLR(modeno),(0x0003 << (remainder*2)));
//DRV_WriteReg(GPIO_MODE_SET(modeno),(conf_dada << (remainder*2)));
}
/*conf_data = 0~3*/
void GPO_ModeSetup(kal_uint16 pin, kal_uint16 conf_dada)
{
kal_uint16 mode;
kal_uint32 savedMask;
