arch/arm/cpu/armv7/sc8825/vibrator.c

   1 #include <config.h>
   2 #include <asm/io.h>
   3 #include <asm/arch/chip_drv_config_extern.h>
   4 #include <asm/arch/bits.h>
   5 #include <linux/types.h>
   6 #include <asm/arch/regs_adi.h>
   7 #include <asm/arch/adi_hal_internal.h>
   8 #define VIBRATOR_REG_UNLOCK (0xA1B2)
   9 #define VIBRATOR_REG_LOCK   (~VIBRATOR_REG_UNLOCK)
  10 #define VIBRATOR_STABLE_LEVEL   (4)
  11 #define VIBRATOR_INIT_LEVEL (11)    //init level must larger than stable level
  12 #define VIBRATOR_INIT_STATE_CNT (2)
  13 #define mdelay(_ms) udelay(_ms*1000)
  14 void set_vibrator(int on)
  15 {
  16         int i = 0;
  17         ANA_REG_SET(ANA_VIBR_WR_PROT, VIBRATOR_REG_UNLOCK); //unlock vibrator registor
  18         if(on == 0){
  19                 mdelay(150);
  20                 ANA_REG_AND(ANA_VIBRATOR_CTL0, ~(VIBR_PD_SET | VIBR_PD_RST));
  21                 ANA_REG_OR(ANA_VIBRATOR_CTL0, VIBR_PD_SET);
  22         }else{
  23                 ANA_REG_AND(ANA_VIBRATOR_CTL0, ~(VIBR_PD_SET | VIBR_PD_RST));
  24                 ANA_REG_OR(ANA_VIBRATOR_CTL0, VIBR_PD_RST);
  25         }
  26         ANA_REG_SET(ANA_VIBR_WR_PROT, VIBRATOR_REG_LOCK);   //lock vibrator registor
  27 }
  28 void vibrator_hw_init(void)
  29 {
  30         ANA_REG_SET(ANA_VIBR_WR_PROT, VIBRATOR_REG_UNLOCK); //unlock vibrator registor
  31
  32         ANA_REG_OR(ANA_VIBRATOR_CTL0, VIBR_RTC_EN);
  33         ANA_REG_AND(ANA_VIBRATOR_CTL0, ~VIBR_BP_EN);   //enable new version,so VIBR_V_BP is disable.
  34
  35         ANA_REG_MSK_OR(ANA_VIBRATOR_CTL0, (VIBRATOR_INIT_LEVEL << VIBR_INIT_V_SHIFT), VIBR_INIT_V_MSK); //set init current level
  36         ANA_REG_MSK_OR(ANA_VIBRATOR_CTL0, (VIBRATOR_STABLE_LEVEL << VIBR_STABLE_V_SHIFT), VIBR_STABLE_V_MSK); //set stable current level
  37         ANA_REG_SET(ANA_VIBRATOR_CTL1, VIBRATOR_INIT_STATE_CNT);   //set convert count
  38
  39         ANA_REG_SET(ANA_VIBR_WR_PROT, VIBRATOR_REG_LOCK);   //lock vibrator registor
  40 }
  41
  42