(CR):[9610][EVB] motor: bring up aw8695 motor conctrlor(1/3)
authorshihuijun <shihuijun@huaqin.com>
Tue, 25 Sep 2018 09:15:40 +0000 (17:15 +0800)
committerxiest1 <xiest1@lenovo.com>
Tue, 5 Nov 2019 09:29:42 +0000 (17:29 +0800)
Change-Id: I658b161043fbd6b278e242d06396d6d39baadefd

drivers/misc/Kconfig
drivers/misc/Makefile
drivers/misc/aw8695_haptic/Kconfig [new file with mode: 0644]
drivers/misc/aw8695_haptic/Makefile [new file with mode: 0644]
drivers/misc/aw8695_haptic/aw8695.c [new file with mode: 0644]
drivers/misc/aw8695_haptic/aw8695.h [new file with mode: 0644]
drivers/misc/aw8695_haptic/aw8695_reg.h [new file with mode: 0644]

index 001d35d4c510cb40688874161bc3d18ed47364c0..5a0f6bbad2e6e5fb98f9e96e711460fed4fb6628 100644 (file)
@@ -543,4 +543,5 @@ source "drivers/misc/mcu_ipc/Kconfig"
 source "drivers/misc/modem_if/Kconfig"
 source "drivers/misc/gnss_if/Kconfig"
 source "drivers/misc/samsung/Kconfig"
+source "drivers/misc/aw8695_haptic/Kconfig"
 endmenu
index 74f51c71f63358f6c8b2905456b423adcc83dabb..8a8b488fd36869922ae0d8b0010a92afe387e8cf 100644 (file)
@@ -82,3 +82,4 @@ OBJCOPYFLAGS_lkdtm_rodata_objcopy.o := \
 targets += lkdtm_rodata.o lkdtm_rodata_objcopy.o
 $(obj)/lkdtm_rodata_objcopy.o: $(obj)/lkdtm_rodata.o FORCE
        $(call if_changed,objcopy)
