static int raise_ab8500_gpio26(void)
{
int ret;
/* selection */
ret = ab8500_read(AB8500_MISC, AB8500_GPIO_DIR4_REG);
if (ret < 0)
goto out;
ret |= 0x2;
ret = ab8500_write(AB8500_MISC, AB8500_GPIO_DIR4_REG, ret);
if (ret < 0)
goto out;
/* out */
ret = ab8500_read(AB8500_MISC, AB8500_GPIO_OUT4_REG);
if (ret < 0)
goto out;
ret |= 0x2;
ret = ab8500_write(AB8500_MISC, AB8500_GPIO_OUT4_REG, ret);
out:
return ret;
}
static int do_ab8500_write(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
ulong bankaddress;
ulong offset;
ulong value;
int ret;
if (argc != 4) {
cmd_usage(cmdtp);
return 1;
}
/* Get bank,offset and value */
bankaddress = simple_strtoul(argv[1], NULL, 16);
offset = simple_strtoul(argv[2], NULL, 16);
value = simple_strtoul(argv[3], NULL, 16);
/* Write the reg value */
ret = ab8500_write(bankaddress, offset, value);
if (ret < 0) {
printf("ab8500 write failed at address 0x%lx,0x%lx\n",
bankaddress, offset);
return 1;
}
/* Print the result */
printf("ab8500_write(0x%lx,0x%lx,0x%lx)\n", bankaddress, offset, value);
return 0;
}
/* Control vibrator */
int do_vibrate(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
int time_ms = 100; /* 100 ms */
int intensity = 50; /* 50 % */
int reg;
/*
* We use the last specified parameters, unless new ones are
* entered.
*/
if (!(flag & CMD_FLAG_REPEAT)) {
/* Parse vibration time if given */
if (argc >= 2)
time_ms = simple_strtoul(argv[1], NULL, 10);
/* Parse vibration intensity if given */
if (argc >= 3)
intensity = simple_strtoul(argv[2], NULL, 10);
}
/* disable audio registers reset */
reg = ab8500_read(AB8500_SYS_CTRL2_BLOCK, AB8500_CTRL3_REG);
ab8500_write(AB8500_SYS_CTRL2_BLOCK, AB8500_CTRL3_REG, reg | 0x02);
/* audio clock enable */
reg = ab8500_read(AB8500_SYS_CTRL2_BLOCK, AB8500_SYSULPCLK_CTRL1_REG);
ab8500_write(AB8500_SYS_CTRL2_BLOCK,
AB8500_SYSULPCLK_CTRL1_REG, reg | 0x10);
/* enable audio supply */
ab8500_write(AB8500_REGU_CTRL1, AB8500_REGU_VAUDIO_SUPPLY_REG, 0x02);
/*
* Audio related registers - Vibrator is controled using PWM
*/
/* power up audio feature */
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_POWER_UP, 0x88);
/* enable vibra class-D */
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_ANA_CONF4, 0x03);
/* general vibra control */
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF1, 0xFF);
/*
* control register ... Set PWM intensity 0..100%
*/
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF2, 0);
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF3, intensity);
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF4, 0);
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF5, intensity);
/* Sleep for time specified */
udelay(1000 * time_ms);
/* Set PWM RMS power to zero */
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF3, 0);
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_PWM_GEN_CONF5, 0);
/* audio clock disable */
reg = ab8500_read(AB8500_SYS_CTRL2_BLOCK, AB8500_SYSULPCLK_CTRL1_REG);
ab8500_write(AB8500_SYS_CTRL2_BLOCK,
AB8500_SYSULPCLK_CTRL1_REG, reg & ~0x10);
/* power down audio feature */
ab8500_write(AB8500_AUDIO, AB8500_AUDIO_POWER_UP, 0);
/* disable audio supply */
ab8500_write(AB8500_REGU_CTRL1, AB8500_REGU_VAUDIO_SUPPLY_REG, 0);
return 0;
}