+obj-$(CONFIG_AW8695_HAPTIC)     += aw8695_haptic/
\ No newline at end of file
diff --git a/drivers/misc/aw8695_haptic/Kconfig b/drivers/misc/aw8695_haptic/Kconfig
new file mode 100644 (file)
index 0000000..7cd5959
--- /dev/null
@@ -0,0 +1,5 @@
+config AW8695_HAPTIC
+    tristate "Haptic driver for awinic AW8695 series"
+    depends on I2C
+    help
+      This option enables support for AW8695 series Haptic Driver.
diff --git a/drivers/misc/aw8695_haptic/Makefile b/drivers/misc/aw8695_haptic/Makefile
new file mode 100644 (file)
index 0000000..ce8657b
--- /dev/null
@@ -0,0 +1,2 @@
+#for AWINIC AW8695 Haptic
+obj-$(CONFIG_AW8695_HAPTIC) += aw8695.o
diff --git a/drivers/misc/aw8695_haptic/aw8695.c b/drivers/misc/aw8695_haptic/aw8695.c
new file mode 100644 (file)
index 0000000..f23ee21
--- /dev/null
@@ -0,0 +1,2644 @@
+/*
+ * aw8695.c   aw8695 haptic module
+ *
+ * Version: v1.1.3
+ *
+ * Copyright (c) 2018 AWINIC Technology CO., LTD
+ *
+ *  Author: Nick Li <liweilei@awinic.com.cn>
+ *
+ * This program is free software; you can redistribute  it and/or modify it
+ * under  the terms of  the GNU General  Public License as published by the
+ * Free Software Foundation;  either version 2 of the  License, or (at your
+ * option) any later version.
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/i2c.h>
+#include <linux/of_gpio.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/firmware.h>
+#include <linux/slab.h>
+#include <linux/version.h>
+#include <linux/input.h>
+#include <linux/interrupt.h>
+#include <linux/debugfs.h>
+#include <linux/miscdevice.h>
+#include <asm/uaccess.h>
+#include <linux/syscalls.h>
+#include <linux/power_supply.h>
+#include "aw8695.h"
+#include "aw8695_reg.h"
+
+/******************************************************
+ *
+ * Marco
+ *
+ ******************************************************/
+#define AW8695_I2C_NAME "aw8695_haptic"
+#define AW8695_HAPTIC_NAME "aw8695_haptic"
+
+#define AW8695_VERSION "v1.1.3"
+
+
+#define AWINIC_RAM_UPDATE_DELAY
+
+#define AW_I2C_RETRIES 2
+#define AW_I2C_RETRY_DELAY 2
+#define AW_READ_CHIPID_RETRIES 5
+#define AW_READ_CHIPID_RETRY_DELAY 2
+
+#define AW8695_MAX_DSP_START_TRY_COUNT    10
+
+
+
+#define AW8695_MAX_FIRMWARE_LOAD_CNT 20
+
+/******************************************************
+ *
+ * variable
+ *
+ ******************************************************/
+#define AW8695_RTP_NAME_MAX        64
+static char *aw8695_ram_name = "aw8695_haptic.bin";
+static char aw8695_rtp_name[][AW8695_RTP_NAME_MAX] = {
+    {"aw8695_rtp.bin"},
+    {"aw8695_rtp_lighthouse.bin"},
+    {"aw8695_rtp_silk.bin"},
+};
+
+struct aw8695_container *aw8695_rtp;
+struct aw8695 *g_aw8695;
+
+/******************************************************
+ *
+ * functions
+ *
+ ******************************************************/
+static void aw8695_interrupt_clear(struct aw8695 *aw8695);
+
+
+ /******************************************************
+ *
+ * aw8695 i2c write/read
+ *
+ ******************************************************/
+static int aw8695_i2c_write(struct aw8695 *aw8695,
+         unsigned char reg_addr, unsigned char reg_data)
+{
+    int ret = -1;
+    unsigned char cnt = 0;
+
+    while(cnt < AW_I2C_RETRIES) {
+        ret = i2c_smbus_write_byte_data(aw8695->i2c, reg_addr, reg_data);
+        if(ret < 0) {
+            pr_err("%s: i2c_write cnt=%d error=%d\n", __func__, cnt, ret);
+        } else {
+            break;
+        }
+        cnt ++;
+        msleep(AW_I2C_RETRY_DELAY);
+    }
+
+    return ret;
+}
+
+static int aw8695_i2c_read(struct aw8695 *aw8695,
+        unsigned char reg_addr, unsigned char *reg_data)
+{
+    int ret = -1;
+    unsigned char cnt = 0;
+
+    while(cnt < AW_I2C_RETRIES) {
+        ret = i2c_smbus_read_byte_data(aw8695->i2c, reg_addr);
+        if(ret < 0) {
+            pr_err("%s: i2c_read cnt=%d error=%d\n", __func__, cnt, ret);
+        } else {
+            *reg_data = ret;
+            break;
+        }
+        cnt ++;
+        msleep(AW_I2C_RETRY_DELAY);
+    }
+
+    return ret;
+}
+
+static int aw8695_i2c_write_bits(struct aw8695 *aw8695,
+         unsigned char reg_addr, unsigned int mask, unsigned char reg_data)
+{
+    unsigned char reg_val = 0;
+
+    aw8695_i2c_read(aw8695, reg_addr, &reg_val);
+    reg_val &= mask;
+    reg_val |= reg_data;
+    aw8695_i2c_write(aw8695, reg_addr, reg_val);
+
+    return 0;
+}
+
+static int aw8695_i2c_writes(struct aw8695 *aw8695,
+        unsigned char reg_addr, unsigned char *buf, unsigned int len)
+{
+    int ret = -1;
+    unsigned char *data;
+
+    data = kmalloc(len+1, GFP_KERNEL);
+    if (data == NULL) {
+        pr_err("%s: can not allocate memory\n", __func__);
+        return  -ENOMEM;
+    }
+
+    data[0] = reg_addr;
+    memcpy(&data[1], buf, len);
+
+    ret = i2c_master_send(aw8695->i2c, data, len+1);
+    if (ret < 0) {
+        pr_err("%s: i2c master send error\n", __func__);
+    }
+
+    kfree(data);
+
+    return ret;
+}
+
+/*****************************************************
+ *
+ * ram update
+ *
+ *****************************************************/
+static void aw8695_rtp_loaded(const struct firmware *cont, void *context)
+{
+    struct aw8695 *aw8695 = context;
+    pr_info("%s enter\n", __func__);
+
+    if (!cont) {
+        pr_err("%s: failed to read %s\n", __func__, aw8695_rtp_name[aw8695->rtp_file_num]);
+        release_firmware(cont);
+        return;
+    }
+
+    pr_info("%s: loaded %s - size: %zu\n", __func__, aw8695_rtp_name[aw8695->rtp_file_num],
+                    cont ? cont->size : 0);
+
+    /* aw8695 rtp update */
+    aw8695_rtp = kzalloc(cont->size+sizeof(int), GFP_KERNEL);
+    if (!aw8695_rtp) {
+        release_firmware(cont);
+        pr_err("%s: Error allocating memory\n", __func__);
+        return;
+    }
+    aw8695_rtp->len = cont->size;
+    pr_info("%s: rtp size = %d\n", __func__, aw8695_rtp->len);
+    memcpy(aw8695_rtp->data, cont->data, cont->size);
+    release_firmware(cont);
+
+    aw8695->rtp_init = 1;
+    pr_info("%s: rtp update complete\n", __func__);
+}
+
+static int aw8695_rtp_update(struct aw8695 *aw8695)
+{
+    pr_info("%s enter\n", __func__);
+
+    return request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG,
+                aw8695_rtp_name[aw8695->rtp_file_num], aw8695->dev, GFP_KERNEL,
+                aw8695, aw8695_rtp_loaded);
+}
+
+
+ static void aw8695_container_update(struct aw8695 *aw8695,
+        struct aw8695_container *aw8695_cont)
+{
+    int i = 0;
+    unsigned int shift = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    mutex_lock(&aw8695->lock);
+
+    aw8695->ram.baseaddr_shift = 2;
+    aw8695->ram.ram_shift = 4;
+
+    /* RAMINIT Enable */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+            AW8695_BIT_SYSCTRL_RAMINIT_MASK, AW8695_BIT_SYSCTRL_RAMINIT_EN);
+
+    /* base addr */
+    shift = aw8695->ram.baseaddr_shift;
+    aw8695->ram.base_addr = (unsigned int)((aw8695_cont->data[0+shift]<<8) |
+            (aw8695_cont->data[1+shift]));
+    pr_info("%s: base_addr=0x%4x\n", __func__, aw8695->ram.base_addr);
+
+    aw8695_i2c_write(aw8695, AW8695_REG_BASE_ADDRH, aw8695_cont->data[0+shift]);
+    aw8695_i2c_write(aw8695, AW8695_REG_BASE_ADDRL, aw8695_cont->data[1+shift]);
+
+    aw8695_i2c_write(aw8695, AW8695_REG_FIFO_AEH,
+                    (unsigned char)((aw8695->ram.base_addr>>2)>>8));
+    aw8695_i2c_write(aw8695, AW8695_REG_FIFO_AEL,
+                    (unsigned char)((aw8695->ram.base_addr>>2)&0x00FF));
+    aw8695_i2c_write(aw8695, AW8695_REG_FIFO_AFH,
+                    (unsigned char)((aw8695->ram.base_addr-(aw8695->ram.base_addr>>2))>>8));
+    aw8695_i2c_write(aw8695, AW8695_REG_FIFO_AFL,
+                    (unsigned char)((aw8695->ram.base_addr-(aw8695->ram.base_addr>>2))&0x00FF));
+
+    /* ram */
+    shift = aw8695->ram.baseaddr_shift;
+    aw8695_i2c_write(aw8695, AW8695_REG_RAMADDRH, aw8695_cont->data[0+shift]);
+    aw8695_i2c_write(aw8695, AW8695_REG_RAMADDRL, aw8695_cont->data[1+shift]);
+    shift = aw8695->ram.ram_shift;
+    for(i=shift; i<aw8695_cont->len; i++) {
+        aw8695_i2c_write(aw8695, AW8695_REG_RAMDATA, aw8695_cont->data[i]);
+    }
+
+#if 0
+    /* ram check */
+    shift = aw8695->ram.baseaddr_shift;
+    aw8695_i2c_write(aw8695, AW8695_REG_RAMADDRH, aw8695_cont->data[0+shift]);
+    aw8695_i2c_write(aw8695, AW8695_REG_RAMADDRL, aw8695_cont->data[1+shift]);
+    shift = aw8695->ram.ram_shift;
+    for(i=shift; i<aw8695_cont->len; i++) {
+        aw8695_i2c_read(aw8695, AW8695_REG_RAMDATA, &reg_val);
+        if(reg_val != aw8695_cont->data[i]) {
+            pr_err("%s: ram check error addr=0x%04x, file_data=0x%02x, ram_data=0x%02x\n",
+                        __func__, i, aw8695_cont->data[i], reg_val);
+            return;
+        }
+    }
+#endif
+
+    /* RAMINIT Disable */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+            AW8695_BIT_SYSCTRL_RAMINIT_MASK, AW8695_BIT_SYSCTRL_RAMINIT_OFF);
+
+    mutex_unlock(&aw8695->lock);
+
+    pr_info("%s exit\n", __func__);
+}
+
+
+static void aw8695_ram_loaded(const struct firmware *cont, void *context)
+{
+    struct aw8695 *aw8695 = context;
+    struct aw8695_container *aw8695_fw;
+    int i = 0;
+    unsigned short check_sum = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    if (!cont) {
+        pr_err("%s: failed to read %s\n", __func__, aw8695_ram_name);
+        release_firmware(cont);
+        return;
+    }
+
+    pr_info("%s: loaded %s - size: %zu\n", __func__, aw8695_ram_name,
+                    cont ? cont->size : 0);
+/*
+    for(i=0; i<cont->size; i++) {
+        pr_info("%s: addr:0x%04x, data:0x%02x\n", __func__, i, *(cont->data+i));
+    }
+*/
+
+    /* check sum */
+    for(i=2; i<cont->size; i++) {
+        check_sum += cont->data[i];
+    }
+    if(check_sum != (unsigned short)((cont->data[0]<<8)|(cont->data[1]))) {
+        pr_err("%s: check sum err: check_sum=0x%04x\n", __func__, check_sum);
+        return;
+    } else {
+        pr_info("%s: check sum pass : 0x%04x\n", __func__, check_sum);
+        aw8695->ram.check_sum = check_sum;
+    }
+
+    /* aw8695 ram update */
+    aw8695_fw = kzalloc(cont->size+sizeof(int), GFP_KERNEL);
+    if (!aw8695_fw) {
+        release_firmware(cont);
+        pr_err("%s: Error allocating memory\n", __func__);
+        return;
+    }
+    aw8695_fw->len = cont->size;
+    memcpy(aw8695_fw->data, cont->data, cont->size);
+    release_firmware(cont);
+
+    aw8695_container_update(aw8695, aw8695_fw);
+
+    aw8695->ram.len = aw8695_fw->len;
+
+    kfree(aw8695_fw);
+
+    aw8695->ram_init = 1;
+    pr_info("%s: fw update complete\n", __func__);
+
+    aw8695_rtp_update(aw8695);
+}
+
+static int aw8695_ram_update(struct aw8695 *aw8695)
+{
+    aw8695->ram_init = 0;
+    aw8695->rtp_init = 0;
+    return request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG,
+                aw8695_ram_name, aw8695->dev, GFP_KERNEL,
+                aw8695, aw8695_ram_loaded);
+}
+
+#ifdef AWINIC_RAM_UPDATE_DELAY
+static void aw8695_ram_work_routine(struct work_struct *work)
+{
+    struct aw8695 *aw8695 = container_of(work, struct aw8695, ram_work.work);
+
+    pr_info("%s enter\n", __func__);
+
+    aw8695_ram_update(aw8695);
+
+}
+#endif
+
+static int aw8695_ram_init(struct aw8695 *aw8695)
+{
+#ifdef AWINIC_RAM_UPDATE_DELAY
+    int ram_timer_val = 5000;
+    INIT_DELAYED_WORK(&aw8695->ram_work, aw8695_ram_work_routine);
+    schedule_delayed_work(&aw8695->ram_work, msecs_to_jiffies(ram_timer_val));
+#else
+    aw8695_ram_update(aw8695);
+#endif
+    return 0;
+}
+
+
+
+/*****************************************************
+ *
+ * haptic control
+ *
+ *****************************************************/
+static int aw8695_haptic_softreset(struct aw8695 *aw8695)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8695_i2c_write(aw8695, AW8695_REG_ID, 0xAA);
+    msleep(1);
+    return 0;
+}
+
+static int aw8695_haptic_active(struct aw8695 *aw8695)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+            AW8695_BIT_SYSCTRL_WORK_MODE_MASK, AW8695_BIT_SYSCTRL_ACTIVE);
+    aw8695_interrupt_clear(aw8695);
+    return 0;
+}
+
+static int aw8695_haptic_play_mode(struct aw8695 *aw8695, unsigned char play_mode)
+{
+    pr_debug("%s enter\n", __func__);
+
+    switch(play_mode) {
+        case AW8695_HAPTIC_STANDBY_MODE:
+            aw8695->play_mode = AW8695_HAPTIC_STANDBY_MODE;
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_WORK_MODE_MASK, AW8695_BIT_SYSCTRL_STANDBY);
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_BST_MODE_MASK, AW8695_BIT_SYSCTRL_BST_MODE_BYPASS);
+            break;
+        case AW8695_HAPTIC_RAM_MODE:
+            aw8695->play_mode = AW8695_HAPTIC_RAM_MODE;
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_PLAY_MODE_MASK, AW8695_BIT_SYSCTRL_PLAY_MODE_RAM);
+            aw8695_haptic_active(aw8695);
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_BST_MODE_MASK, AW8695_BIT_SYSCTRL_BST_MODE_BOOST);
+            break;
+        case AW8695_HAPTIC_RTP_MODE:
+            aw8695->play_mode = AW8695_HAPTIC_RTP_MODE;
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_PLAY_MODE_MASK, AW8695_BIT_SYSCTRL_PLAY_MODE_RTP);
+            aw8695_haptic_active(aw8695);
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_BST_MODE_MASK, AW8695_BIT_SYSCTRL_BST_MODE_BOOST);
+            break;
+        case AW8695_HAPTIC_TRIG_MODE:
+            aw8695->play_mode = AW8695_HAPTIC_TRIG_MODE;
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_PLAY_MODE_MASK, AW8695_BIT_SYSCTRL_PLAY_MODE_RAM);
+            aw8695_haptic_active(aw8695);
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_BST_MODE_MASK, AW8695_BIT_SYSCTRL_BST_MODE_BOOST);
+            break;
+        case AW8695_HAPTIC_CONT_MODE:
+            aw8695->play_mode = AW8695_HAPTIC_CONT_MODE;
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_PLAY_MODE_MASK, AW8695_BIT_SYSCTRL_PLAY_MODE_CONT);
+            aw8695_haptic_active(aw8695);
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+                    AW8695_BIT_SYSCTRL_BST_MODE_MASK, AW8695_BIT_SYSCTRL_BST_MODE_BYPASS);
+            break;
+        default:
+            dev_err(aw8695->dev, "%s: play mode %d err",
+                    __func__, play_mode);
+            break;
+    }
+    return 0;
+}
+
+static int aw8695_haptic_play_go(struct aw8695 *aw8695, bool flag)
+{
+    pr_debug("%s enter\n", __func__);
+
+    if(flag == true) {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_GO,
+            AW8695_BIT_GO_MASK, AW8695_BIT_GO_ENABLE);
+    } else {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_GO,
+            AW8695_BIT_GO_MASK, AW8695_BIT_GO_DISABLE);
+    }
+    return 0;
+}
+
+
+static int aw8695_haptic_stop(struct aw8695 *aw8695)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8695_haptic_play_go(aw8695, false);
+    aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_STANDBY_MODE);
+
+    return 0;
+}
+
+static int aw8695_haptic_start(struct aw8695 *aw8695)
+{
+    pr_debug("%s enter\n", __func__);
+
+    aw8695_haptic_play_go(aw8695, true);
+
+    return 0;
+}
+
+static int aw8695_haptic_set_wav_seq(struct aw8695 *aw8695,
+        unsigned char wav, unsigned char seq)
+{
+    aw8695_i2c_write(aw8695, AW8695_REG_WAVSEQ1+wav,
+            seq);
+    return 0;
+}
+
+static int aw8695_haptic_set_wav_loop(struct aw8695 *aw8695,
+        unsigned char wav, unsigned char loop)
+{
+    unsigned char tmp = 0;
+
+    if(wav%2) {
+        tmp = loop<<0;
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_WAVLOOP1+(wav/2),
+                AW8695_BIT_WAVLOOP_SEQNP1_MASK, tmp);
+    } else {
+        tmp = loop<<4;
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_WAVLOOP1+(wav/2),
+                AW8695_BIT_WAVLOOP_SEQN_MASK, tmp);
+    }
+
+    return 0;
+}
+/*
+static int aw8695_haptic_set_main_loop(struct aw8695 *aw8695,
+        unsigned char loop)
+{
+    aw8695_i2c_write(aw8695, AW8695_REG_MAIN_LOOP, loop);
+    return 0;
+}
+*/
+static int aw8695_haptic_set_repeat_seq(struct aw8695 *aw8695, unsigned char flag)
+{
+/*
+    if(flag) {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_DATACTRL,
+                AW8695_BIT_DATACTRL_WAV_DBG_MASK, AW8695_BIT_DATACTRL_WAV_DBG);
+    } else {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_DATACTRL,
+                AW8695_BIT_DATACTRL_WAV_DBG_MASK, AW8695_BIT_DATACTRL_WAV_NORMAL);
+    }
+*/
+    return 0;
+}
+
+static int aw8695_haptic_set_repeat_wav_seq(struct aw8695 *aw8695, unsigned char seq)
+{
+/*
+    unsigned char i;
+    for(i=0; i<AW8695_SEQUENCER_SIZE; i++) {
+        aw8695_i2c_write(aw8695, AW8695_REG_WAVSEQ1+i, seq);
+    }
+*/
+
+    aw8695_haptic_set_wav_seq(aw8695, 0x00, seq);
+    aw8695_haptic_set_wav_loop(aw8695, 0x00, AW8695_BIT_WAVLOOP_INIFINITELY);
+
+    return 0;
+}
+
+
+static int aw8695_haptic_set_bst_vol(struct aw8695 *aw8695, unsigned char bst_vol)
+{
+    if(bst_vol & 0xc0) {
+        bst_vol = 0x22;
+    }
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_BSTCFG,
+            AW8695_BIT_BSTCFG_BSTVOL_MASK, bst_vol);
+    return 0;
+}
+
+static int aw8695_haptic_set_bst_peak_cur(struct aw8695 *aw8695, unsigned char peak_cur)
+{
+    switch(aw8695->chipid) {
+        case AW8694_ID:
+        case AW8695_ID:
+            if(peak_cur & 0xfc) {
+                peak_cur = 0x01;
+            }
+            break;
+        case AW8696_ID:
+        case AW8697_ID:
+            if(peak_cur & 0xf8) {
+                peak_cur = 0x05;
+            }
+            break;
+        default:
+            break;
+    }
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_BSTCFG,
+            AW8695_BIT_BSTCFG_PEAKCUR_MASK, peak_cur);
+    return 0;
+}
+
+static int aw8695_haptic_set_gain(struct aw8695 *aw8695, unsigned char gain)
+{
+    aw8695_i2c_write(aw8695, AW8695_REG_DATDBG, gain);
+    return 0;
+}
+
+static int aw8695_haptic_set_pwm(struct aw8695 *aw8695, unsigned char mode)
+{
+    switch(mode) {
+        case AW8695_PWM_48K:
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_PWMDBG,
+                AW8695_BIT_PWMDBG_PWM_MODE_MASK, AW8695_BIT_PWMDBG_PWM_48K);
+            break;
+        case AW8695_PWM_24K:
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_PWMDBG,
+                AW8695_BIT_PWMDBG_PWM_MODE_MASK, AW8695_BIT_PWMDBG_PWM_24K);
+            break;
+        case AW8695_PWM_12K:
+            aw8695_i2c_write_bits(aw8695, AW8695_REG_PWMDBG,
+                AW8695_BIT_PWMDBG_PWM_MODE_MASK, AW8695_BIT_PWMDBG_PWM_12K);
+            break;
+        default:
+            break;
+    }
+    return 0;
+}
+
+static int aw8695_haptic_play_wav_seq(struct aw8695 *aw8695, unsigned char flag)
+{
+    pr_debug("%s enter\n", __func__);
+
+    //aw8695_haptic_stop(aw8695);
+    if(flag) {
+        aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_RAM_MODE);
+        aw8695_haptic_set_repeat_seq(aw8695, 0);
+        aw8695_haptic_start(aw8695);
+    }
+    return 0;
+}
+/*
+static int aw8695_haptic_play_repeat_seq(struct aw8695 *aw8695, unsigned char flag)
+{
+    pr_debug("%s enter\n", __func__);
+    //aw8695_haptic_stop(aw8695);
+    if(flag) {
+        aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_RAM_MODE);
+        aw8695_haptic_set_repeat_seq(aw8695, 1);
+        aw8695_haptic_start(aw8695);
+    }
+
+    return 0;
+}
+*/
+static int aw8695_haptic_set_f0_preset(struct aw8695 *aw8695)
+{
+    unsigned int f0_reg = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    f0_reg = 1000000000/(aw8695->f0_pre*AW8695_HAPTIC_F0_COEFF);
+    aw8695_i2c_write(aw8695, AW8695_REG_F_PRE_H, (unsigned char)((f0_reg>>8)&0xff));
+    aw8695_i2c_write(aw8695, AW8695_REG_F_PRE_L, (unsigned char)((f0_reg>>0)&0xff));
+
+    return 0;
+}
+
+static int aw8695_haptic_get_f0(struct aw8695 *aw8695)
+{
+    int ret = 0;
+    unsigned char reg_val = 0;
+    unsigned int f0_reg = 0;
+    unsigned long f0_tmp = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_F_LRA_F0_H, &reg_val);
+    f0_reg = (reg_val<<8);
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_F_LRA_F0_L, &reg_val);
+    f0_reg |= (reg_val<<0);
+    f0_tmp = 1000000000/(f0_reg*AW8695_HAPTIC_F0_COEFF);
+    aw8695->f0 = (unsigned int)f0_tmp;
+    pr_info("%s f0=%d\n", __func__, aw8695->f0);
+
+    return 0;
+}
+
+static int aw8695_haptic_get_beme(struct aw8695 *aw8695)
+{
+    int ret = 0;
+    unsigned char reg_val = 0;
+
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_WAIT_VOL_MP, &reg_val);
+    aw8695->max_pos_beme = (reg_val<<0);
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_WAIT_VOL_MN, &reg_val);
+    aw8695->max_neg_beme = (reg_val<<0);
+
+    pr_info("%s max_pos_beme=%d\n", __func__, aw8695->max_pos_beme);
+    pr_info("%s max_neg_beme=%d\n", __func__, aw8695->max_neg_beme);
+
+    return 0;
+}
+
+
+
+static void aw8695_haptic_set_rtp_aei(struct aw8695 *aw8695, bool flag)
+{
+    if(flag) {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+                AW8695_BIT_SYSINTM_FF_AE_MASK, AW8695_BIT_SYSINTM_FF_AE_EN);
+    } else {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+                AW8695_BIT_SYSINTM_FF_AE_MASK, AW8695_BIT_SYSINTM_FF_AE_OFF);
+    }
+}
+/*
+static void aw8695_haptic_set_rtp_afi(struct aw8695 *aw8695, bool flag)
+{
+    if(flag) {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+                AW8695_BIT_SYSINTM_FF_AF_MASK, AW8695_BIT_SYSINTM_FF_AF_EN);
+    } else {
+        aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+                AW8695_BIT_SYSINTM_FF_AF_MASK, AW8695_BIT_SYSINTM_FF_AF_OFF);
+    }
+}
+*/
+/*
+static unsigned char aw8695_haptic_rtp_get_fifo_aei(struct aw8695 *aw8695)
+{
+    unsigned char ret;
+    unsigned char reg_val;
+
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+    reg_val &= AW8695_BIT_SYSINT_FF_AEI;
+    ret = reg_val>>4;
+
+    return ret;
+}
+*/
+
+static unsigned char aw8695_haptic_rtp_get_fifo_afi(struct aw8695 *aw8695)
+{
+    unsigned char ret = 0;
+    unsigned char reg_val = 0;
+
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+    reg_val &= AW8695_BIT_SYSINT_FF_AFI;
+    ret = reg_val>>3;
+
+    return ret;
+}
+
+static int aw8695_haptic_rtp_init(struct aw8695 *aw8695)
+{
+    unsigned int buf_len = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    aw8695->rtp_cnt = 0;
+
+    while((!aw8695_haptic_rtp_get_fifo_afi(aw8695)) &&
+            (aw8695->play_mode == AW8695_HAPTIC_RTP_MODE)) {
+        pr_info("%s rtp cnt = %d\n", __func__, aw8695->rtp_cnt);
+        if((aw8695_rtp->len-aw8695->rtp_cnt) < (aw8695->ram.base_addr>>2)) {
+            buf_len = aw8695_rtp->len-aw8695->rtp_cnt;
+        } else {
+            buf_len = (aw8695->ram.base_addr>>2);
+        }
+        aw8695_i2c_writes(aw8695, AW8695_REG_RTP_DATA,
+                &aw8695_rtp->data[aw8695->rtp_cnt], buf_len);
+        aw8695->rtp_cnt += buf_len;
+        if(aw8695->rtp_cnt == aw8695_rtp->len) {
+            pr_info("%s: rtp update complete\n", __func__);
+            aw8695->rtp_cnt = 0;
+            return 0;
+        }
+    }
+
+    if(aw8695->play_mode == AW8695_HAPTIC_RTP_MODE) {
+        aw8695_haptic_set_rtp_aei(aw8695, true);
+    }
+
+    pr_info("%s exit\n", __func__);
+
+    return 0;
+}
+
+static void aw8695_rtp_work_routine(struct work_struct *work)
+{
+    const struct firmware *rtp_file;
+    int ret = -1;
+    struct aw8695 *aw8695 = container_of(work, struct aw8695, rtp_work);
+
+    pr_info("%s enter\n", __func__);
+
+    /* fw loaded */
+    ret = request_firmware(&rtp_file,
+            aw8695_rtp_name[aw8695->rtp_file_num],
+            aw8695->dev);
+    if(ret < 0)
+    {
+        pr_err("%s: failed to read %s\n", __func__,
+                aw8695_rtp_name[aw8695->rtp_file_num]);
+        return ;
+    }
+    aw8695->rtp_init = 0;
+    kfree(aw8695_rtp);
+    aw8695_rtp = kzalloc(rtp_file->size+sizeof(int), GFP_KERNEL);
+    if (!aw8695_rtp) {
+        release_firmware(rtp_file);
+        pr_err("%s: error allocating memory\n", __func__);
+        return;
+    }
+    aw8695_rtp->len = rtp_file->size;
+    pr_info("%s: rtp file [%s] size = %d\n", __func__,
+            aw8695_rtp_name[aw8695->rtp_file_num], aw8695_rtp->len);
+    memcpy(aw8695_rtp->data, rtp_file->data, rtp_file->size);
+    release_firmware(rtp_file);
+
+    aw8695->rtp_init = 1;
+
+    /* rtp mode config */
+    aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_RTP_MODE);
+
+    /* haptic start */
+    aw8695_haptic_start(aw8695);
+
+    aw8695_haptic_rtp_init(aw8695);
+}
+
+
+/*****************************************************
+ *
+ * haptic - audio
+ *
+ *****************************************************/
+static enum hrtimer_restart aw8695_haptic_audio_timer_func(struct hrtimer *timer)
+{
+    struct aw8695 *aw8695 = container_of(timer, struct aw8695, haptic_audio.timer);
+
+    pr_debug("%s enter\n", __func__);
+    schedule_work(&aw8695->haptic_audio.work);
+
+    hrtimer_start(&aw8695->haptic_audio.timer,
+            ktime_set(aw8695->haptic_audio.timer_val/1000000,
+                    (aw8695->haptic_audio.timer_val%1000000)*1000),
+            HRTIMER_MODE_REL);
+    return HRTIMER_NORESTART;
+}
+
+static void aw8695_haptic_audio_work_routine(struct work_struct *work)
+{
+    struct aw8695 *aw8695 = container_of(work, struct aw8695, haptic_audio.work);
+
+    pr_debug("%s enter\n", __func__);
+
+    mutex_lock(&aw8695->haptic_audio.lock);
+    memcpy(&aw8695->haptic_audio.ctr,
+            &aw8695->haptic_audio.data[aw8695->haptic_audio.cnt],
+            sizeof(struct haptic_ctr));
+    pr_debug("%s: cnt=%d, cmd=%d, play=%d, wavseq=%d, loop=%d, gain=%d\n",
+            __func__,
+            aw8695->haptic_audio.cnt,
+            aw8695->haptic_audio.ctr.cmd,
+            aw8695->haptic_audio.ctr.play,
+            aw8695->haptic_audio.ctr.wavseq,
+            aw8695->haptic_audio.ctr.loop,
+            aw8695->haptic_audio.ctr.gain);
+    mutex_unlock(&aw8695->haptic_audio.lock);
+    if(aw8695->haptic_audio.ctr.cmd == 0x01) {
+        if(aw8695->haptic_audio.ctr.play == 0x01) {
+            pr_info("%s: haptic_audio_play_start\n", __func__);
+            mutex_lock(&aw8695->lock);
+            aw8695_haptic_stop(aw8695);
+
+            aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_RAM_MODE);
+
+            aw8695_haptic_set_wav_seq(aw8695, 0x00,
+                    aw8695->haptic_audio.ctr.wavseq);
+            aw8695_haptic_set_wav_seq(aw8695, 0x01, 0x00);
+
+            aw8695_haptic_set_wav_loop(aw8695, 0x00,
+                    aw8695->haptic_audio.ctr.loop);
+
+            aw8695_haptic_set_gain(aw8695,
+                    aw8695->haptic_audio.ctr.gain);
+
+            aw8695_haptic_start(aw8695);
+            mutex_unlock(&aw8695->lock);
+        }
+        mutex_lock(&aw8695->haptic_audio.lock);
+        memset(&aw8695->haptic_audio.data[aw8695->haptic_audio.cnt],
+                0, sizeof(struct haptic_ctr));
+        mutex_unlock(&aw8695->haptic_audio.lock);
+    }
+
+    mutex_lock(&aw8695->haptic_audio.lock);
+    aw8695->haptic_audio.cnt ++;
+    if(aw8695->haptic_audio.data[aw8695->haptic_audio.cnt].cmd == 0) {
+        aw8695->haptic_audio.cnt = 0;
+        pr_debug("%s: haptic play buffer restart\n", __func__);
+    }
+    mutex_unlock(&aw8695->haptic_audio.lock);
+
+}
+
+
+
+/*****************************************************
+ *
+ * haptic cont
+ *
+ *****************************************************/
+static int aw8695_haptic_cont(struct aw8695 *aw8695)
+{
+    pr_info("%s enter\n", __func__);
+
+    mutex_lock(&aw8695->lock);
+
+
+    /* work mode */
+    aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_CONT_MODE);
+
+    /* preset f0 */
+    aw8695->f0_pre = aw8695->f0;
+    aw8695_haptic_set_f0_preset(aw8695);
+
+    /* lpf */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_DATCTRL,
+            AW8695_BIT_DATCTRL_FC_MASK, AW8695_BIT_DATCTRL_FC_1000HZ);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_DATCTRL,
+            AW8695_BIT_DATCTRL_LPF_ENABLE_MASK, AW8695_BIT_DATCTRL_LPF_ENABLE);
+
+    /* cont config */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_ZC_DETEC_MASK, AW8695_BIT_CONT_CTRL_ZC_DETEC_ENABLE);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_WAIT_PERIOD_MASK, AW8695_BIT_CONT_CTRL_WAIT_1PERIOD);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_MODE_MASK, AW8695_BIT_CONT_CTRL_BY_GO_SIGNAL);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_EN_CLOSE_MASK, AW8695_BIT_CONT_CTRL_OPEN_PLAYBACK);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_F0_DETECT_MASK, AW8695_BIT_CONT_CTRL_F0_DETECT_DISABLE);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_O2C_MASK, AW8695_BIT_CONT_CTRL_O2C_DISABLE);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_AUTO_BRK_MASK, AW8695_BIT_CONT_CTRL_AUTO_BRK_ENABLE);
+
+    /* TD time */
+    aw8695_i2c_write(aw8695, AW8695_REG_TD_H, 0x00);
+    aw8695_i2c_write(aw8695, AW8695_REG_TD_L, 0x5d);
+    aw8695_i2c_write(aw8695, AW8695_REG_TSET, 0x12);
+
+    /* zero cross */
+    aw8695_i2c_write(aw8695, AW8695_REG_ZC_THRSH_H, 0x0f);
+    aw8695_i2c_write(aw8695, AW8695_REG_ZC_THRSH_L, 0xf1);
+
+    /* bemf */
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHH_H, 0x10);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHH_L, 0x08);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHL_H, 0x03);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHL_L, 0xf8);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_NUM, 0x53);
+    aw8695_i2c_write(aw8695, AW8695_REG_TIME_NZC, 0x1f);
+
+    /* f0 driver level */
+    aw8695_i2c_write(aw8695, AW8695_REG_DRV_LVL, aw8695->f0_drv_lvl);
+    aw8695_i2c_write(aw8695, AW8695_REG_DRV_LVL_OV, 0x7f);
+
+    /* cont play go */
+    aw8695_haptic_play_go(aw8695, true);
+
+    mutex_unlock(&aw8695->lock);
+
+    return 0;
+}
+
+/*****************************************************
+ *
+ * haptic f0 cali
+ *
+ *****************************************************/
+static int aw8695_haptic_f0_calibration(struct aw8695 *aw8695)
+{
+    int ret = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    unsigned char f0_pre_num = 0;
+    unsigned char f0_wait_num = 0;
+    unsigned char f0_repeat_num = 0;
+    unsigned char f0_trace_num = 0;
+    unsigned int t_f0_ms = 0;
+    unsigned int t_f0_trace_ms = 0;
+    unsigned int f0_cali_cnt = 50;
+    char f0_cali_lra = 0;
+    int f0_cali_step = 0;
+    int f0_dft_step = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    mutex_lock(&aw8695->lock);
+
+    aw8695->f0_pre = AW8695_HAPTIC_F0_PRE;
+    aw8695->f0 = aw8695->f0_pre;
+    aw8695->f0_drv_lvl = AW8695_HAPTIC_F0_DRV_LVL;
+
+    /* f0 calibrate work mode */
+    aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_CONT_MODE);
+
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_EN_CLOSE_MASK, AW8695_BIT_CONT_CTRL_OPEN_PLAYBACK);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_F0_DETECT_MASK, AW8695_BIT_CONT_CTRL_F0_DETECT_ENABLE);
+
+    /* LPF */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_DATCTRL,
+            AW8695_BIT_DATCTRL_FC_MASK, AW8695_BIT_DATCTRL_FC_1000HZ);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_DATCTRL,
+            AW8695_BIT_DATCTRL_LPF_ENABLE_MASK, AW8695_BIT_DATCTRL_LPF_ENABLE);
+
+    /* LRA OSC Source */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_ANACTRL,
+            AW8695_BIT_ANACTRL_LRA_SRC_MASK, AW8695_BIT_ANACTRL_LRA_SRC_REG);
+
+    /* preset f0 */
+    aw8695_haptic_set_f0_preset(aw8695);
+
+    /* beme config */
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHH_H, 0x10);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHH_L, 0x08);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHL_H, 0x03);
+    aw8695_i2c_write(aw8695, AW8695_REG_BEMF_VTHL_L, 0xf8);
+
+    /* f0 driver level */
+    aw8695_i2c_write(aw8695, AW8695_REG_DRV_LVL, aw8695->f0_drv_lvl);
+
+    /* f0 trace parameter */
+    f0_pre_num = 0x05;
+    f0_wait_num = 0x03;
+    f0_repeat_num = 0x02;
+    f0_trace_num = 0x0f;
+    aw8695_i2c_write(aw8695, AW8695_REG_NUM_F0_1, (f0_pre_num<<4)|(f0_wait_num<<0));
+    aw8695_i2c_write(aw8695, AW8695_REG_NUM_F0_2, (f0_repeat_num<<0));
+    aw8695_i2c_write(aw8695, AW8695_REG_NUM_F0_3, (f0_trace_num<<0));
+
+    /* clear aw8695 interrupt */
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+
+    /* play go and start f0 calibration */
+    aw8695_haptic_play_go(aw8695, true);
+
+    /* f0 trace time */
+    t_f0_ms = 1000*10/aw8695->f0_pre;
+    t_f0_trace_ms = t_f0_ms * (f0_pre_num + f0_wait_num + (f0_trace_num+f0_wait_num)*(f0_repeat_num-1));
+    msleep(t_f0_trace_ms);
+
+    for(i=0; i<f0_cali_cnt; i++) {
+        ret = aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+        /* f0 calibrate done */
+        if(reg_val & 0x01) {
+            aw8695_haptic_get_f0(aw8695);
+            aw8695_haptic_get_beme(aw8695);
+            break;
+        }
+        msleep(10);
+        pr_debug("%s f0 cali sleep 10ms\n", __func__);
+    }
+
+    if(i == f0_cali_cnt) {
+        pr_err("%s get f0 error, user defafult f0\n", __func__);
+    } else {
+        /* calculate cali step */
+        f0_cali_step = 10000*((int)aw8695->f0-(int)aw8695->f0_pre)/((int)aw8695->f0_pre*24);
+        pr_debug("%s f0_cali_step=%d\n", __func__, f0_cali_step);
+
+        /* get default cali step */
+        aw8695_i2c_read(aw8695, AW8695_REG_TRIM_LRA, &reg_val);
+        if(reg_val & 0x20) {
+            f0_dft_step = reg_val - 0x40;
+        } else {
+            f0_dft_step = reg_val;
+        }
+        pr_debug("%s f0_dft_step=%d\n", __func__, f0_dft_step);
+
+        /* get new cali step */
+        f0_cali_step += f0_dft_step;
+        pr_debug("%s f0_cali_step=%d\n", __func__, f0_cali_step);
+
+        if(f0_cali_step > 31) {
+            f0_cali_step = 31;
+        } else if(f0_cali_step < -32) {
+            f0_cali_step = -32;
+        }
+        f0_cali_lra = (char)f0_cali_step;
+        pr_debug("%s f0_cali_lra=%d\n", __func__, f0_cali_lra);
+
+        /* get cali step complement code*/
+        if(f0_cali_lra < 0) {
+            f0_cali_lra = ~f0_cali_lra;
+            f0_cali_lra ++;
+        }
+        pr_debug("%s reg f0_cali_lra=%d\n", __func__, f0_cali_lra);
+
+        /* update cali step */
+        aw8695_i2c_write(aw8695, AW8695_REG_TRIM_LRA, (char)f0_cali_lra);
+        aw8695_i2c_read(aw8695, AW8695_REG_TRIM_LRA, &reg_val);
+        pr_info("%s final trim_lra=0x%02x\n", __func__, reg_val);
+    }
+
+    /* restore default work mode */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_EN_CLOSE_MASK, AW8695_BIT_CONT_CTRL_CLOSE_PLAYBACK);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_CONT_CTRL,
+            AW8695_BIT_CONT_CTRL_F0_DETECT_MASK, AW8695_BIT_CONT_CTRL_F0_DETECT_DISABLE);
+
+    aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_RAM_MODE);
+    aw8695_haptic_stop(aw8695);
+
+    mutex_unlock(&aw8695->lock);
+
+    return ret;
+}
+
+/*****************************************************
+ *
+ * haptic fops
+ *
+ *****************************************************/
+static int aw8695_file_open(struct inode *inode, struct file *file)
+{
+    if (!try_module_get(THIS_MODULE))
+        return -ENODEV;
+
+    file->private_data = (void*)g_aw8695;
+
+    return 0;
+}
+
+static int aw8695_file_release(struct inode *inode, struct file *file)
+{
+    file->private_data = (void*)NULL;
+
+    module_put(THIS_MODULE);
+
+    return 0;
+}
+
+static long aw8695_file_unlocked_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
+{
+    struct aw8695 *aw8695 = (struct aw8695 *)file->private_data;
+
+    int ret = 0;
+
+    dev_info(aw8695->dev, "%s: cmd=0x%x, arg=0x%lx\n",
+              __func__, cmd, arg);
+
+    mutex_lock(&aw8695->lock);
+
+    if(_IOC_TYPE(cmd) != AW8695_HAPTIC_IOCTL_MAGIC) {
+        dev_err(aw8695->dev, "%s: cmd magic err\n",
+                __func__);
+        return -EINVAL;
+    }
+
+    switch (cmd) {
+        default:
+            dev_err(aw8695->dev, "%s, unknown cmd\n", __func__);
+            break;
+    }
+
+    mutex_unlock(&aw8695->lock);
+
+    return ret;
+}
+
+static ssize_t aw8695_file_read(struct file* filp, char* buff, size_t len, loff_t* offset)
+{
+    struct aw8695 *aw8695 = (struct aw8695 *)filp->private_data;
+    int ret = 0;
+    int i = 0;
+    unsigned char reg_val = 0;
+    unsigned char *pbuff = NULL;
+
+    mutex_lock(&aw8695->lock);
+
+    dev_info(aw8695->dev, "%s: len=%zu\n", __func__, len);
+
+    switch(aw8695->fileops.cmd)
+    {
+        case AW8695_HAPTIC_CMD_READ_REG:
+            pbuff = (unsigned char *)kzalloc(len, GFP_KERNEL);
+            if(pbuff != NULL) {
+                for(i=0; i<len; i++) {
+                    aw8695_i2c_read(aw8695, aw8695->fileops.reg+i, &reg_val);
+                    pbuff[i] = reg_val;
+                }
+                for(i=0; i<len; i++) {
+                    dev_info(aw8695->dev, "%s: pbuff[%d]=0x%02x\n",
+                            __func__, i, pbuff[i]);
+                }
+                ret = copy_to_user(buff, pbuff, len);
+                if(ret) {
+                    dev_err(aw8695->dev, "%s: copy to user fail\n", __func__);
+                }
+                kfree(pbuff);
+            } else {
+                dev_err(aw8695->dev, "%s: alloc memory fail\n", __func__);
+            }
+            break;
+        default:
+            dev_err(aw8695->dev, "%s, unknown cmd %d \n", __func__, aw8695->fileops.cmd);
+            break;
+    }
+
+    mutex_unlock(&aw8695->lock);
+
+
+    return len;
+}
+
+static ssize_t aw8695_file_write(struct file* filp, const char* buff, size_t len, loff_t* off)
+{
+    struct aw8695 *aw8695 = (struct aw8695 *)filp->private_data;
+    int i = 0;
+    int ret = 0;
+    unsigned char *pbuff = NULL;
+
+    pbuff = (unsigned char *)kzalloc(len, GFP_KERNEL);
+    if(pbuff == NULL) {
+        dev_err(aw8695->dev, "%s: alloc memory fail\n", __func__);
+        return len;
+    }
+    ret = copy_from_user(pbuff, buff, len);
+    if(ret) {
+        dev_err(aw8695->dev, "%s: copy from user fail\n", __func__);
+        return len;
+    }
+
+    for(i=0; i<len; i++) {
+        dev_info(aw8695->dev, "%s: pbuff[%d]=0x%02x\n",
+                __func__, i, pbuff[i]);
+    }
+
+    mutex_lock(&aw8695->lock);
+
+    aw8695->fileops.cmd = pbuff[0];
+
+    switch(aw8695->fileops.cmd)
+    {
+        case AW8695_HAPTIC_CMD_READ_REG:
+            if(len == 2) {
+                aw8695->fileops.reg = pbuff[1];
+            } else {
+                dev_err(aw8695->dev, "%s: read cmd len %zu err\n", __func__, len);
+            }
+            break;
+        case AW8695_HAPTIC_CMD_WRITE_REG:
+            if(len > 2) {
+                for(i=0; i<len-2; i++) {
+                    dev_info(aw8695->dev, "%s: write reg0x%02x=0x%02x\n",
+                            __func__, pbuff[1]+i, pbuff[i+2]);
+                    aw8695_i2c_write(aw8695, pbuff[1]+i, pbuff[2+i]);
+                }
+            } else {
+                dev_err(aw8695->dev, "%s: write cmd len %zu err\n", __func__, len);
+            }
+            break;
+        default:
+            dev_err(aw8695->dev, "%s, unknown cmd %d \n", __func__, aw8695->fileops.cmd);
+            break;
+    }
+
+    mutex_unlock(&aw8695->lock);
+
+    if(pbuff != NULL) {
+        kfree(pbuff);
+    }
+    return len;
+}
+
+static struct file_operations fops =
+{
+    .owner = THIS_MODULE,
+    .read = aw8695_file_read,
+    .write = aw8695_file_write,
+    .unlocked_ioctl = aw8695_file_unlocked_ioctl,
+    .open = aw8695_file_open,
+    .release = aw8695_file_release,
+};
+
+static struct miscdevice aw8695_haptic_misc =
+{
+    .minor = MISC_DYNAMIC_MINOR,
+    .name = AW8695_HAPTIC_NAME,
+    .fops = &fops,
+};
+
+static int aw8695_haptic_init(struct aw8695 *aw8695)
+{
+    int ret = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    ret = misc_register(&aw8695_haptic_misc);
+    if(ret) {
+        dev_err(aw8695->dev,  "%s: misc fail: %d\n", __func__, ret);
+        return ret;
+    }
+
+    /* haptic audio */
+    aw8695->haptic_audio.delay_val = 20833;
+    aw8695->haptic_audio.timer_val = 20833;
+
+    hrtimer_init(&aw8695->haptic_audio.timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+    aw8695->haptic_audio.timer.function = aw8695_haptic_audio_timer_func;
+    INIT_WORK(&aw8695->haptic_audio.work, aw8695_haptic_audio_work_routine);
+
+    mutex_init(&aw8695->haptic_audio.lock);
+
+
+       /* haptic init */
+    mutex_lock(&aw8695->lock);
+
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_WAVSEQ1, &reg_val);
+    aw8695->index = reg_val & 0x7F;
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_DATDBG, &reg_val);
+    aw8695->gain = reg_val & 0x7F;
+    ret = aw8695_i2c_read(aw8695, AW8695_REG_BSTDBG4, &reg_val);
+    aw8695->vmax = (reg_val>>0)&0x3F;
+    for(i=0; i<AW8695_SEQUENCER_SIZE; i++) {
+        ret = aw8695_i2c_read(aw8695, AW8695_REG_WAVSEQ1+i, &reg_val);
+        aw8695->seq[i] = reg_val;
+    }
+
+    aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_STANDBY_MODE);
+
+    aw8695_haptic_set_pwm(aw8695, AW8695_PWM_24K);
+
+    aw8695_i2c_write(aw8695, AW8695_REG_BSTDBG1, 0x30);
+    aw8695_i2c_write(aw8695, AW8695_REG_BSTDBG2, 0xeb);
+    aw8695_i2c_write(aw8695, AW8695_REG_BSTDBG3, 0xd4);
+    aw8695_i2c_write(aw8695, AW8695_REG_TSET, 0x12);
+    aw8695_i2c_write(aw8695, AW8695_REG_R_SPARE, 0x68);
+
+    aw8695_haptic_set_bst_peak_cur(aw8695, 0x01);
+
+    mutex_unlock(&aw8695->lock);
+
+
+    /* f0 calibration */
+    aw8695_haptic_f0_calibration(aw8695);
+
+    return ret;
+}
+
+
+
+/*****************************************************
+ *
+ * vibrator
+ *
+ *****************************************************/
+#ifdef TIMED_OUTPUT
+static int aw8695_vibrator_get_time(struct timed_output_dev *dev)
+{
+    struct aw8695 *aw8695 = container_of(dev, struct aw8695, to_dev);
+
+    if (hrtimer_active(&aw8695->timer)) {
+        ktime_t r = hrtimer_get_remaining(&aw8695->timer);
+        return ktime_to_ms(r);
+    }
+
+    return 0;
+}
+
+static void aw8695_vibrator_enable( struct timed_output_dev *dev, int value)
+{
+    struct aw8695 *aw8695 = container_of(dev, struct aw8695, to_dev);
+
+    mutex_lock(&aw8695->lock);
+
+    pr_debug("%s enter\n", __func__);
+
+    aw8695_haptic_stop(aw8695);
+
+    if (value > 0) {
+        aw8695_haptic_play_wav_seq(aw8695, value);
+    }
+
+    mutex_unlock(&aw8695->lock);
+
+    pr_debug("%s exit\n", __func__);
+}
+
+#else
+static enum led_brightness aw8695_haptic_brightness_get(struct led_classdev *cdev)
+{
+    struct aw8695 *aw8695 =
+        container_of(cdev, struct aw8695, cdev);
+
+    return aw8695->amplitude;
+}
+
+static void aw8695_haptic_brightness_set(struct led_classdev *cdev,
+                enum led_brightness level)
+{
+    struct aw8695 *aw8695 =
+        container_of(cdev, struct aw8695, cdev);
+
+    aw8695->amplitude = level;
+
+    mutex_lock(&aw8695->lock);
+
+    aw8695_haptic_stop(aw8695);
+    if (aw8695->amplitude > 0) {
+        aw8695_haptic_play_wav_seq(aw8695, aw8695->amplitude);
+    }
+
+    mutex_unlock(&aw8695->lock);
+
+}
+#endif
+
+static ssize_t aw8695_state_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "%d\n", aw8695->state);
+}
+
+static ssize_t aw8695_state_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+    return count;
+}
+
+static ssize_t aw8695_duration_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ktime_t time_rem;
+    s64 time_ms = 0;
+
+    if (hrtimer_active(&aw8695->timer)) {
+        time_rem = hrtimer_get_remaining(&aw8695->timer);
+        time_ms = ktime_to_ms(time_rem);
+    }
+
+    return snprintf(buf, PAGE_SIZE, "%lld\n", time_ms);
+}
+
+static ssize_t aw8695_duration_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    /* setting 0 on duration is NOP for now */
+    if (val <= 0)
+        return count;
+
+    aw8695->duration = val;
+
+    return count;
+}
+
+static ssize_t aw8695_activate_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+
+    /* For now nothing to show */
+    return snprintf(buf, PAGE_SIZE, "%d\n", aw8695->state);
+}
+
+static ssize_t aw8695_activate_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    if (val != 0 && val != 1)
+        return count;
+
+    pr_debug("%s: value=%d\n", __FUNCTION__, val);
+
+    mutex_lock(&aw8695->lock);
+    hrtimer_cancel(&aw8695->timer);
+
+    aw8695->state = val;
+
+    if (aw8695->state)
+    {
+        /* clip value to max */
+        val = aw8695->duration;
+        /* run ms timer */
+        hrtimer_start(&aw8695->timer,
+                  ktime_set(val / 1000, (val % 1000) * 1000000),
+                  HRTIMER_MODE_REL);
+    }
+    mutex_unlock(&aw8695->lock);
+    schedule_work(&aw8695->vibrator_work);
+
+    return count;
+}
+
+static ssize_t aw8695_index_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned char reg_val = 0;
+    aw8695_i2c_read(aw8695, AW8695_REG_WAVSEQ1, &reg_val);
+    aw8695->index = reg_val;
+
+    return snprintf(buf, PAGE_SIZE, "%d\n", aw8695->index);
+}
+
+static ssize_t aw8695_index_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    pr_debug("%s: value=%d\n", __FUNCTION__, val);
+
+    mutex_lock(&aw8695->lock);
+    aw8695->index = val;
+    aw8695_haptic_set_repeat_wav_seq(aw8695, aw8695->index);
+    mutex_unlock(&aw8695->lock);
+    return count;
+}
+
+static ssize_t aw8695_vmax_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "0x%02x\n", aw8695->vmax);
+}
+
+static ssize_t aw8695_vmax_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    pr_debug("%s: value=%d\n", __FUNCTION__, val);
+
+    mutex_lock(&aw8695->lock);
+    aw8695->vmax = val;
+    aw8695_haptic_set_bst_vol(aw8695, aw8695->vmax);
+    mutex_unlock(&aw8695->lock);
+    return count;
+}
+
+static ssize_t aw8695_gain_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+
+    return snprintf(buf, PAGE_SIZE, "0x%02x\n", aw8695->gain);
+}
+
+static ssize_t aw8695_gain_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    pr_debug("%s: value=%d\n", __FUNCTION__, val);
+
+    mutex_lock(&aw8695->lock);
+    aw8695->gain = val;
+    aw8695_haptic_set_gain(aw8695, aw8695->gain);
+    mutex_unlock(&aw8695->lock);
+    return count;
+}
+
+static ssize_t aw8695_seq_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    size_t count = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+
+    for(i=0; i<AW8695_SEQUENCER_SIZE; i++) {
+        aw8695_i2c_read(aw8695, AW8695_REG_WAVSEQ1+i, &reg_val);
+        count += snprintf(buf+count, PAGE_SIZE-count,
+                "seq%d: 0x%02x\n", i+1, reg_val);
+        aw8695->seq[i] |= reg_val;
+    }
+    return count;
+}
+
+static ssize_t aw8695_seq_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        pr_debug("%s: seq%d=0x%x\n", __FUNCTION__, databuf[0], databuf[1]);
+        mutex_lock(&aw8695->lock);
+        aw8695->seq[databuf[0]] = (unsigned char)databuf[1];
+        aw8695_haptic_set_wav_seq(aw8695, (unsigned char)databuf[0],
+                aw8695->seq[databuf[0]]);
+        mutex_unlock(&aw8695->lock);
+    }
+    return count;
+}
+
+static ssize_t aw8695_loop_show(struct device *dev,
+        struct device_attribute *attr, char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    size_t count = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+
+    for(i=0; i<AW8695_SEQUENCER_LOOP_SIZE; i++) {
+        aw8695_i2c_read(aw8695, AW8695_REG_WAVLOOP1+i, &reg_val);
+        aw8695->loop[i*2+0] = (reg_val>>4)&0x0F;
+        aw8695->loop[i*2+1] = (reg_val>>0)&0x0F;
+
+        count += snprintf(buf+count, PAGE_SIZE-count,
+                "seq%d loop: 0x%02x\n", i*2+1, aw8695->loop[i*2+0]);
+        count += snprintf(buf+count, PAGE_SIZE-count,
+                "seq%d loop: 0x%02x\n", i*2+2, aw8695->loop[i*2+1]);
+    }
+    return count;
+}
+
+static ssize_t aw8695_loop_store(struct device *dev,
+        struct device_attribute *attr, const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        pr_debug("%s: seq%d loop=0x%x\n", __FUNCTION__, databuf[0], databuf[1]);
+        mutex_lock(&aw8695->lock);
+        aw8695->loop[databuf[0]] = (unsigned char)databuf[1];
+        aw8695_haptic_set_wav_loop(aw8695, (unsigned char)databuf[0],
+                aw8695->loop[databuf[0]]);
+        mutex_unlock(&aw8695->lock);
+    }
+
+    return count;
+}
+
+static ssize_t aw8695_reg_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    for(i = 0; i < AW8695_REG_MAX; i ++) {
+        if(!(aw8695_reg_access[i]&REG_RD_ACCESS))
+           continue;
+        aw8695_i2c_read(aw8695, i, &reg_val);
+        len += snprintf(buf+len, PAGE_SIZE-len, "reg:0x%02x=0x%02x \n", i, reg_val);
+    }
+    return len;
+}
+
+static ssize_t aw8695_reg_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        aw8695_i2c_write(aw8695, (unsigned char)databuf[0], (unsigned char)databuf[1]);
+    }
+
+    return count;
+}
+
+static ssize_t aw8695_rtp_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "rtp play: %d\n", aw8695->rtp_cnt);
+
+    return len;
+}
+
+static ssize_t aw8695_rtp_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    aw8695_haptic_stop(aw8695);
+    aw8695_haptic_set_rtp_aei(aw8695, false);
+    aw8695_interrupt_clear(aw8695);
+    if(val < (sizeof(aw8695_rtp_name)/AW8695_RTP_NAME_MAX)) {
+        aw8695->rtp_file_num = val;
+        if(val) {
+            schedule_work(&aw8695->rtp_work);
+        }
+    } else {
+        pr_err("%s: rtp_file_num 0x%02x over max value \n", __func__, aw8695->rtp_file_num);
+    }
+
+    return count;
+}
+
+static ssize_t aw8695_ram_update_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    //struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    //struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    //struct led_classdev *cdev = dev_get_drvdata(dev);
+    //struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "sram update mode\n");
+    return len;
+}
+
+static ssize_t aw8695_ram_update_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    if(val) {
+        aw8695_ram_update(aw8695);
+    }
+    return count;
+}
+
+static ssize_t aw8695_cali_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    aw8695_haptic_get_f0(aw8695);
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8695 f0 = %d\n", aw8695->f0);
+    return len;
+}
+
+static ssize_t aw8695_cali_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    if(val) {
+        aw8695_haptic_f0_calibration(aw8695);
+    }
+    return count;
+}
+
+static ssize_t aw8695_cont_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    aw8695_haptic_get_f0(aw8695);
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8695 f0 = %d\n", aw8695->f0);
+    return len;
+}
+
+static ssize_t aw8695_cont_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int val = 0;
+    int rc = 0;
+
+    rc = kstrtouint(buf, 0, &val);
+    if (rc < 0)
+        return rc;
+
+    aw8695_haptic_stop(aw8695);
+    if(val) {
+        aw8695_haptic_cont(aw8695);
+    }
+    return count;
+}
+
+
+static ssize_t aw8695_haptic_audio_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "%d\n", aw8695->haptic_audio.cnt);
+    return len;
+}
+
+static ssize_t aw8695_haptic_audio_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int databuf[6] = {0};
+
+    if(6 == sscanf(buf, "%d %d %d %d %d %d", &databuf[0], &databuf[1], &databuf[2],
+            &databuf[3], &databuf[4], &databuf[5])) {
+        pr_debug("%s: cnt=%d, cmd=%d, play=%d, wavseq=%d, loop=%d, gain=%d\n",
+                __func__, databuf[0], databuf[1], databuf[2], databuf[3],
+                databuf[4], databuf[5]);
+        mutex_lock(&aw8695->haptic_audio.lock);
+        aw8695->haptic_audio.data[(unsigned char)databuf[0]].cmd = (unsigned char)databuf[1];
+        aw8695->haptic_audio.data[(unsigned char)databuf[0]].play = (unsigned char)databuf[2];
+        aw8695->haptic_audio.data[(unsigned char)databuf[0]].wavseq = (unsigned char)databuf[3];
+        aw8695->haptic_audio.data[(unsigned char)databuf[0]].loop = (unsigned char)databuf[4];
+        aw8695->haptic_audio.data[(unsigned char)databuf[0]].gain = (unsigned char)databuf[5];
+        mutex_unlock(&aw8695->haptic_audio.lock);
+
+        if(aw8695->haptic_audio.data[aw8695->haptic_audio.cnt].cmd == 0xff) {
+            pr_info("%s: haptic_audio stop\n", __func__);
+            if(hrtimer_active(&aw8695->haptic_audio.timer)) {
+                pr_info("%s: cancel haptic_audio_timer\n", __func__);
+                hrtimer_cancel(&aw8695->haptic_audio.timer);
+                aw8695->haptic_audio.cnt = 0;
+                aw8695_haptic_set_gain(aw8695, 0x80);
+            }
+        } else {
+            if(hrtimer_active(&aw8695->haptic_audio.timer)) {
+            } else {
+                pr_info("%s: start haptic_audio_timer\n", __func__);
+                hrtimer_start(&aw8695->haptic_audio.timer,
+                        ktime_set(aw8695->haptic_audio.delay_val/1000000,
+                                (aw8695->haptic_audio.delay_val%1000000)*1000),
+                        HRTIMER_MODE_REL);
+            }
+        }
+    }
+    return count;
+}
+
+
+static ssize_t aw8695_haptic_audio_time_show(struct device *dev, struct device_attribute *attr,
+        char *buf)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    ssize_t len = 0;
+    len += snprintf(buf+len, PAGE_SIZE-len, "haptic_audio.delay_val=%dus\n", aw8695->haptic_audio.delay_val);
+    len += snprintf(buf+len, PAGE_SIZE-len, "haptic_audio.timer_val=%dus\n", aw8695->haptic_audio.timer_val);
+    return len;
+}
+
+static ssize_t aw8695_haptic_audio_time_store(struct device *dev, struct device_attribute *attr,
+        const char *buf, size_t count)
+{
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev *to_dev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(to_dev, struct aw8695, to_dev);
+#else
+    struct led_classdev *cdev = dev_get_drvdata(dev);
+    struct aw8695 *aw8695 = container_of(cdev, struct aw8695, cdev);
+#endif
+    unsigned int databuf[2] = {0};
+
+    if(2 == sscanf(buf, "%d %d", &databuf[0], &databuf[1])) {
+        aw8695->haptic_audio.delay_val = databuf[0];
+        aw8695->haptic_audio.timer_val = databuf[1];
+    }
+    return count;
+}
+
+
+static DEVICE_ATTR(state, S_IWUSR | S_IRUGO, aw8695_state_show, aw8695_state_store);
+static DEVICE_ATTR(duration, S_IWUSR | S_IRUGO, aw8695_duration_show, aw8695_duration_store);
+static DEVICE_ATTR(activate, S_IWUSR | S_IRUGO, aw8695_activate_show, aw8695_activate_store);
+static DEVICE_ATTR(index, S_IWUSR | S_IRUGO, aw8695_index_show, aw8695_index_store);
+static DEVICE_ATTR(vmax, S_IWUSR | S_IRUGO, aw8695_vmax_show, aw8695_vmax_store);
+static DEVICE_ATTR(gain, S_IWUSR | S_IRUGO, aw8695_gain_show, aw8695_gain_store);
+static DEVICE_ATTR(seq, S_IWUSR | S_IRUGO, aw8695_seq_show, aw8695_seq_store);
+static DEVICE_ATTR(loop, S_IWUSR | S_IRUGO, aw8695_loop_show, aw8695_loop_store);
+static DEVICE_ATTR(register, S_IWUSR | S_IRUGO, aw8695_reg_show, aw8695_reg_store);
+static DEVICE_ATTR(rtp, S_IWUSR | S_IRUGO, aw8695_rtp_show, aw8695_rtp_store);
+static DEVICE_ATTR(ram_update, S_IWUSR | S_IRUGO, aw8695_ram_update_show, aw8695_ram_update_store);
+static DEVICE_ATTR(cali, S_IWUSR | S_IRUGO, aw8695_cali_show, aw8695_cali_store);
+static DEVICE_ATTR(cont, S_IWUSR | S_IRUGO, aw8695_cont_show, aw8695_cont_store);
+static DEVICE_ATTR(haptic_audio, S_IWUSR | S_IRUGO, aw8695_haptic_audio_show, aw8695_haptic_audio_store);
+static DEVICE_ATTR(haptic_audio_time, S_IWUSR | S_IRUGO, aw8695_haptic_audio_time_show, aw8695_haptic_audio_time_store);
+
+
+static struct attribute *aw8695_vibrator_attributes[] = {
+    &dev_attr_state.attr,
+    &dev_attr_duration.attr,
+    &dev_attr_activate.attr,
+    &dev_attr_index.attr,
+    &dev_attr_vmax.attr,
+    &dev_attr_gain.attr,
+    &dev_attr_seq.attr,
+    &dev_attr_loop.attr,
+    &dev_attr_register.attr,
+    &dev_attr_rtp.attr,
+    &dev_attr_ram_update.attr,
+    &dev_attr_cali.attr,
+    &dev_attr_cont.attr,
+    &dev_attr_haptic_audio.attr,
+    &dev_attr_haptic_audio_time.attr,
+    NULL
+};
+
+static struct attribute_group aw8695_vibrator_attribute_group = {
+    .attrs = aw8695_vibrator_attributes
+};
+
+static enum hrtimer_restart aw8695_vibrator_timer_func(struct hrtimer *timer)
+{
+    struct aw8695 *aw8695 = container_of(timer, struct aw8695, timer);
+
+    pr_debug("%s enter\n", __func__);
+    aw8695->state = 0;
+    schedule_work(&aw8695->vibrator_work);
+
+    return HRTIMER_NORESTART;
+}
+
+static void aw8695_vibrator_work_routine(struct work_struct *work)
+{
+    struct aw8695 *aw8695 = container_of(work, struct aw8695, vibrator_work);
+
+    pr_debug("%s enter\n", __func__);
+/*
+    mutex_lock(&aw8695->lock);
+
+    if(aw8695->state) {
+               pr_info("%s play seq ture\n", __func__);
+        aw8695_haptic_play_repeat_seq(aw8695, true);
+        //aw8695_haptic_play_mode(aw8695, AW8695_HAPTIC_RAM_MODE);
+        //aw8695_haptic_set_repeat_seq(aw8695, 1);
+        //aw8695_haptic_start(aw8695);
+    } else {
+               pr_info("%s haptic stop\n", __func__);
+*/
+    aw8695_haptic_stop(aw8695);
+    if(aw8695->state) {
+        aw8695_haptic_cont(aw8695);
+    }
+}
+
+static int aw8695_vibrator_init(struct aw8695 *aw8695)
+{
+    int ret = 0;
+
+    pr_info("%s enter\n", __func__);
+
+#ifdef TIMED_OUTPUT
+    aw8695->to_dev.name = "vibrator_aw8695";
+    aw8695->to_dev.get_time = aw8695_vibrator_get_time;
+    aw8695->to_dev.enable = aw8695_vibrator_enable;
+
+    ret = timed_output_dev_register(&(aw8695->to_dev));
+    if ( ret < 0){
+        dev_err(aw8695->dev, "%s: fail to create timed output dev\n",
+                __func__);
+        return ret;
+    }
+    ret = sysfs_create_group(&aw8695->to_dev.dev->kobj, &aw8695_vibrator_attribute_group);
+    if (ret < 0) {
+        dev_err(aw8695->dev, "%s error creating sysfs attr files\n", __func__);
+        return ret;
+    }
+#else
+    aw8695->cdev.name = "vibrator_aw8695";
+    aw8695->cdev.brightness_get = aw8695_haptic_brightness_get;
+    aw8695->cdev.brightness_set = aw8695_haptic_brightness_set;
+
+    ret = devm_led_classdev_register(&aw8695->i2c->dev, &aw8695->cdev);
+    if (ret < 0){
+        dev_err(aw8695->dev, "%s: fail to create led dev\n",
+                __func__);
+        return ret;
+    }
+    ret = sysfs_create_group(&aw8695->cdev.dev->kobj, &aw8695_vibrator_attribute_group);
+    if (ret < 0) {
+        dev_err(aw8695->dev, "%s error creating sysfs attr files\n", __func__);
+        return ret;
+     }
+#endif
+    hrtimer_init(&aw8695->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+    aw8695->timer.function = aw8695_vibrator_timer_func;
+    INIT_WORK(&aw8695->vibrator_work, aw8695_vibrator_work_routine);
+
+    INIT_WORK(&aw8695->rtp_work, aw8695_rtp_work_routine);
+
+    mutex_init(&aw8695->lock);
+
+    return 0;
+}
+
+
+
+
+/******************************************************
+ *
+ * irq
+ *
+ ******************************************************/
+static void aw8695_interrupt_clear(struct aw8695 *aw8695)
+{
+    unsigned char reg_val = 0;
+    pr_info("%s enter\n", __func__);
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+    pr_info("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+}
+
+static void aw8695_interrupt_setup(struct aw8695 *aw8695)
+{
+    unsigned char reg_val = 0;
+
+    pr_info("%s enter\n", __func__);
+
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+    pr_info("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+            AW8695_BIT_SYSINTM_BSTERR_MASK, AW8695_BIT_SYSINTM_BSTERR_OFF);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+            AW8695_BIT_SYSINTM_OV_MASK, AW8695_BIT_SYSINTM_OV_EN);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+            AW8695_BIT_SYSINTM_UVLO_MASK, AW8695_BIT_SYSINTM_UVLO_EN);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+            AW8695_BIT_SYSINTM_OCD_MASK, AW8695_BIT_SYSINTM_OCD_EN);
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSINTM,
+            AW8695_BIT_SYSINTM_OT_MASK, AW8695_BIT_SYSINTM_OT_EN);
+}
+
+static irqreturn_t aw8695_irq(int irq, void *data)
+{
+    struct aw8695 *aw8695 = data;
+    unsigned char reg_val = 0;
+    unsigned char dbg_val = 0;
+    unsigned int buf_len = 0;
+
+    pr_debug("%s enter\n", __func__);
+
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+    pr_info("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+    aw8695_i2c_read(aw8695, AW8695_REG_DBGSTAT, &dbg_val);
+    pr_info("%s: reg DBGSTAT=0x%x\n", __func__, dbg_val);
+
+    if(reg_val & AW8695_BIT_SYSINT_OVI) {
+        pr_err("%s chip ov int error\n", __func__);
+    }
+    if(reg_val & AW8695_BIT_SYSINT_UVLI) {
+        pr_err("%s chip uvlo int error\n", __func__);
+    }
+    if(reg_val & AW8695_BIT_SYSINT_OCDI) {
+        pr_err("%s chip over current int error\n", __func__);
+    }
+    if(reg_val & AW8695_BIT_SYSINT_OTI) {
+        pr_err("%s chip over temperature int error\n", __func__);
+    }
+    if(reg_val & AW8695_BIT_SYSINT_DONEI) {
+        pr_info("%s chip playback done\n", __func__);
+    }
+
+    if(reg_val & AW8695_BIT_SYSINT_FF_AEI) {
+        pr_debug("%s: aw8695 rtp fifo almost empty int\n", __func__);
+        if(aw8695->rtp_init) {
+            while((!aw8695_haptic_rtp_get_fifo_afi(aw8695)) &&
+                    (aw8695->play_mode == AW8695_HAPTIC_RTP_MODE)) {
+                pr_info("%s: aw8695 rtp mode fifo update, cnt=%d\n",
+                        __func__, aw8695->rtp_cnt);
+                if((aw8695_rtp->len-aw8695->rtp_cnt) < (aw8695->ram.base_addr>>2)) {
+                    buf_len = aw8695_rtp->len-aw8695->rtp_cnt;
+                } else {
+                    buf_len = (aw8695->ram.base_addr>>2);
+                }
+                aw8695_i2c_writes(aw8695, AW8695_REG_RTP_DATA,
+                        &aw8695_rtp->data[aw8695->rtp_cnt], buf_len);
+                aw8695->rtp_cnt += buf_len;
+                if(aw8695->rtp_cnt == aw8695_rtp->len) {
+                    pr_info("%s: rtp update complete\n", __func__);
+                    aw8695_haptic_set_rtp_aei(aw8695, false);
+                    aw8695->rtp_cnt = 0;
+                    aw8695->rtp_init = 0;
+                    break;
+                }
+            }
+        } else {
+            pr_err("%s: aw8695 rtp init = %d, init error\n", __func__, aw8695->rtp_init);
+        }
+    }
+
+    if(reg_val & AW8695_BIT_SYSINT_FF_AFI) {
+        pr_debug("%s: aw8695 rtp mode fifo full empty\n", __func__);
+    }
+
+    if(aw8695->play_mode != AW8695_HAPTIC_RTP_MODE) {
+        aw8695_haptic_set_rtp_aei(aw8695, false);
+    }
+
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSINT, &reg_val);
+    pr_debug("%s: reg SYSINT=0x%x\n", __func__, reg_val);
+    aw8695_i2c_read(aw8695, AW8695_REG_SYSST, &reg_val);
+    pr_debug("%s: reg SYSST=0x%x\n", __func__, reg_val);
+
+    pr_debug("%s exit\n", __func__);
+
+    return IRQ_HANDLED;
+}
+
+/*****************************************************
+ *
+ * device tree
+ *
+ *****************************************************/
+static int aw8695_parse_dt(struct device *dev, struct aw8695 *aw8695,
+        struct device_node *np) {
+    aw8695->reset_gpio = of_get_named_gpio(np, "reset-gpio", 0);
+    if (aw8695->reset_gpio < 0) {
+        dev_err(dev, "%s: no reset gpio provided, will not HW reset device\n", __func__);
+        return -1;
+    } else {
+        dev_info(dev, "%s: reset gpio provided ok\n", __func__);
+    }
+    aw8695->irq_gpio =  of_get_named_gpio(np, "irq-gpio", 0);
+    if (aw8695->irq_gpio < 0) {
+        dev_err(dev, "%s: no irq gpio provided.\n", __func__);
+    } else {
+        dev_info(dev, "%s: irq gpio provided ok.\n", __func__);
+    }
+
+    return 0;
+}
+
+static int aw8695_hw_reset(struct aw8695 *aw8695)
+{
+    pr_info("%s enter\n", __func__);
+
+    if (aw8695 && gpio_is_valid(aw8695->reset_gpio)) {
+        gpio_set_value_cansleep(aw8695->reset_gpio, 0);
+        msleep(1);
+        gpio_set_value_cansleep(aw8695->reset_gpio, 1);
+        msleep(1);
+    } else {
+        dev_err(aw8695->dev, "%s:  failed\n", __func__);
+    }
+    return 0;
+}
+
+
+/*****************************************************
+ *
+ * check chip id
+ *
+ *****************************************************/
+static int aw8695_read_chipid(struct aw8695 *aw8695)
+{
+    int ret = -1;
+    unsigned char cnt = 0;
+    unsigned char reg = 0;
+
+    while(cnt < AW_READ_CHIPID_RETRIES) {
+        /* hardware reset */
+        aw8695_hw_reset(aw8695);
+
+        ret = aw8695_i2c_read(aw8695, AW8695_REG_ID, &reg);
+        if (ret < 0) {
+            dev_err(aw8695->dev, "%s: failed to read register AW8695_REG_ID: %d\n", __func__, ret);
+        }
+        switch (reg) {
+        case 0x95:
+            pr_info("%s aw8695 detected\n", __func__);
+            aw8695->chipid = AW8695_ID;
+            //aw8695->flags |= AW8695_FLAG_SKIP_INTERRUPTS;
+            return 0;
+        default:
+            pr_info("%s unsupported device revision (0x%x)\n", __func__, reg );
+            break;
+        }
+        cnt ++;
+
+        msleep(AW_READ_CHIPID_RETRY_DELAY);
+    }
+
+    return -EINVAL;
+}
+
+/******************************************************
+ *
+ * sys group attribute: reg
+ *
+ ******************************************************/
+static ssize_t aw8695_i2c_reg_store(struct device *dev, struct device_attribute *attr,
+                const char *buf, size_t count)
+{
+    struct aw8695 *aw8695 = dev_get_drvdata(dev);
+
+    unsigned int databuf[2] = {0, 0};
+
+    if(2 == sscanf(buf, "%x %x", &databuf[0], &databuf[1])) {
+        aw8695_i2c_write(aw8695, (unsigned char)databuf[0], (unsigned char)databuf[1]);
+    }
+
+    return count;
+}
+
+static ssize_t aw8695_i2c_reg_show(struct device *dev, struct device_attribute *attr,
+                char *buf)
+{
+    struct aw8695 *aw8695 = dev_get_drvdata(dev);
+    ssize_t len = 0;
+    unsigned char i = 0;
+    unsigned char reg_val = 0;
+    for(i = 0; i < AW8695_REG_MAX; i ++) {
+        if(!(aw8695_reg_access[i]&REG_RD_ACCESS))
+           continue;
+        aw8695_i2c_read(aw8695, i, &reg_val);
+        len += snprintf(buf+len, PAGE_SIZE-len, "reg:0x%02x=0x%02x \n", i, reg_val);
+    }
+    return len;
+}
+static ssize_t aw8695_i2c_ram_store(struct device *dev, struct device_attribute *attr,
+                const char *buf, size_t count)
+{
+    struct aw8695 *aw8695 = dev_get_drvdata(dev);
+
+    unsigned int databuf[1] = {0};
+
+    if(1 == sscanf(buf, "%x", &databuf[0])) {
+        if(1 == databuf[0]) {
+            aw8695_ram_update(aw8695);
+        }
+    }
+
+    return count;
+}
+
+static ssize_t aw8695_i2c_ram_show(struct device *dev, struct device_attribute *attr,
+                char *buf)
+{
+    struct aw8695 *aw8695 = dev_get_drvdata(dev);
+    ssize_t len = 0;
+    unsigned int i = 0;
+    unsigned char reg_val = 0;
+
+    aw8695_haptic_stop(aw8695);
+    /* RAMINIT Enable */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+            AW8695_BIT_SYSCTRL_RAMINIT_MASK, AW8695_BIT_SYSCTRL_RAMINIT_EN);
+
+    aw8695_i2c_write(aw8695, AW8695_REG_RAMADDRH, (unsigned char)(aw8695->ram.base_addr>>8));
+    aw8695_i2c_write(aw8695, AW8695_REG_RAMADDRL, (unsigned char)(aw8695->ram.base_addr&0x00ff));
+    len += snprintf(buf+len, PAGE_SIZE-len, "aw8695_haptic_ram:\n");
+    for(i=0; i<aw8695->ram.len; i++) {
+        aw8695_i2c_read(aw8695, AW8695_REG_RAMDATA, &reg_val);
+        len += snprintf(buf+len, PAGE_SIZE-len, "0x%02x,", reg_val);
+    }
+    len += snprintf(buf+len, PAGE_SIZE-len, "\n");
+    /* RAMINIT Disable */
+    aw8695_i2c_write_bits(aw8695, AW8695_REG_SYSCTRL,
+            AW8695_BIT_SYSCTRL_RAMINIT_MASK, AW8695_BIT_SYSCTRL_RAMINIT_OFF);
+
+    return len;
+}
+
+static DEVICE_ATTR(reg, S_IWUSR | S_IRUGO, aw8695_i2c_reg_show, aw8695_i2c_reg_store);
+static DEVICE_ATTR(ram, S_IWUSR | S_IRUGO, aw8695_i2c_ram_show, aw8695_i2c_ram_store);
+
+static struct attribute *aw8695_attributes[] = {
+    &dev_attr_reg.attr,
+    &dev_attr_ram.attr,
+    NULL
+};
+
+static struct attribute_group aw8695_attribute_group = {
+    .attrs = aw8695_attributes
+};
+
+
+/******************************************************
+ *
+ * i2c driver
+ *
+ ******************************************************/
+static int aw8695_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id)
+{
+    struct aw8695 *aw8695;
+    struct device_node *np = i2c->dev.of_node;
+    int irq_flags = 0;
+    int ret = -1;
+
+    pr_info("%s enter\n", __func__);
+
+    if (!i2c_check_functionality(i2c->adapter, I2C_FUNC_I2C)) {
+        dev_err(&i2c->dev, "check_functionality failed\n");
+        return -EIO;
+    }
+
+    aw8695 = devm_kzalloc(&i2c->dev, sizeof(struct aw8695), GFP_KERNEL);
+    if (aw8695 == NULL)
+        return -ENOMEM;
+
+    aw8695->dev = &i2c->dev;
+    aw8695->i2c = i2c;
+
+    i2c_set_clientdata(i2c, aw8695);
+
+    /* aw8695 rst & int */
+    if (np) {
+        ret = aw8695_parse_dt(&i2c->dev, aw8695, np);
+        if (ret) {
+            dev_err(&i2c->dev, "%s: failed to parse device tree node\n", __func__);
+            goto err;
+        }
+    } else {
+        aw8695->reset_gpio = -1;
+        aw8695->irq_gpio = -1;
+    }
+
+    if (gpio_is_valid(aw8695->reset_gpio)) {
+        ret = devm_gpio_request_one(&i2c->dev, aw8695->reset_gpio,
+            GPIOF_OUT_INIT_LOW, "aw8695_rst");
+        if (ret){
+            dev_err(&i2c->dev, "%s: rst request failed\n", __func__);
+            goto err;
+        }
+    }
+
+    if (gpio_is_valid(aw8695->irq_gpio)) {
+        ret = devm_gpio_request_one(&i2c->dev, aw8695->irq_gpio,
+            GPIOF_DIR_IN, "aw8695_int");
+        if (ret){
+            dev_err(&i2c->dev, "%s: int request failed\n", __func__);
+            goto err;
+        }
+    }
+
+    /* aw8695 chip id */
+    ret = aw8695_read_chipid(aw8695);
+    if (ret < 0) {
+        dev_err(&i2c->dev, "%s: aw8695_read_chipid failed ret=%d\n", __func__, ret);
+        goto err_id;
+    }
+
+    /* aw8695 irq */
+    if (gpio_is_valid(aw8695->irq_gpio) &&
+        !(aw8695->flags & AW8695_FLAG_SKIP_INTERRUPTS)) {
+        /* register irq handler */
+        aw8695_interrupt_setup(aw8695);
+        irq_flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
+        ret = devm_request_threaded_irq(&i2c->dev,
+                    gpio_to_irq(aw8695->irq_gpio),
+                    NULL, aw8695_irq, irq_flags,
+                    "aw8695", aw8695);
+        if (ret != 0) {
+            dev_err(&i2c->dev, "%s: failed to request IRQ %d: %d\n",
+                    __func__, gpio_to_irq(aw8695->irq_gpio), ret);
+            goto err_irq;
+        }
+    } else {
+        dev_info(&i2c->dev, "%s skipping IRQ registration\n", __func__);
+        /* disable feature support if gpio was invalid */
+        aw8695->flags |= AW8695_FLAG_SKIP_INTERRUPTS;
+    }
+
+    dev_set_drvdata(&i2c->dev, aw8695);
+
+    ret = sysfs_create_group(&i2c->dev.kobj, &aw8695_attribute_group);
+    if (ret < 0) {
+        dev_info(&i2c->dev, "%s error creating sysfs attr files\n", __func__);
+        goto err_sysfs;
+    }
+
+    g_aw8695 = aw8695;
+
+    aw8695_haptic_softreset(aw8695);
+
+    aw8695_vibrator_init(aw8695);
+
+    aw8695_haptic_init(aw8695);
+
+    aw8695_ram_init(aw8695);
+
+    pr_info("%s probe completed successfully!\n", __func__);
+
+    return 0;
+
+err_sysfs:
+    sysfs_remove_group(&i2c->dev.kobj, &aw8695_attribute_group);
+err_irq:
+err_id:
+err:
+    return ret;
+}
+
+static int aw8695_i2c_remove(struct i2c_client *i2c)
+{
+    struct aw8695 *aw8695 = i2c_get_clientdata(i2c);
+
+    pr_info("%s enter\n", __func__);
+
+    sysfs_remove_group(&i2c->dev.kobj, &aw8695_attribute_group);
+
+    if (gpio_is_valid(aw8695->irq_gpio))
+        devm_gpio_free(&i2c->dev, aw8695->irq_gpio);
+    if (gpio_is_valid(aw8695->reset_gpio))
+        devm_gpio_free(&i2c->dev, aw8695->reset_gpio);
+
+    return 0;
+}
+
+static const struct i2c_device_id aw8695_i2c_id[] = {
+    { AW8695_I2C_NAME, 0 },
+    { }
+};
+MODULE_DEVICE_TABLE(i2c, aw8695_i2c_id);
+
+static struct of_device_id aw8695_dt_match[] = {
+    { .compatible = "awinic,aw8695_haptic" },
+    { },
+};
+
+static struct i2c_driver aw8695_i2c_driver = {
+    .driver = {
+        .name = AW8695_I2C_NAME,
+        .owner = THIS_MODULE,
+        .of_match_table = of_match_ptr(aw8695_dt_match),
+    },
+    .probe = aw8695_i2c_probe,
+    .remove = aw8695_i2c_remove,
+    .id_table = aw8695_i2c_id,
+};
+
+
+static int __init aw8695_i2c_init(void)
+{
+    int ret = 0;
+
+    pr_info("aw8695 driver version %s\n", AW8695_VERSION);
+
+    ret = i2c_add_driver(&aw8695_i2c_driver);
+    if(ret){
+        pr_err("fail to add aw8695 device into i2c\n");
+        return ret;
+    }
+
+    return 0;
+}
+//late_initcall(aw8695_i2c_init);
+module_init(aw8695_i2c_init);
+
+
+static void __exit aw8695_i2c_exit(void)
+{
+    i2c_del_driver(&aw8695_i2c_driver);
+}
+module_exit(aw8695_i2c_exit);
+
+
+MODULE_DESCRIPTION("AW8695 Haptic Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/misc/aw8695_haptic/aw8695.h b/drivers/misc/aw8695_haptic/aw8695.h
new file mode 100644 (file)
index 0000000..5fa5744
--- /dev/null
@@ -0,0 +1,214 @@
+#ifndef _AW8695_H_
+#define _AW8695_H_
+
+/*********************************************************
+ *
+ * kernel version
+ *
+ ********************************************************/
+#if LINUX_VERSION_CODE <= KERNEL_VERSION(4, 4, 1)
+#define TIMED_OUTPUT
+#endif
+
+/*********************************************************
+ *
+ * aw8695.h
+ *
+ ********************************************************/
+#include <linux/regmap.h>
+#include <linux/timer.h>
+#include <linux/workqueue.h>
+#include <linux/hrtimer.h>
+#include <linux/mutex.h>
+#include <linux/cdev.h>
+#ifdef TIMED_OUTPUT
+#include <../../../drivers/staging/android/timed_output.h>
+#else
+#include <linux/leds.h>
+#endif
+
+/*********************************************************
+ *
+ * marco
+ *
+ ********************************************************/
+#define MAX_I2C_BUFFER_SIZE 65536
+
+#define AW8695_REG_MAX                      0xff
+
+#define AW8695_SEQUENCER_SIZE               8
+#define AW8695_SEQUENCER_LOOP_SIZE          4
+
+#define AW8695_RTP_I2C_SINGLE_MAX_NUM       512
+
+#define HAPTIC_MAX_TIMEOUT                  10000
+
+#define AW8695_HAPTIC_F0_PRE                2350
+#define AW8695_HAPTIC_F0_DRV_LVL            80
+#define AW8695_HAPTIC_F0_COEFF              260    //2.604167
+
+enum aw8695_flags {
+    AW8695_FLAG_NONR = 0,
+    AW8695_FLAG_SKIP_INTERRUPTS = 1,
+};
+
+enum aw8695_chipids {
+    AW8690_ID = 0,
+    AW8691_ID = 1,
+    AW8694_ID = 4,
+    AW8695_ID = 5,
+    AW8696_ID = 6,
+    AW8697_ID = 7,
+};
+
+enum aw8695_haptic_read_write {
+    AW8695_HAPTIC_CMD_READ_REG = 0,
+    AW8695_HAPTIC_CMD_WRITE_REG = 1,
+};
+
+
+enum aw8695_haptic_work_mode {
+    AW8695_HAPTIC_STANDBY_MODE = 0,
+    AW8695_HAPTIC_RAM_MODE = 1,
+    AW8695_HAPTIC_RTP_MODE = 2,
+    AW8695_HAPTIC_TRIG_MODE = 3,
+    AW8695_HAPTIC_CONT_MODE = 4,
+};
+
+enum aw8695_haptic_bst_mode {
+    AW8695_HAPTIC_BYPASS_MODE = 0,
+    AW8695_HAPTIC_BOOST_MODE = 1,
+};
+
+enum aw8695_haptic_pwm_mode {
+    AW8695_PWM_48K = 0,
+    AW8695_PWM_24K = 1,
+    AW8695_PWM_12K = 2,
+};
+
+/*********************************************************
+ *
+ * struct
+ *
+ ********************************************************/
+struct fileops {
+    unsigned char cmd;
+    unsigned char reg;
+    unsigned char ram_addrh;
+    unsigned char ram_addrl;
+};
+
+struct ram {
+    unsigned int len;
+    unsigned int check_sum;
+    unsigned int base_addr;
+    unsigned char version;
+    unsigned char ram_shift;
+    unsigned char baseaddr_shift;
+};
+
+struct haptic_ctr{
+    unsigned char cmd;
+    unsigned char play;
+    unsigned char wavseq;
+    unsigned char loop;
+    unsigned char gain;
+};
+
+struct haptic_audio{
+    struct mutex lock;
+    struct hrtimer timer;
+    struct work_struct work;
+    int delay_val;
+    int timer_val;
+    unsigned char cnt;
+    struct haptic_ctr data[256];
+    struct haptic_ctr ctr;
+};
+
+struct aw8695 {
+    struct regmap *regmap;
+    struct i2c_client *i2c;
+    struct device *dev;
+    struct input_dev *input;
+
+    struct mutex lock;
+    struct hrtimer timer;
+    struct work_struct vibrator_work;
+    struct work_struct rtp_work;
+    struct delayed_work ram_work;
+#ifdef TIMED_OUTPUT
+    struct timed_output_dev to_dev;
+#else
+    struct led_classdev cdev;
+#endif
+    struct fileops fileops;
+    struct ram ram;
+
+    int reset_gpio;
+    int irq_gpio;
+
+    unsigned char hwen_flag;
+    unsigned char flags;
+    unsigned char chipid;
+
+    unsigned char play_mode;
+
+    int state;
+    int duration;
+    int amplitude;
+    int index;
+    int vmax;
+    int gain;
+
+    unsigned char seq[AW8695_SEQUENCER_SIZE];
+    unsigned char loop[AW8695_SEQUENCER_SIZE];
+
+    unsigned int rtp_cnt;
+    unsigned int rtp_file_num;
+
+    unsigned char rtp_init;
+    unsigned char ram_init;
+
+    unsigned int f0;
+    unsigned int f0_pre;
+    unsigned char f0_drv_lvl;
+    unsigned char max_pos_beme;
+    unsigned char max_neg_beme;
+
+    struct haptic_audio haptic_audio;
+};
+
+struct aw8695_container{
+    int len;
+    unsigned char data[];
+};
+
+
+/*********************************************************
+ *
+ * ioctl
+ *
+ ********************************************************/
+struct aw8695_seq_loop {
+    unsigned char loop[AW8695_SEQUENCER_SIZE];
+};
+
+struct aw8695_que_seq {
+    unsigned char index[AW8695_SEQUENCER_SIZE];
+};
+
+
+#define AW8695_HAPTIC_IOCTL_MAGIC         'h'
+
+#define AW8695_HAPTIC_SET_QUE_SEQ         _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 1, struct aw8695_que_seq*)
+#define AW8695_HAPTIC_SET_SEQ_LOOP        _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 2, struct aw8695_seq_loop*)
+#define AW8695_HAPTIC_PLAY_QUE_SEQ        _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 3, unsigned int)
+#define AW8695_HAPTIC_SET_BST_VOL         _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 4, unsigned int)
+#define AW8695_HAPTIC_SET_BST_PEAK_CUR    _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 5, unsigned int)
+#define AW8695_HAPTIC_SET_GAIN            _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 6, unsigned int)
+#define AW8695_HAPTIC_PLAY_REPEAT_SEQ     _IOWR(AW8695_HAPTIC_IOCTL_MAGIC, 7, unsigned int)
+
+
+#endif
+
diff --git a/drivers/misc/aw8695_haptic/aw8695_reg.h b/drivers/misc/aw8695_haptic/aw8695_reg.h
new file mode 100644 (file)
index 0000000..af8be9c
--- /dev/null
@@ -0,0 +1,481 @@
+#ifndef _AW8695_REG_H_
+#define _AW8695_REG_H_
+
+/********************************************
+ * Register List
+ *******************************************/
+#define AW8695_REG_ID            0x00
+#define AW8695_REG_SYSST         0x01
+#define AW8695_REG_SYSINT        0x02
+#define AW8695_REG_SYSINTM       0x03
+#define AW8695_REG_SYSCTRL       0x04
+#define AW8695_REG_GO            0x05
+#define AW8695_REG_RTP_DATA      0x06
+#define AW8695_REG_WAVSEQ1       0x07
+#define AW8695_REG_WAVSEQ2       0x08
+#define AW8695_REG_WAVSEQ3       0x09
+#define AW8695_REG_WAVSEQ4       0x0a
+#define AW8695_REG_WAVSEQ5       0x0b
+#define AW8695_REG_WAVSEQ6       0x0c
+#define AW8695_REG_WAVSEQ7       0x0d
+#define AW8695_REG_WAVSEQ8       0x0e
+#define AW8695_REG_WAVLOOP1      0x0f
+#define AW8695_REG_WAVLOOP2      0x10
+#define AW8695_REG_WAVLOOP3      0x11
+#define AW8695_REG_WAVLOOP4      0x12
+#define AW8695_REG_MAIN_LOOP     0x13
+#define AW8695_REG_TRG1_WAV_P    0x14
+#define AW8695_REG_TRG2_WAV_P    0x15
+#define AW8695_REG_TRG3_WAV_P    0x16
+#define AW8695_REG_TRG1_WAV_N    0x17
+#define AW8695_REG_TRG2_WAV_N    0x18
+#define AW8695_REG_TRG3_WAV_N    0x19
+#define AW8695_REG_TRG_PRIO      0x1a
+#define AW8695_REG_TRG_CFG1      0x1b
+#define AW8695_REG_TRG_CFG2      0x1c
+#define AW8695_REG_DBGCTRL       0x20
+#define AW8695_REG_BASE_ADDRH    0x21
+#define AW8695_REG_BASE_ADDRL    0x22
+#define AW8695_REG_FIFO_AEH      0x23
+#define AW8695_REG_FIFO_AEL      0x24
+#define AW8695_REG_FIFO_AFH      0x25
+#define AW8695_REG_FIFO_AFL      0x26
+#define AW8695_REG_WAKE_DLY      0x27
+#define AW8695_REG_START_DLY     0x28
+#define AW8695_REG_END_DLY_H     0x29
+#define AW8695_REG_END_DLY_L     0x2a
+#define AW8695_REG_DATCTRL       0x2b
+#define AW8695_REG_PWMDEL        0x2c
+#define AW8695_REG_PWMPRE        0x2d
+#define AW8695_REG_PWMDBG        0x2e
+#define AW8695_REG_LDOCTRL       0x2f
+#define AW8695_REG_DBGSTAT       0x30
+#define AW8695_REG_BSTDBG1       0x31
+#define AW8695_REG_BSTDBG2       0x32
+#define AW8695_REG_BSTDBG3       0x33
+#define AW8695_REG_BSTCFG        0x34
+#define AW8695_REG_ANADBG        0x35
+#define AW8695_REG_ANACTRL       0x36
+#define AW8695_REG_CPDBG         0x37
+#define AW8695_REG_GLBDBG        0x38
+#define AW8695_REG_DATDBG        0x39
+#define AW8695_REG_BSTDBG4       0x3a
+#define AW8695_REG_BSTDBG5       0x3b
+#define AW8695_REG_BSTDBG6       0x3c
+#define AW8695_REG_HDRVDBG       0x3d
+#define AW8695_REG_PRLVL         0x3e
+#define AW8695_REG_PRTIME        0x3f
+#define AW8695_REG_RAMADDRH      0x40
+#define AW8695_REG_RAMADDRL      0x41
+#define AW8695_REG_RAMDATA       0x42
+#define AW8695_REG_GLB_STATE     0x46
+#define AW8695_REG_BAT_AUTO      0x47
+#define AW8695_REG_CONT_CTRL     0x48
+#define AW8695_REG_F_PRE_H       0x49
+#define AW8695_REG_F_PRE_L       0x4a
+#define AW8695_REG_TD_H          0x4b
+#define AW8695_REG_TD_L          0x4c
+#define AW8695_REG_TSET          0x4d
+#define AW8695_REG_TRIM_LRA      0x5b
+#define AW8695_REG_R_SPARE       0x5d
+#define AW8695_REG_D2SCFG        0x5e
+#define AW8695_REG_DETCTRL       0x5f
+#define AW8695_REG_RLDET         0x60
+#define AW8695_REG_OSDET         0x61
+#define AW8695_REG_VBATDET       0x62
+#define AW8695_REG_TESTDET       0x63
+#define AW8695_REG_DETLO         0x64
+#define AW8695_REG_BEMFDBG       0x65
+#define AW8695_REG_ADCTEST       0x66
+#define AW8695_REG_BEMFTEST      0x67
+#define AW8695_REG_F_LRA_F0_H    0x68
+#define AW8695_REG_F_LRA_F0_L    0x69
+#define AW8695_REG_F_LRA_CONT_H  0x6a
+#define AW8695_REG_F_LRA_CONT_L  0x6b
+#define AW8695_REG_WAIT_VOL_MP   0x6d
+#define AW8695_REG_WAIT_VOL_MN   0x6f
+#define AW8695_REG_BEMF_VOL_H    0x70
+#define AW8695_REG_BEMF_VOL_L    0x71
+#define AW8695_REG_ZC_THRSH_H    0x72
+#define AW8695_REG_ZC_THRSH_L    0x73
+#define AW8695_REG_BEMF_VTHH_H   0x74
+#define AW8695_REG_BEMF_VTHH_L   0x75
+#define AW8695_REG_BEMF_VTHL_H   0x76
+#define AW8695_REG_BEMF_VTHL_L   0x77
+#define AW8695_REG_BEMF_NUM      0x78
+#define AW8695_REG_DRV_TIME      0x79
+#define AW8695_REG_TIME_NZC      0x7a
+#define AW8695_REG_DRV_LVL       0x7b
+#define AW8695_REG_DRV_LVL_OV    0x7c
+#define AW8695_REG_NUM_F0_1      0x7d
+#define AW8695_REG_NUM_F0_2      0x7e
+#define AW8695_REG_NUM_F0_3      0x7f
+
+
+
+
+/********************************************
+ * Register Access
+ *******************************************/
+#define REG_NONE_ACCESS 0
+#define REG_RD_ACCESS  1 << 0
+#define REG_WR_ACCESS  1 << 1
+
+const unsigned char aw8695_reg_access[AW8695_REG_MAX]={
+ [AW8695_REG_ID          ] = REG_RD_ACCESS,
+ [AW8695_REG_SYSST       ] = REG_RD_ACCESS,
+ [AW8695_REG_SYSINT      ] = REG_RD_ACCESS,
+ [AW8695_REG_SYSINTM     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_SYSCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_GO          ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_RTP_DATA    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ1     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ2     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ3     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ4     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ5     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ6     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ7     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVSEQ8     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVLOOP1    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVLOOP2    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVLOOP3    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAVLOOP4    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_MAIN_LOOP   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG1_WAV_P  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG2_WAV_P  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG3_WAV_P  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG1_WAV_N  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG2_WAV_N  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG3_WAV_N  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG_PRIO    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG_CFG1    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRG_CFG2    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DBGCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BASE_ADDRH  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BASE_ADDRL  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_FIFO_AEH    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_FIFO_AEL    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_FIFO_AFH    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_FIFO_AFL    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAKE_DLY    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_START_DLY   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_END_DLY_H   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_END_DLY_L   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DATCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_PWMDEL      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_PWMPRE      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_PWMDBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_LDOCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DBGSTAT     ] = REG_RD_ACCESS,
+ [AW8695_REG_BSTDBG1     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BSTDBG2     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BSTDBG3     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BSTCFG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_ANADBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_ANACTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_CPDBG       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_GLBDBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DATDBG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BSTDBG4     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BSTDBG5     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BSTDBG6     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_HDRVDBG     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_PRLVL       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_PRTIME      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_RAMADDRH    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_RAMADDRL    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_RAMDATA     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_GLB_STATE   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BAT_AUTO    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_CONT_CTRL   ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_F_PRE_H     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_F_PRE_L     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TD_H        ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TD_L        ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TSET        ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TRIM_LRA    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_R_SPARE     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_D2SCFG      ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DETCTRL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_RLDET       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_OSDET       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_VBATDET     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TESTDET     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DETLO       ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMFDBG     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_ADCTEST     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMFTEST    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_F_LRA_F0_H  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_F_LRA_F0_L  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_F_LRA_CONT_H] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_F_LRA_CONT_L] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAIT_VOL_MP ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_WAIT_VOL_MN ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_VOL_H  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_VOL_L  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_ZC_THRSH_H  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_ZC_THRSH_L  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_VTHH_H ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_VTHH_L ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_VTHL_H ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_VTHL_L ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_BEMF_NUM    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DRV_TIME    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_TIME_NZC    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DRV_LVL     ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_DRV_LVL_OV  ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_NUM_F0_1    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_NUM_F0_2    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+ [AW8695_REG_NUM_F0_3    ] = REG_RD_ACCESS|REG_WR_ACCESS,
+};
+
+
+/******************************************************
+ * Register Detail
+ *****************************************************/
+// SYSST
+#define AW8695_BIT_SYSST_BSTERRS                 (1<<7)
+#define AW8695_BIT_SYSST_OVS                     (1<<6)
+#define AW8695_BIT_SYSST_UVLS                    (1<<5)
+#define AW8695_BIT_SYSST_FF_AES                  (1<<4)
+#define AW8695_BIT_SYSST_FF_AFS                  (1<<3)
+#define AW8695_BIT_SYSST_OCDS                    (1<<2)
+#define AW8695_BIT_SYSST_OTS                     (1<<1)
+#define AW8695_BIT_SYSST_DONES                   (1<<0)
+
+// SYSINT
+#define AW8695_BIT_SYSINT_BSTERRI                (1<<7)
+#define AW8695_BIT_SYSINT_OVI                    (1<<6)
+#define AW8695_BIT_SYSINT_UVLI                   (1<<5)
+#define AW8695_BIT_SYSINT_FF_AEI                 (1<<4)
+#define AW8695_BIT_SYSINT_FF_AFI                 (1<<3)
+#define AW8695_BIT_SYSINT_OCDI                   (1<<2)
+#define AW8695_BIT_SYSINT_OTI                    (1<<1)
+#define AW8695_BIT_SYSINT_DONEI                  (1<<0)
+
+// SYSINTM
+#define AW8695_BIT_SYSINTM_BSTERR_MASK           (~(1<<7))
+#define AW8695_BIT_SYSINTM_BSTERR_OFF            (1<<7)
+#define AW8695_BIT_SYSINTM_BSTERR_EN             (0<<7)
+#define AW8695_BIT_SYSINTM_OV_MASK               (~(1<<6))
+#define AW8695_BIT_SYSINTM_OV_OFF                (1<<6)
+#define AW8695_BIT_SYSINTM_OV_EN                 (0<<6)
+#define AW8695_BIT_SYSINTM_UVLO_MASK             (~(1<<5))
+#define AW8695_BIT_SYSINTM_UVLO_OFF              (1<<5)
+#define AW8695_BIT_SYSINTM_UVLO_EN               (0<<5)
+#define AW8695_BIT_SYSINTM_FF_AE_MASK            (~(1<<4))
+#define AW8695_BIT_SYSINTM_FF_AE_OFF             (1<<4)
+#define AW8695_BIT_SYSINTM_FF_AE_EN              (0<<4)
+#define AW8695_BIT_SYSINTM_FF_AF_MASK            (~(1<<3))
+#define AW8695_BIT_SYSINTM_FF_AF_OFF             (1<<3)
+#define AW8695_BIT_SYSINTM_FF_AF_EN              (0<<3)
+#define AW8695_BIT_SYSINTM_OCD_MASK              (~(1<<2))
+#define AW8695_BIT_SYSINTM_OCD_OFF               (1<<2)
+#define AW8695_BIT_SYSINTM_OCD_EN                (0<<2)
+#define AW8695_BIT_SYSINTM_OT_MASK               (~(1<<1))
+#define AW8695_BIT_SYSINTM_OT_OFF                (1<<1)
+#define AW8695_BIT_SYSINTM_OT_EN                 (0<<1)
+#define AW8695_BIT_SYSINTM_DONE_MASK             (~(1<<0))
+#define AW8695_BIT_SYSINTM_DONE_OFF              (1<<0)
+#define AW8695_BIT_SYSINTM_DONE_EN               (0<<0)
+
+// SYSCTRL
+#define AW8695_BIT_SYSCTRL_WAVDAT_MODE_MASK      (~(3<<6))
+#define AW8695_BIT_SYSCTRL_WAVDAT_MODE_4X        (3<<6)
+#define AW8695_BIT_SYSCTRL_WAVDAT_MODE_2X        (0<<6)
+#define AW8695_BIT_SYSCTRL_WAVDAT_MODE_1X        (1<<6)
+#define AW8695_BIT_SYSCTRL_RAMINIT_MASK          (~(1<<5))
+#define AW8695_BIT_SYSCTRL_RAMINIT_EN            (1<<5)
+#define AW8695_BIT_SYSCTRL_RAMINIT_OFF           (0<<5)
+#define AW8695_BIT_SYSCTRL_PLAY_MODE_MASK        (~(3<<2))
+#define AW8695_BIT_SYSCTRL_PLAY_MODE_CONT        (2<<2)
+#define AW8695_BIT_SYSCTRL_PLAY_MODE_RTP         (1<<2)
+#define AW8695_BIT_SYSCTRL_PLAY_MODE_RAM         (0<<2)
+#define AW8695_BIT_SYSCTRL_BST_MODE_MASK         (~(1<<1))
+#define AW8695_BIT_SYSCTRL_BST_MODE_BOOST        (1<<1)
+#define AW8695_BIT_SYSCTRL_BST_MODE_BYPASS       (0<<1)
+#define AW8695_BIT_SYSCTRL_WORK_MODE_MASK        (~(1<<0))
+#define AW8695_BIT_SYSCTRL_STANDBY               (1<<0)
+#define AW8695_BIT_SYSCTRL_ACTIVE                (0<<0)
+
+// GO
+#define AW8695_BIT_GO_MASK                       (~(1<<0))
+#define AW8695_BIT_GO_ENABLE                     (1<<0)
+#define AW8695_BIT_GO_DISABLE                    (0<<0)
+
+// WAVSEQ1
+#define AW8695_BIT_WAVSEQ1_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ1_WAV_FRM_SEQ1_MASK     (~(127<<0))
+
+// WAVSEQ2
+#define AW8695_BIT_WAVSEQ2_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ2_WAV_FRM_SEQ2_MASK     (~(127<<0))
+
+// WAVSEQ3
+#define AW8695_BIT_WAVSEQ3_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ3_WAV_FRM_SEQ3_MASK     (~(127<<0))
+
+// WAVSEQ4
+#define AW8695_BIT_WAVSEQ4_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ4_WAV_FRM_SEQ4_MASK     (~(127<<0))
+
+// WAVSEQ5
+#define AW8695_BIT_WAVSEQ5_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ5_WAV_FRM_SEQ5_MASK     (~(127<<0))
+
+// WAVSEQ6
+#define AW8695_BIT_WAVSEQ6_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ6_WAV_FRM_SEQ6_MASK     (~(127<<0))
+
+// WAVSEQ7
+#define AW8695_BIT_WAVSEQ7_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ7_WAV_FRM_SEQ7_MASK     (~(127<<0))
+
+// WAVSEQ8
+#define AW8695_BIT_WAVSEQ8_WAIT                  (1<<7)
+#define AW8695_BIT_WAVSEQ8_WAV_FRM_SEQ8_MASK     (~(127<<0))
+
+// WAVLOOP
+#define AW8695_BIT_WAVLOOP_SEQN_MASK            (~(15<<4))
+#define AW8695_BIT_WAVLOOP_SEQNP1_MASK          (~(15<<0))
+#define AW8695_BIT_WAVLOOP_INIFINITELY          (15<<0)
+
+// WAVLOOP1
+#define AW8695_BIT_WAVLOOP1_SEQ1_MASK            (~(15<<4))
+#define AW8695_BIT_WAVLOOP1_SEQ2_MASK            (~(15<<0))
+
+// WAVLOOP2
+#define AW8695_BIT_WAVLOOP2_SEQ3_MASK            (~(15<<4))
+#define AW8695_BIT_WAVLOOP2_SEQ4_MASK            (~(15<<0))
+
+// WAVLOOP3
+#define AW8695_BIT_WAVLOOP3_SEQ5_MASK            (~(15<<4))
+#define AW8695_BIT_WAVLOOP3_SEQ6_MASK            (~(15<<0))
+
+// WAVLOOP4
+#define AW8695_BIT_WAVLOOP4_SEQ7_MASK            (~(15<<4))
+#define AW8695_BIT_WAVLOOP4_SEQ8_MASK            (~(15<<0))
+
+
+// PLAYPRIO
+#define AW8695_BIT_PLAYPRIO_GO_MASK              (~(3<<6))
+#define AW8695_BIT_PLAYPRIO_TRIG3_MASK           (~(3<<4))
+#define AW8695_BIT_PLAYPRIO_TRIG2_MASK           (~(3<<2))
+#define AW8695_BIT_PLAYPRIO_TRIG1_MASK           (~(3<<0))
+
+// TRGCFG1
+#define AW8695_BIT_TRGCFG1_TRG3_POLAR_MASK       (~(1<<5))
+#define AW8695_BIT_TRGCFG1_TRG3_POLAR_NEG        (1<<5)
+#define AW8695_BIT_TRGCFG1_TRG3_POLAR_POS        (0<<5)
+#define AW8695_BIT_TRGCFG1_TRG3_EDGE_MASK        (~(1<<4))
+#define AW8695_BIT_TRGCFG1_TRG3_EDGE_POS         (1<<4)
+#define AW8695_BIT_TRGCFG1_TRG3_EDGE_POS_NEG     (0<<4)
+#define AW8695_BIT_TRGCFG1_TRG2_POLAR_MASK       (~(1<<3))
+#define AW8695_BIT_TRGCFG1_TRG2_POLAR_NEG        (1<<3)
+#define AW8695_BIT_TRGCFG1_TRG2_POLAR_POS        (0<<3)
+#define AW8695_BIT_TRGCFG1_TRG2_EDGE_MASK        (~(1<<2))
+#define AW8695_BIT_TRGCFG1_TRG2_EDGE_POS         (1<<2)
+#define AW8695_BIT_TRGCFG1_TRG2_EDGE_POS_NEG     (0<<2)
+#define AW8695_BIT_TRGCFG1_TRG1_POLAR_MASK       (~(1<<1))
+#define AW8695_BIT_TRGCFG1_TRG1_POLAR_NEG        (1<<1)
+#define AW8695_BIT_TRGCFG1_TRG1_POLAR_POS        (0<<1)
+#define AW8695_BIT_TRGCFG1_TRG1_EDGE_MASK        (~(1<<0))
+#define AW8695_BIT_TRGCFG1_TRG1_EDGE_POS         (1<<0)
+#define AW8695_BIT_TRGCFG1_TRG1_EDGE_POS_NEG     (0<<0)
+
+// TRGCFG2
+#define AW8695_BIT_TRGCFG2_TRG3_ENABLE_MASK      (~(1<<2))
+#define AW8695_BIT_TRGCFG2_TRG3_ENABLE           (1<<2)
+#define AW8695_BIT_TRGCFG2_TRG3_DISABLE          (0<<2)
+#define AW8695_BIT_TRGCFG2_TRG2_ENABLE_MASK      (~(1<<1))
+#define AW8695_BIT_TRGCFG2_TRG2_ENABLE           (1<<1)
+#define AW8695_BIT_TRGCFG2_TRG2_DISABLE          (0<<1)
+#define AW8695_BIT_TRGCFG2_TRG1_ENABLE_MASK      (~(1<<0))
+#define AW8695_BIT_TRGCFG2_TRG1_ENABLE           (1<<0)
+#define AW8695_BIT_TRGCFG2_TRG1_DISABLE          (0<<0)
+
+// DATCTRL
+#define AW8695_BIT_DATCTRL_FC_MASK              (~(1<<6))
+#define AW8695_BIT_DATCTRL_FC_1000HZ            (3<<6)
+#define AW8695_BIT_DATCTRL_FC_800HZ             (3<<6)
+#define AW8695_BIT_DATCTRL_FC_600HZ             (1<<6)
+#define AW8695_BIT_DATCTRL_FC_400HZ             (0<<6)
+#define AW8695_BIT_DATCTRL_LPF_ENABLE_MASK      (~(1<<5))
+#define AW8695_BIT_DATCTRL_LPF_ENABLE           (1<<5)
+#define AW8695_BIT_DATCTRL_LPF_DISABLE          (0<<5)
+
+
+// PWMDBG
+#define AW8695_BIT_PWMDBG_PWM_MODE_MASK          (~(3<<5))
+#define AW8695_BIT_PWMDBG_PWM_12K                (3<<5)
+#define AW8695_BIT_PWMDBG_PWM_24K                (2<<5)
+#define AW8695_BIT_PWMDBG_PWM_48K                (0<<5)
+
+
+// CONT_CTRL
+#define AW8695_BIT_CONT_CTRL_ZC_DETEC_MASK       (~(1<<7))
+#define AW8695_BIT_CONT_CTRL_ZC_DETEC_ENABLE     (1<<7)
+#define AW8695_BIT_CONT_CTRL_ZC_DETEC_DISABLE    (0<<7)
+#define AW8695_BIT_CONT_CTRL_WAIT_PERIOD_MASK    (~(3<<5))
+#define AW8695_BIT_CONT_CTRL_WAIT_8PERIOD        (3<<5)
+#define AW8695_BIT_CONT_CTRL_WAIT_4PERIOD        (2<<5)
+#define AW8695_BIT_CONT_CTRL_WAIT_2PERIOD        (1<<5)
+#define AW8695_BIT_CONT_CTRL_WAIT_1PERIOD        (0<<5)
+#define AW8695_BIT_CONT_CTRL_MODE_MASK           (~(1<<4))
+#define AW8695_BIT_CONT_CTRL_BY_DRV_TIME         (1<<4)
+#define AW8695_BIT_CONT_CTRL_BY_GO_SIGNAL        (0<<4)
+#define AW8695_BIT_CONT_CTRL_EN_CLOSE_MASK       (~(1<<3))
+#define AW8695_BIT_CONT_CTRL_CLOSE_PLAYBACK      (1<<3)
+#define AW8695_BIT_CONT_CTRL_OPEN_PLAYBACK       (0<<3)
+#define AW8695_BIT_CONT_CTRL_F0_DETECT_MASK      (~(1<<2))
+#define AW8695_BIT_CONT_CTRL_F0_DETECT_ENABLE    (1<<2)
+#define AW8695_BIT_CONT_CTRL_F0_DETECT_DISABLE   (0<<2)
+#define AW8695_BIT_CONT_CTRL_O2C_MASK            (~(1<<1))
+#define AW8695_BIT_CONT_CTRL_O2C_ENABLE          (1<<1)
+#define AW8695_BIT_CONT_CTRL_O2C_DISABLE         (0<<1)
+#define AW8695_BIT_CONT_CTRL_AUTO_BRK_MASK       (~(1<<0))
+#define AW8695_BIT_CONT_CTRL_AUTO_BRK_ENABLE     (1<<0)
+#define AW8695_BIT_CONT_CTRL_AUTO_BRK_DISABLE    (0<<0)
+
+
+// DETCTRL
+#define AW8695_BIT_DETCTRL_RL_OS_MASK            (~(1<<6))
+#define AW8695_BIT_DETCTRL_RL_DETECT             (1<<6)
+#define AW8695_BIT_DETCTRL_OS_DETECT             (0<<6)
+#define AW8695_BIT_DETCTRL_PROTECT_MASK          (~(1<<5))
+#define AW8695_BIT_DETCTRL_PROTECT_NO_ACTION     (1<<5)
+#define AW8695_BIT_DETCTRL_PROTECT_SHUTDOWN      (0<<5)
+#define AW8695_BIT_DETCTRL_VBAT_GO_MASK          (~(1<<1))
+#define AW8695_BIT_DETCTRL_VABT_GO_ENABLE        (1<<1)
+#define AW8695_BIT_DETCTRL_VBAT_GO_DISBALE       (0<<1)
+#define AW8695_BIT_DETCTRL_DIAG_GO_MASK          (~(1<<0))
+#define AW8695_BIT_DETCTRL_DIAG_GO_ENABLE        (1<<0)
+#define AW8695_BIT_DETCTRL_DIAG_GO_DISABLE       (0<<0)
+
+
+// VBAT MODE
+#define AW8695_BIT_DETCTRL_VBAT_MODE_MASK        (~(1<<6))
+#define AW8695_BIT_DETCTRL_VBAT_HW_COMP          (1<<6)
+#define AW8695_BIT_DETCTRL_VBAT_SW_COMP          (0<<6)
+
+// BSTCFG
+#define AW8695_BIT_BSTCFG_PEAKCUR_MASK          (~(7<<0))
+#define AW8695_BIT_BSTCFG_PEAKCUR_4A            (7<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_3P75A         (6<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_3P5A          (5<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_3P25A         (4<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_3A            (3<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_2P5A          (2<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_2A            (1<<0)
+#define AW8695_BIT_BSTCFG_PEAKCUR_1P5A          (0<<0)
+
+// BSTDBG4
+#define AW8695_BIT_BSTCFG_BSTVOL_MASK           (~(31<<3))
+
+// ANACTRL
+#define AW8695_BIT_ANACTRL_LRA_SRC_MASK         (~(1<<5))
+#define AW8695_BIT_ANACTRL_LRA_SRC_REG          (1<<5)
+#define AW8695_BIT_ANACTRL_LRA_SRC_EFUSE        (0<<5)
+
+#endif