Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20;
From:   Luca Weiss <luca.weiss@fairphone.com>
To:     linux-input@vger.kernel.org
Cc:     ~postmarketos/upstreaming@lists.sr.ht, phone-devel@vger.kernel.org,
        Luca Weiss <luca.weiss@fairphone.com>,
        Dmitry Torokhov <dmitry.torokhov@gmail.com>,
        Linus Walleij <linus.walleij@linaro.org>,
        Lukas Bulwahn <lukas.bulwahn@gmail.com>,
        Arnd Bergmann <arnd@arndb.de>, linux-kernel@vger.kernel.org
Subject: [PATCH 2/3] Input - aw8695: Add driver for AW8695 haptics
Date:   Fri,  8 Apr 2022 13:53:09 +0200
Message-Id: <20220408115311.237039-2-luca.weiss@fairphone.com>
In-Reply-To: <20220408115311.237039-1-luca.weiss@fairphone.com>
References: <20220408115311.237039-1-luca.weiss@fairphone.com>
MIME-Version: 1.0
Content-Transfer-Encoding: 8bit
Precedence: bulk

Add a driver for interfacing with the Awinic AW8695 LRA Haptic Driver.

The chip supports multiple modes of which only RAM mode is implemented.
RTP mode would enable a user to "stream" waveform data but to my
knowledge no such user space API exists in the kernel yet.

We upload a basic sine wave to the chip and play this on request.

Signed-off-by: Luca Weiss <luca.weiss@fairphone.com>
---
 drivers/input/misc/Kconfig          |   11 +
 drivers/input/misc/Makefile         |    1 +
 drivers/input/misc/aw8695-haptics.c | 1391 +++++++++++++++++++++++++++
 3 files changed, 1403 insertions(+)
 create mode 100644 drivers/input/misc/aw8695-haptics.c

diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig
index dd5227cf8696..40f4ece9075a 100644
--- a/drivers/input/misc/Kconfig
+++ b/drivers/input/misc/Kconfig
@@ -119,6 +119,17 @@ config INPUT_ATMEL_CAPTOUCH
 	  To compile this driver as a module, choose M here: the
 	  module will be called atmel_captouch.
 
+config INPUT_AW8695_HAPTICS
+	tristate "Awinic AW8695 haptics support"
+	depends on INPUT && I2C
+	select INPUT_FF_MEMLESS
+	select REGMAP_I2C
+	help
+	  Say Y to enable support for the Awinic AW8695 haptics driver.
+
+	  To compile this driver as a module, choose M here: the module will
+	  be called aw8695-haptics.
+
 config INPUT_BMA150
 	tristate "BMA150/SMB380 acceleration sensor support"
 	depends on I2C
diff --git a/drivers/input/misc/Makefile b/drivers/input/misc/Makefile
index b92c53a6b5ae..18eb84a7bb17 100644
--- a/drivers/input/misc/Makefile
+++ b/drivers/input/misc/Makefile
@@ -21,6 +21,7 @@ obj-$(CONFIG_INPUT_ATC260X_ONKEY)	+= atc260x-onkey.o
 obj-$(CONFIG_INPUT_ATI_REMOTE2)		+= ati_remote2.o
 obj-$(CONFIG_INPUT_ATLAS_BTNS)		+= atlas_btns.o
 obj-$(CONFIG_INPUT_ATMEL_CAPTOUCH)	+= atmel_captouch.o
+obj-$(CONFIG_INPUT_AW8695_HAPTICS)	+= aw8695-haptics.o
 obj-$(CONFIG_INPUT_BMA150)		+= bma150.o
 obj-$(CONFIG_INPUT_CM109)		+= cm109.o
 obj-$(CONFIG_INPUT_CMA3000)		+= cma3000_d0x.o
diff --git a/drivers/input/misc/aw8695-haptics.c b/drivers/input/misc/aw8695-haptics.c
new file mode 100644
index 000000000000..a122c8f0fab8
--- /dev/null
+++ b/drivers/input/misc/aw8695-haptics.c
@@ -0,0 +1,1391 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (C) 2022 Luca Weiss <luca.weiss@fairphone.com>
+ *
+ * Partially based on vendor driver:
+ *   Copyright (c) 2018 AWINIC Technology CO., LTD
+ */
+
+#include <linux/delay.h>
+#include <linux/firmware.h>
+#include <linux/gpio/consumer.h>
+#include <linux/i2c.h>
+#include <linux/input.h>
+#include <linux/module.h>
+#include <linux/regmap.h>
+#include <linux/regulator/consumer.h>
+#include <linux/slab.h>
+
+#define AW8695_CHIPID			0x95
+#define AW8695_RESET			0xaa
+/* Default of BASE_ADDR* registers */
+#define AW8695_RAM_BASE_ADDR		0x800
+
+#define AW8695_HIGH_MASK		GENMASK(15, 8)
+#define AW8695_LOW_MASK			GENMASK(7, 0)
+
+/* Chip ID */
+#define AW8695_ID				0x00
+
+/* System Status */
+#define AW8695_SYSST				0x01
+#define AW8695_SYSST_BSTERRS			BIT(7)
+#define AW8695_SYSST_OVS			BIT(6)
+#define AW8695_SYSST_UVLS			BIT(5)
+#define AW8695_SYSST_FF_AES			BIT(4)
+#define AW8695_SYSST_FF_AFS			BIT(3)
+#define AW8695_SYSST_OCDS			BIT(2)
+#define AW8695_SYSST_OTS			BIT(1)
+#define AW8695_SYSST_DONES			BIT(0)
+
+/* System Interrupt */
+#define AW8695_SYSINT				0x02
+#define AW8695_SYSINT_BSTERRI			BIT(7)
+#define AW8695_SYSINT_OVI			BIT(6)
+#define AW8695_SYSINT_UVLI			BIT(5)
+#define AW8695_SYSINT_FF_AEI			BIT(4)
+#define AW8695_SYSINT_FF_AFI			BIT(3)
+#define AW8695_SYSINT_OCDI			BIT(2)
+#define AW8695_SYSINT_OTI			BIT(1)
+#define AW8695_SYSINT_DONEI			BIT(0)
+
+/* System Interrupt Mask */
+#define AW8695_SYSINTM				0x03
+#define AW8695_SYSINTM_BSTERR_OFF		BIT(7)
+#define AW8695_SYSINTM_OV_OFF			BIT(6)
+#define AW8695_SYSINTM_UVLO_OFF			BIT(5)
+#define AW8695_SYSINTM_FF_AE_OFF		BIT(4)
+#define AW8695_SYSINTM_FF_AF_OFF		BIT(3)
+#define AW8695_SYSINTM_OCD_OFF			BIT(2)
+#define AW8695_SYSINTM_OT_OFF			BIT(1)
+#define AW8695_SYSINTM_DONE_OFF			BIT(0)
+
+/* System Control */
+#define AW8695_SYSCTRL				0x04
+#define AW8695_SYSCTRL_WAVDAT_MODE_MASK		GENMASK(7, 6)
+#define AW8695_SYSCTRL_WAVDAT_MODE_4X		(3<<6)
+#define AW8695_SYSCTRL_WAVDAT_MODE_2X		(0<<6)
+#define AW8695_SYSCTRL_WAVDAT_MODE_1X		(1<<6)
+
+#define AW8695_SYSCTRL_RAMINIT_EN		BIT(5)
+
+#define AW8695_SYSCTRL_PLAY_MODE_MASK		GENMASK(3, 2)
+#define AW8695_SYSCTRL_PLAY_MODE_CONT		(2<<2)
+#define AW8695_SYSCTRL_PLAY_MODE_RTP		(1<<2)
+#define AW8695_SYSCTRL_PLAY_MODE_RAM		(0<<2)
+
+#define AW8695_SYSCTRL_BST_MODE_MASK		GENMASK(1, 1)
+#define AW8695_SYSCTRL_BST_MODE_BOOST		(1<<1)
+#define AW8695_SYSCTRL_BST_MODE_BYPASS		(0<<1)
+
+#define AW8695_SYSCTRL_WORK_MODE_MASK		GENMASK(0, 0)
+#define AW8695_SYSCTRL_STANDBY			(1<<0)
+#define AW8695_SYSCTRL_ACTIVE			(0<<0)
+
+/* Process Control */
+#define AW8695_GO				0x05
+#define AW8695_GO_ENABLE			BIT(0)
+
+/* RTP Mode Data */
+#define AW8695_RTP_DATA				0x06
+
+/* Waveform #1 */
+#define AW8695_WAVSEQ1				0x07
+#define AW8695_WAVSEQ1_WAIT			BIT(7)
+#define AW8695_WAVSEQ1_WAV_FRM_SEQ1_MASK	GENMASK(6, 0)
+
+/* Waveform #2 */
+#define AW8695_WAVSEQ2				0x08
+#define AW8695_WAVSEQ2_WAIT			BIT(7)
+#define AW8695_WAVSEQ2_WAV_FRM_SEQ2_MASK	GENMASK(6, 0)
+
+/* Waveform #3 */
+#define AW8695_WAVSEQ3				0x09
+#define AW8695_WAVSEQ3_WAIT			BIT(7)
+#define AW8695_WAVSEQ3_WAV_FRM_SEQ3_MASK	GENMASK(6, 0)
+
+/* Waveform #4 */
+#define AW8695_WAVSEQ4				0x0a
+#define AW8695_WAVSEQ4_WAIT			BIT(7)
+#define AW8695_WAVSEQ4_WAV_FRM_SEQ4_MASK	GENMASK(6, 0)
+
+/* Waveform #5 */
+#define AW8695_WAVSEQ5				0x0b
+#define AW8695_WAVSEQ5_WAIT			BIT(7)
+#define AW8695_WAVSEQ5_WAV_FRM_SEQ5_MASK	GENMASK(6, 0)
+
+/* Waveform #6 */
+#define AW8695_WAVSEQ6				0x0c
+#define AW8695_WAVSEQ6_WAIT			BIT(7)
+#define AW8695_WAVSEQ6_WAV_FRM_SEQ6_MASK	GENMASK(6, 0)
+
+/* Waveform #7 */
+#define AW8695_WAVSEQ7				0x0d
+#define AW8695_WAVSEQ7_WAIT			BIT(7)
+#define AW8695_WAVSEQ7_WAV_FRM_SEQ7_MASK	GENMASK(6, 0)
+
+/* Waveform #8 */
+#define AW8695_WAVSEQ8				0x0e
+#define AW8695_WAVSEQ8_WAIT			BIT(7)
+#define AW8695_WAVSEQ8_WAV_FRM_SEQ8_MASK	GENMASK(6, 0)
+
+/* Waveform Loop #1 */
+#define AW8695_WAVLOOP1				0x0f
+#define AW8695_WAVLOOP1_SEQ1_MASK		GENMASK(7, 4)
+#define AW8695_WAVLOOP1_SEQ2_MASK		GENMASK(3, 0)
+
+/* Waveform Loop #2 */
+#define AW8695_WAVLOOP2				0x10
+#define AW8695_WAVLOOP2_SEQ3_MASK		GENMASK(7, 4)
+#define AW8695_WAVLOOP2_SEQ4_MASK		GENMASK(3, 0)
+
+/* Waveform Loop #3 */
+#define AW8695_WAVLOOP3				0x11
+#define AW8695_WAVLOOP3_SEQ5_MASK		GENMASK(7, 4)
+#define AW8695_WAVLOOP3_SEQ6_MASK		GENMASK(3, 0)
+
+/* Waveform Loop #4 */
+#define AW8695_WAVLOOP4				0x12
+#define AW8695_WAVLOOP4_SEQ7_MASK		GENMASK(7, 4)
+#define AW8695_WAVLOOP4_SEQ8_MASK		GENMASK(3, 0)
+
+/* Main Loop */
+#define AW8695_MAIN_LOOP			0x13
+
+/* TRIG1 Edge Waveform #1 */
+#define AW8695_TRG1_WAV_P			0x14
+
+/* TRIG2 Edge Waveform #1 */
+#define AW8695_TRG2_WAV_P			0x15
+
+/* TRIG3 Edge Waveform #1 */
+#define AW8695_TRG3_WAV_P			0x16
+
+/* TRIG1 Edge Waveform #2 */
+#define AW8695_TRG1_WAV_N			0x17
+
+/* TRIG2 Edge Waveform #2 */
+#define AW8695_TRG2_WAV_N			0x18
+
+/* TRIG3 Edge Waveform #2 */
+#define AW8695_TRG3_WAV_N			0x19
+
+#define AW8695_TRG_PRIO				0x1a
+#define AW8695_PLAYPRIO_GO_MASK			GENMASK(7, 6)
+#define AW8695_PLAYPRIO_TRIG3_MASK		GENMASK(5, 4)
+#define AW8695_PLAYPRIO_TRIG2_MASK		GENMASK(3, 2)
+#define AW8695_PLAYPRIO_TRIG1_MASK		GENMASK(1, 0)
+
+/* Trig Pins Config */
+#define AW8695_TRG_CFG1				0x1b
+#define AW8695_TRGCFG1_TRG3_POLAR_NEG		BIT(5)
+#define AW8695_TRGCFG1_TRG3_EDGE_POS		BIT(4)
+#define AW8695_TRGCFG1_TRG2_POLAR_NEG		BIT(3)
+#define AW8695_TRGCFG1_TRG2_EDGE_POS		BIT(2)
+#define AW8695_TRGCFG1_TRG1_POLAR_NEG		BIT(1)
+#define AW8695_TRGCFG1_TRG1_EDGE_POS		BIT(0)
+
+/* Trig Pins Config */
+#define AW8695_TRG_CFG2				0x1c
+#define AW8695_TRGCFG2_TRG3_ENABLE		BIT(2)
+#define AW8695_TRGCFG2_TRG2_ENABLE		BIT(1)
+#define AW8695_TRGCFG2_TRG1_ENABLE		BIT(0)
+
+/* Debug Control */
+#define AW8695_DBGCTRL				0x20
+#define AW8695_DBGCTRL_INT_EDGE_MODE_MASK	GENMASK(3, 3)
+#define AW8695_DBGCTRL_INT_EDGE_MODE_POS	(1<<3)
+#define AW8695_DBGCTRL_INT_EDGE_MODE_BOTH	(0<<3)
+#define AW8695_DBGCTRL_INT_MODE_MASK		GENMASK(2, 2)
+#define AW8695_DBGCTRL_INT_MODE_EDGE		(1<<2)
+#define AW8695_DBGCTRL_INT_MODE_LEVEL		(0<<2)
+
+/* High Five Bits of Wave SRAM */
+#define AW8695_BASE_ADDRH			0x21
+
+/* Low Eight Bits of Wave SRAM */
+#define AW8695_BASE_ADDRL			0x22
+
+/* High Four Bits of FIFO AE */
+#define AW8695_FIFO_AEH				0x23
+
+/* Low Eight Bits of FIFO AE */
+#define AW8695_FIFO_AEL				0x24
+
+/* High Four Bits of FIFO AF */
+#define AW8695_FIFO_AFH				0x25
+
+/* Low Eight Bits of FIFO AF */
+#define AW8695_FIFO_AFL				0x26
+
+#define AW8695_WAKE_DLY				0x27
+
+#define AW8695_START_DLY			0x28
+
+#define AW8695_END_DLY_H			0x29
+
+#define AW8695_END_DLY_L			0x2a
+
+/* Global Control Data */
+#define AW8695_DATCTRL				0x2b
+#define AW8695_DATCTRL_FC_MASK			GENMASK(6, 6)
+#define AW8695_DATCTRL_FC_1000HZ		(3<<6)
+#define AW8695_DATCTRL_FC_800HZ			(3<<6)
+#define AW8695_DATCTRL_FC_600HZ			(1<<6)
+#define AW8695_DATCTRL_FC_400HZ			(0<<6)
+
+#define AW8695_DATCTRL_LPF_ENABLE_MASK		GENMASK(5, 5)
+#define AW8695_DATCTRL_LPF_ENABLE		(1<<5)
+#define AW8695_DATCTRL_LPF_DISABLE		(0<<5)
+
+#define AW8695_DATCTRL_WAKEMODE_ENABLE_MASK	GENMASK(0, 0)
+#define AW8695_DATCTRL_WAKEMODE_ENABLE		(1<<0)
+#define AW8695_DATCTRL_WAKEMODE_DISABLE		(0<<0)
+
+#define AW8695_PWMDEL				0x2c
+
+/* PWM Output Protect Configuration */
+#define AW8695_PWMPRC				0x2d
+#define AW8695_PWMPRC_PRC_ENABLE		BIT(7)
+
+/* PWM Debug */
+#define AW8695_PWMDBG				0x2e
+#define AW8695_PWMDBG_PWM_MODE_MASK		GENMASK(6, 5)
+#define AW8695_PWMDBG_PWM_12K			(3<<5)
+#define AW8695_PWMDBG_PWM_24K			(2<<5)
+#define AW8695_PWMDBG_PWM_48K			(0<<5)
+
+#define AW8695_LDOCTRL				0x2f
+
+/* Debug Status */
+#define AW8695_DBGSTAT				0x30
+#define AW8695_DBGSTAT_FF_EMPTY			BIT(0)
+
+/* Boost Debug #1 */
+#define AW8695_BSTDBG1				0x31
+
+/* Boost Debug #2 */
+#define AW8695_BSTDBG2				0x32
+
+/* Boost Debug #3 */
+#define AW8695_BSTDBG3				0x33
+
+/* Boost Config */
+#define AW8695_BSTCFG				0x34
+#define AW8695_BSTCFG_PEAKCUR_MASK		GENMASK(2, 0)
+#define AW8695_BSTCFG_PEAKCUR_4A		(7<<0)
+#define AW8695_BSTCFG_PEAKCUR_3P75A		(6<<0)
+#define AW8695_BSTCFG_PEAKCUR_3P5A		(5<<0)
+#define AW8695_BSTCFG_PEAKCUR_3P25A		(4<<0)
+#define AW8695_BSTCFG_PEAKCUR_3A		(3<<0)
+#define AW8695_BSTCFG_PEAKCUR_2P5A		(2<<0)
+#define AW8695_BSTCFG_PEAKCUR_2A		(1<<0)
+#define AW8695_BSTCFG_PEAKCUR_1P5A		(0<<0)
+
+#define AW8695_ANADBG				0x35
+#define AW8695_ANADBG_IOC_MASK			GENMASK(3, 2)
+#define AW8695_ANADBG_IOC_4P65A			(3<<2)
+#define AW8695_ANADBG_IOC_4P15A			(2<<2)
+#define AW8695_ANADBG_IOC_3P65A			(1<<2)
+#define AW8695_ANADBG_IOC_3P15A			(0<<2)
+
+#define AW8695_ANACTRL				0x36
+#define AW8695_ANACTRL_LRA_SRC_MASK		GENMASK(5, 5)
+#define AW8695_ANACTRL_LRA_SRC_REG		(1<<5)
+#define AW8695_ANACTRL_LRA_SRC_EFUSE		(0<<5)
+#define AW8695_ANACTRL_HD_PD_MASK		GENMASK(3, 3)
+#define AW8695_ANACTRL_HD_PD_EN			(1<<3)
+#define AW8695_ANACTRL_HD_HZ_EN			(0<<3)
+
+#define AW8695_CPDBG				0x37
+
+#define AW8695_GLBDBG				0x38
+
+/* Data Gain */
+#define AW8695_DATDBG				0x39
+
+/* Boost Debug #4 */
+#define AW8695_BSTDBG4				0x3a
+#define AW8695_BSTDBG4_BSTVOL_MASK		GENMASK(5, 1)
+
+/* Boost Debug #5 */
+#define AW8695_BSTDBG5				0x3b
+
+/* Boost Debug #6 */
+#define AW8695_BSTDBG6				0x3c
+
+#define AW8695_HDRVDBG				0x3d
+
+/* Waveform Protect Level */
+#define AW8695_PRLVL				0x3e
+#define AW8695_PRLVL_PR_ENABLE			BIT(7)
+#define AW8695_PRLVL_PRLVL_MASK			GENMASK(6, 0)
+
+/* Waveform Protect Period */
+#define AW8695_PRTIME				0x3f
+
+/* SRAM Address 0xhigh */
+#define AW8695_RAMADDRH				0x40
+
+/* SRAM Address 0xlow */
+#define AW8695_RAMADDRL				0x41
+
+/* SRAM Data */
+#define AW8695_RAMDATA				0x42
+
+#define AW8695_GLB_STATE			0x46
+
+#define AW8695_BST_AUTO				0x47
+#define AW8695_BST_AUTO_BST_AUTOSW_MASK		GENMASK(2, 2)
+#define AW8695_BST_AUTO_BST_AUTOMATIC_BOOST	(1<<2)
+#define AW8695_BST_AUTO_BST_MANUAL_BOOST	(0<<2)
+#define AW8695_BST_AUTO_BST_RTP_ENABLE		BIT(1)
+#define AW8695_BST_AUTO_BST_RAM_ENABLE		BIT(0)
+
+/* CONT Mode Control */
+#define AW8695_CONT_CTRL			0x48
+#define AW8695_CONT_CTRL_ZC_DETEC_ENABLE	BIT(7)
+#define AW8695_CONT_CTRL_WAIT_PERIOD_MASK	GENMASK(6, 5)
+#define AW8695_CONT_CTRL_WAIT_8PERIOD		(3<<5)
+#define AW8695_CONT_CTRL_WAIT_4PERIOD		(2<<5)
+#define AW8695_CONT_CTRL_WAIT_2PERIOD		(1<<5)
+#define AW8695_CONT_CTRL_WAIT_1PERIOD		(0<<5)
+#define AW8695_CONT_CTRL_MODE_MASK		GENMASK(4, 4)
+#define AW8695_CONT_CTRL_BY_DRV_TIME		(1<<4)
+#define AW8695_CONT_CTRL_BY_GO_SIGNAL		(0<<4)
+#define AW8695_CONT_CTRL_EN_CLOSE_MASK		GENMASK(3, 3)
+#define AW8695_CONT_CTRL_CLOSE_PLAYBACK		(1<<3)
+#define AW8695_CONT_CTRL_OPEN_PLAYBACK		(0<<3)
+#define AW8695_CONT_CTRL_F0_DETECT_ENABLE	BIT(2)
+#define AW8695_CONT_CTRL_O2C_ENABLE		BIT(1)
+#define AW8695_CONT_CTRL_AUTO_BRK_ENABLE	BIT(0)
+
+/* High 8 Bits Pre Setting f0 Value */
+#define AW8695_F_PRE_H				0x49
+
+/* Low 8 Bits Pre Setting f0 Value */
+#define AW8695_F_PRE_L				0x4a
+
+/* High 4 Bits of Delay Time Setting */
+#define AW8695_TD_H				0x4b
+
+/* Low 8 Bits of Delay Time Setting */
+#define AW8695_TD_L				0x4c
+
+#define AW8695_TSET				0x4d
+
+#define AW8695_TRIM_LRA				0x5b
+
+#define AW8695_R_SPARE				0x5d
+
+#define AW8695_D2SCFG				0x5e
+#define AW8695_D2SCFG_CLK_ADC_MASK		GENMASK(7, 5)
+#define AW8695_D2SCFG_CLK_ASC_0P09375MHZ	(7<<5)
+#define AW8695_D2SCFG_CLK_ASC_0P1875MHZ		(6<<5)
+#define AW8695_D2SCFG_CLK_ASC_0P375MHZ		(5<<5)
+#define AW8695_D2SCFG_CLK_ASC_0P75MHZ		(4<<5)
+#define AW8695_D2SCFG_CLK_ASC_1P5MHZ		(3<<5)
+#define AW8695_D2SCFG_CLK_ASC_3MHZ		(2<<5)
+#define AW8695_D2SCFG_CLK_ASC_6MHZ		(1<<5)
+#define AW8695_D2SCFG_CLK_ASC_12MHZ		(0<<5)
+
+/* Detection Control */
+#define AW8695_DETCTRL				0x5f
+#define AW8695_DETCTRL_RL_OS_MASK		GENMASK(6, 6)
+#define AW8695_DETCTRL_RL_DETECT		(1<<6)
+#define AW8695_DETCTRL_OS_DETECT		(0<<6)
+#define AW8695_DETCTRL_PROTECT_MASK		GENMASK(5, 5)
+#define AW8695_DETCTRL_PROTECT_NO_ACTION	(1<<5)
+#define AW8695_DETCTRL_PROTECT_SHUTDOWN		(0<<5)
+#define AW8695_DETCTRL_ADO_SLOT_MODE_ENABLE	BIT(4)
+#define AW8695_DETCTRL_VBAT_GO_ENABLE		BIT(1)
+#define AW8695_DETCTRL_DIAG_GO_ENABLE		BIT(0)
+
+/* Detected RL of LRA */
+#define AW8695_RLDET				0x60
+
+/* Detected Offset of LRA */
+#define AW8695_OSDET				0x61
+
+/* Detected VBAT */
+#define AW8695_VBATDET				0x62
+
+#define AW8695_TESTDET				0x63
+
+#define AW8695_DETLO				0x64
+
+#define AW8695_BEMFDBG				0x65
+
+/* ADC Test */
+#define AW8695_ADCTEST				0x66
+#define AW8695_ADCTEST_VBAT_MODE_MASK		GENMASK(6, 6)
+#define AW8695_ADCTEST_VBAT_HW_COMP		(1<<6)
+#define AW8695_ADCTEST_VBAT_SW_COMP		(0<<6)
+
+#define AW8695_BEMFTEST				0x67
+
+/* High 8 Bits Detected f0 Value */
+#define AW8695_F_LRA_F0_H			0x68
+
+/* Low 8 Bits Detected f0 Value */
+#define AW8695_F_LRA_F0_L			0x69
+
+/* High 8 Bits CONT_ENG Gotten f0 Value */
+#define AW8695_F_LRA_CONT_H			0x6a
+
+/* Low 8 Bits CONT_ENG Gotten f0 Value */
+#define AW8695_F_LRA_CONT_L			0x6b
+
+#define AW8695_WAIT_VOL_MP			0x6d
+
+#define AW8695_WAIT_VOL_MN			0x6f
+
+#define AW8695_BEMF_VOL_H			0x70
+
+#define AW8695_BEMF_VOL_L			0x71
+
+/* Zero Cross Threshold High 8 Bits Configuration */
+#define AW8695_ZC_THRSH_H			0x72
+
+/* Zero Cross Threshold Low 8 Bits Configuration */
+#define AW8695_ZC_THRSH_L			0x73
+
+#define AW8695_BEMF_VTHH_H			0x74
+
+#define AW8695_BEMF_VTHH_L			0x75
+
+#define AW8695_BEMF_VTHL_H			0x76
+
+#define AW8695_BEMF_VTHL_L			0x77
+
+/* BEMF Detection Cycles Configuration */
+#define AW8695_BEMF_NUM				0x78
+#define AW8695_BEMF_NUM_BRK_MASK		GENMASK(3, 0)
+
+/* Drive Time Setting */
+#define AW8695_DRV_TIME				0x79
+
+/* Non Zero Cross Time Setting */
+#define AW8695_TIME_NZC				0x7a
+
+/* Drive Level Setting */
+#define AW8695_DRV_LVL				0x7b
+
+/* Drive Level for Overdrive Setting */
+#define AW8695_DRV_LVL_OV			0x7c
+
+/* Number Configuration for F0 Trace #1 */
+#define AW8695_NUM_F0_1				0x7d
+#define AW8695_NUM_F0_1_PRE_MASK		GENMASK(7, 4)
+#define AW8695_NUM_F0_1_WAIT_MASK		GENMASK(3, 0)
+
+/* Number Configuration for F0 Trace #2 */
+#define AW8695_NUM_F0_2				0x7e
+
+/* Number Configuration for F0 Trace #3 */
+#define AW8695_NUM_F0_3				0x7f
+
+#define AW8695_MAX_REG				0x7f
+
+enum aw8695_work_mode {
+	AW8695_STANDBY_MODE,
+	AW8695_RAM_MODE,
+	AW8695_RTP_MODE,
+	AW8695_TRIG_MODE,
+	AW8695_CONT_MODE,
+};
+
+struct aw8695_data {
+	struct input_dev *input_dev;
+	struct i2c_client *client;
+	struct regmap *regmap;
+	struct gpio_desc *reset_gpio;
+	bool running;
+	struct work_struct play_work;
+	/* Parameters from devicetree */
+	u32 f0_preset;
+	u32 f0_coefficient;
+	u32 f0_cali_percent;
+	u32 drive_level;
+	u32 f0_det_play;
+	u32 f0_det_wait;
+	u32 f0_det_repeat;
+	u32 f0_det_trace;
+	u8 boost_debug[3];
+	u8 tset;
+	u8 r_spare;
+	u32 bemf_vthh;
+	u32 bemf_vthl;
+};
+
+/*
+ * Sine wave representing the magnitude of the drive to be used.
+ * Data is encoded in two's complement.
+ *   round(84 * sin(x / 16.25))
+ */
+static const u8 aw8695_sine_waveform[] = {
+	0x00, 0x05, 0x0a, 0x0f, 0x14, 0x19, 0x1e, 0x23, 0x28, 0x2c, 0x30, 0x35,
+	0x39, 0x3c, 0x40, 0x43, 0x46, 0x49, 0x4b, 0x4d, 0x4f, 0x51, 0x52, 0x53,
+	0x54, 0x54, 0x54, 0x54, 0x53, 0x52, 0x51, 0x4f, 0x4d, 0x4b, 0x49, 0x46,
+	0x43, 0x40, 0x3c, 0x39, 0x35, 0x31, 0x2c, 0x28, 0x23, 0x1f, 0x1a, 0x15,
+	0x10, 0x0b, 0x05, 0x00, 0xfb, 0xf6, 0xf1, 0xec, 0xe7, 0xe2, 0xdd, 0xd9,
+	0xd4, 0xd0, 0xcc, 0xc8, 0xc4, 0xc0, 0xbd, 0xba, 0xb7, 0xb5, 0xb3, 0xb1,
+	0xaf, 0xae, 0xad, 0xac, 0xac, 0xac, 0xac, 0xad, 0xae, 0xaf, 0xb1, 0xb2,
+	0xb5, 0xb7, 0xba, 0xbd, 0xc0, 0xc3, 0xc7, 0xcb, 0xcf, 0xd3, 0xd8, 0xdc,
+	0xe1, 0xe6, 0xeb, 0xf0, 0xf5, 0xfa
+};
+
+/*
+ * Header that gets written to AW8695 SRAM that describes the available
+ * waveforms being transferred afterwards.
+ *
+ * @version: waveform library version
+ * @start_address: start address of waveform in SRAM
+ * @end_address: end address of waveform in SRAM
+ */
+struct aw8695_sram_waveform_header {
+	u8 version;
+	struct {
+		__be16 start_address;
+		__be16 end_address;
+	} __packed waveform_address[1];
+} __packed;
+
+static const struct aw8695_sram_waveform_header sram_waveform_header = {
+	.version = 0x01,
+	.waveform_address = {
+		/* Simple sine wave defined above */
+		{
+			.start_address = cpu_to_be16(AW8695_RAM_BASE_ADDR +
+				sizeof(struct aw8695_sram_waveform_header)),
+			.end_address = cpu_to_be16(AW8695_RAM_BASE_ADDR +
+				sizeof(struct aw8695_sram_waveform_header) +
+				ARRAY_SIZE(aw8695_sine_waveform) - 1),
+		}
+	}
+};
+
+static int aw8695_interrupt_clear(struct aw8695_data *haptics)
+{
+	unsigned int read_buf;
+
+	/* Clear UVLI bit by reading register */
+	return regmap_read(haptics->regmap, AW8695_SYSINT, &read_buf);
+}
+
+static int aw8695_haptic_set_active(struct aw8695_data *haptics)
+{
+	int err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+		AW8695_SYSCTRL_WORK_MODE_MASK, AW8695_SYSCTRL_ACTIVE);
+	if (err)
+		return err;
+
+	err = aw8695_interrupt_clear(haptics);
+	if (err)
+		return err;
+
+	return regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+		AW8695_SYSINTM_UVLO_OFF, 0);
+}
+
+static int aw8695_set_work_mode(struct aw8695_data *haptics,
+				 enum aw8695_work_mode mode)
+{
+	struct device *dev = &haptics->client->dev;
+	int err;
+
+	switch (mode) {
+	case AW8695_STANDBY_MODE:
+		err = regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+			AW8695_SYSINTM_UVLO_OFF, AW8695_SYSINTM_UVLO_OFF);
+		if (err)
+			return err;
+		err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+			AW8695_SYSCTRL_WORK_MODE_MASK, AW8695_SYSCTRL_STANDBY);
+		if (err)
+			return err;
+		break;
+	case AW8695_RAM_MODE:
+		err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+			AW8695_SYSCTRL_PLAY_MODE_MASK, AW8695_SYSCTRL_PLAY_MODE_RAM);
+		if (err)
+			return err;
+		err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+			AW8695_SYSCTRL_BST_MODE_MASK, AW8695_SYSCTRL_BST_MODE_BYPASS);
+		if (err)
+			return err;
+		err = aw8695_haptic_set_active(haptics);
+		if (err)
+			return err;
+		break;
+	case AW8695_CONT_MODE:
+		err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+			AW8695_SYSCTRL_PLAY_MODE_MASK, AW8695_SYSCTRL_PLAY_MODE_CONT);
+		if (err)
+			return err;
+		err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+			AW8695_SYSCTRL_BST_MODE_MASK, AW8695_SYSCTRL_BST_MODE_BYPASS);
+		if (err)
+			return err;
+		err = aw8695_haptic_set_active(haptics);
+		if (err)
+			return err;
+		break;
+	default:
+		dev_err(dev, "Unhandled mode: %d\n", mode);
+		return -EINVAL;
+	}
+
+	return err;
+}
+
+static int aw8695_haptics_play(struct input_dev *dev, void *data,
+			       struct ff_effect *effect)
+{
+	struct aw8695_data *haptics = input_get_drvdata(dev);
+	int level;
+
+	level = effect->u.rumble.strong_magnitude;
+	if (!level)
+		level = effect->u.rumble.weak_magnitude;
+
+	haptics->running = level;
+	schedule_work(&haptics->play_work);
+
+	return 0;
+}
+
+static int aw8695_haptics_stop(struct aw8695_data *haptics)
+{
+	int err;
+	unsigned int read_buf;
+	struct device *dev = &haptics->client->dev;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_GO,
+		AW8695_GO_ENABLE, 0);
+	if (err)
+		return err;
+
+	err = regmap_read_poll_timeout(haptics->regmap, AW8695_GLB_STATE, read_buf,
+			(read_buf & 0x0f) == 0, 2000, 2000 * 100);
+	if (err) {
+		dev_err(dev, "Did not enter standby: %d\n", err);
+		return err;
+	}
+
+	return aw8695_set_work_mode(haptics, AW8695_STANDBY_MODE);
+}
+
+static int aw8695_haptics_start(struct aw8695_data *haptics)
+{
+	int err;
+
+	err = aw8695_haptics_stop(haptics);
+	if (err)
+		return err;
+
+	/* Configure for waveform #1 to be played infinitely */
+	err = regmap_write(haptics->regmap, AW8695_WAVSEQ1, 0x1);
+	if (err)
+		return err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_WAVLOOP1,
+		AW8695_WAVLOOP1_SEQ1_MASK, 0xf0);
+	if (err)
+		return err;
+
+	err = regmap_write(haptics->regmap, AW8695_WAVSEQ2, 0x0);
+	if (err)
+		return err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_WAVLOOP1,
+		AW8695_WAVLOOP1_SEQ2_MASK, 0x0);
+	if (err)
+		return err;
+
+	/* Configure for RAM mode */
+	err = aw8695_set_work_mode(haptics, AW8695_RAM_MODE);
+	if (err)
+		return err;
+
+	/* Start vibration */
+	return regmap_update_bits(haptics->regmap, AW8695_GO,
+		AW8695_GO_ENABLE, AW8695_GO_ENABLE);
+}
+
+static void aw8695_close(struct input_dev *input)
+{
+	struct aw8695_data *haptics = input_get_drvdata(input);
+	struct device *dev = &haptics->client->dev;
+	int err;
+
+	cancel_work_sync(&haptics->play_work);
+	err = aw8695_haptics_stop(haptics);
+	if (err)
+		dev_err(dev, "Failed to stop haptics: %d\n", err);
+}
+
+static void aw8695_haptics_play_work(struct work_struct *work)
+{
+	struct aw8695_data *haptics =
+		container_of(work, struct aw8695_data, play_work);
+	struct device *dev = &haptics->client->dev;
+	int err;
+
+	if (haptics->running)
+		err = aw8695_haptics_start(haptics);
+	else
+		err = aw8695_haptics_stop(haptics);
+
+	if (err)
+		dev_err(dev, "Failed to execute work command: %d\n", err);
+}
+
+static void aw8695_hw_reset(struct aw8695_data *haptics)
+{
+	/* Pull reset low */
+	gpiod_set_value_cansleep(haptics->reset_gpio, 0);
+
+	/* Wait ~1ms */
+	usleep_range(1000, 2000);
+
+	/* Pull reset high */
+	gpiod_set_value_cansleep(haptics->reset_gpio, 1);
+
+	/* Wait ~3.5ms until I2C is accessible */
+	usleep_range(3500, 4000);
+}
+
+static int aw8695_haptic_offset_calibration(struct aw8695_data *haptics)
+{
+	unsigned int read_buf;
+	int err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+		AW8695_SYSCTRL_RAMINIT_EN, AW8695_SYSCTRL_RAMINIT_EN);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_DETCTRL,
+		AW8695_DETCTRL_DIAG_GO_ENABLE, AW8695_DETCTRL_DIAG_GO_ENABLE);
+	if (err)
+		return err;
+
+	err = regmap_read_poll_timeout(haptics->regmap, AW8695_DETCTRL, read_buf,
+			(read_buf & AW8695_DETCTRL_DIAG_GO_ENABLE) == 0, 10000, 10000 * 50);
+	if (err)
+		return err;
+
+	return regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+		AW8695_SYSCTRL_RAMINIT_EN, 0);
+}
+
+static int aw8695_haptic_read_f0(struct aw8695_data *haptics)
+{
+	struct device *dev = &haptics->client->dev;
+	unsigned long f0;
+	unsigned int f0_reg;
+	unsigned int read_buf;
+	int err;
+
+	err = regmap_read(haptics->regmap, AW8695_F_LRA_F0_H, &read_buf);
+	if (err)
+		return err;
+	f0_reg = FIELD_PREP(AW8695_HIGH_MASK, read_buf);
+
+	err = regmap_read(haptics->regmap, AW8695_F_LRA_F0_L, &read_buf);
+	if (err)
+		return err;
+	f0_reg |= FIELD_PREP(AW8695_LOW_MASK, read_buf);
+
+	if (!f0_reg) {
+		dev_err(dev, "Failed to read f0 value!\n");
+		return -EINVAL;
+	}
+
+	f0 = 1000000000 / (f0_reg * haptics->f0_coefficient);
+	dev_dbg(dev, "Read new f0: %d\n", (int)f0);
+
+	return (int)f0;
+}
+
+static int aw8695_haptic_get_f0(struct aw8695_data *haptics)
+{
+	struct device *dev = &haptics->client->dev;
+	unsigned int read_buf;
+	unsigned int f0_trace_ms;
+	unsigned int f0_reg;
+	int f0;
+	int err;
+
+	err = aw8695_haptics_stop(haptics);
+	if (err)
+		return err;
+
+	err = regmap_write(haptics->regmap, AW8695_TRIM_LRA, 0x00);
+	if (err)
+		return err;
+
+	err = aw8695_set_work_mode(haptics, AW8695_CONT_MODE);
+	if (err)
+		return err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_CONT_CTRL,
+		AW8695_CONT_CTRL_EN_CLOSE_MASK, AW8695_CONT_CTRL_OPEN_PLAYBACK);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_CONT_CTRL,
+		AW8695_CONT_CTRL_F0_DETECT_ENABLE, AW8695_CONT_CTRL_F0_DETECT_ENABLE);
+	if (err)
+		return err;
+
+	/* LPF */
+	err = regmap_update_bits(haptics->regmap, AW8695_DATCTRL,
+		AW8695_DATCTRL_FC_MASK, AW8695_DATCTRL_FC_1000HZ);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_DATCTRL,
+		AW8695_DATCTRL_LPF_ENABLE_MASK, AW8695_DATCTRL_LPF_ENABLE);
+	if (err)
+		return err;
+
+	/* LRA OSC Source */
+	err = regmap_update_bits(haptics->regmap, AW8695_ANACTRL,
+		AW8695_ANACTRL_LRA_SRC_MASK, AW8695_ANACTRL_LRA_SRC_REG);
+	if (err)
+		return err;
+
+	/* preset f0 */
+	f0_reg = 1000000000 / (haptics->f0_preset * haptics->f0_coefficient);
+	err = regmap_write(haptics->regmap, AW8695_F_PRE_H,
+			FIELD_GET(AW8695_HIGH_MASK, f0_reg));
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_F_PRE_L,
+			FIELD_GET(AW8695_LOW_MASK, f0_reg));
+	if (err)
+		return err;
+
+	/* f0 driver level */
+	err = regmap_write(haptics->regmap, AW8695_DRV_LVL, haptics->drive_level);
+	if (err)
+		return err;
+
+	/* f0 trace parameter */
+	err = regmap_write(haptics->regmap, AW8695_NUM_F0_1,
+			FIELD_PREP(AW8695_NUM_F0_1_PRE_MASK, haptics->f0_det_play) |
+			FIELD_PREP(AW8695_NUM_F0_1_WAIT_MASK, haptics->f0_det_wait));
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_NUM_F0_2, haptics->f0_det_repeat);
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_NUM_F0_3, haptics->f0_det_trace);
+	if (err)
+		return err;
+
+	err = aw8695_interrupt_clear(haptics);
+	if (err)
+		return err;
+
+	/* play go and start f0 calibration */
+	err = regmap_update_bits(haptics->regmap, AW8695_GO,
+		AW8695_GO_ENABLE, AW8695_GO_ENABLE);
+	if (err)
+		return err;
+
+	/* f0 trace time */
+	f0_trace_ms =
+		(1000 * 10 / haptics->f0_preset) * (haptics->f0_det_play + haptics->f0_det_wait +
+		(haptics->f0_det_trace + haptics->f0_det_wait) * (haptics->f0_det_repeat - 1));
+	usleep_range(f0_trace_ms * 1000, f0_trace_ms * 1000 + 500);
+
+	err = regmap_read_poll_timeout(haptics->regmap, AW8695_GLB_STATE, read_buf,
+			(read_buf & 0x0f) == 0, 10000, 10000 * 50);
+	if (err) {
+		dev_err(dev, "Did not enter standby: %d\n", err);
+		return err;
+	}
+
+	f0 = aw8695_haptic_read_f0(haptics);
+
+	/* restore default config */
+	err = regmap_update_bits(haptics->regmap, AW8695_CONT_CTRL,
+		AW8695_CONT_CTRL_EN_CLOSE_MASK, AW8695_CONT_CTRL_CLOSE_PLAYBACK);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_CONT_CTRL,
+		AW8695_CONT_CTRL_F0_DETECT_ENABLE, 0);
+	if (err)
+		return err;
+
+	return f0;
+}
+
+
+static int aw8695_haptic_f0_calibration(struct aw8695_data *haptics)
+{
+	struct device *dev = &haptics->client->dev;
+	unsigned int read_buf;
+	int f0_cali_step, f0_limit, f0;
+	char f0_cali_lra;
+	int err;
+
+
+	f0 = aw8695_haptic_get_f0(haptics);
+	if (f0 < 0) {
+		dev_err(dev, "Failed to read f0: %d\n", f0);
+		return f0;
+	}
+
+	/* make sure the f0_limit is not more than f0_cali_percent % away from read f0 */
+	if (f0 * 100 < haptics->f0_preset * (100 - haptics->f0_cali_percent) ||
+	    f0 * 100 > haptics->f0_preset * (100 + haptics->f0_cali_percent)) {
+		f0_limit = (int)haptics->f0_preset;
+	} else {
+		f0_limit = (int)f0;
+	}
+
+	/* calculate cali step */
+	f0_cali_step = 100000 * (f0_limit - (int)haptics->f0_preset) /
+		(f0_limit * 25);
+
+	if (f0_cali_step >= 0) {
+		if (f0_cali_step % 10 >= 5)
+			f0_cali_step = f0_cali_step / 10 + 1 + 32;
+		else
+			f0_cali_step = f0_cali_step / 10 + 32;
+	} else {
+		if (f0_cali_step % 10 <= -5)
+			f0_cali_step = 32 + (f0_cali_step / 10 - 1);
+		else
+			f0_cali_step = 32 + f0_cali_step / 10;
+	}
+
+	if (f0_cali_step > 31)
+		f0_cali_lra = (char)f0_cali_step - 32;
+	else
+		f0_cali_lra = (char)f0_cali_step + 32;
+
+	err = regmap_write(haptics->regmap, AW8695_TRIM_LRA, f0_cali_lra);
+	if (err)
+		return err;
+
+	err = regmap_read(haptics->regmap, AW8695_TRIM_LRA, &read_buf);
+	if (err)
+		return err;
+
+	dev_dbg(dev, "Calibrated TRIM_LRA: %x\n", read_buf);
+
+	/* restore default work mode */
+	err = aw8695_set_work_mode(haptics, AW8695_STANDBY_MODE);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+		AW8695_SYSCTRL_PLAY_MODE_MASK, AW8695_SYSCTRL_PLAY_MODE_RAM);
+	if (err)
+		return err;
+
+	return aw8695_haptics_stop(haptics);
+}
+
+static int aw8695_init(struct aw8695_data *haptics)
+{
+	int err;
+	unsigned int read_buf;
+	struct device *dev = &haptics->client->dev;
+
+	aw8695_hw_reset(haptics);
+
+	err = regmap_read(haptics->regmap, AW8695_ID, &read_buf);
+	if (err) {
+		dev_err(dev, "Failed to read ID register: %d\n", err);
+		return err;
+	}
+
+	if (read_buf != AW8695_CHIPID) {
+		dev_err(dev, "Chip ID mismatch: expected %x, got %x\n",
+			AW8695_CHIPID, read_buf);
+		return -ENODEV;
+	}
+
+	err = regmap_write(haptics->regmap, AW8695_ID, AW8695_RESET);
+	if (err) {
+		dev_err(dev, "Failed to reset: %d\n", err);
+		return err;
+	}
+
+	/* Wait ~1ms after reset */
+	usleep_range(1000, 1500);
+
+	/* Clear UVLI bit by reading register */
+	err = aw8695_interrupt_clear(haptics);
+	if (err) {
+		dev_err(dev, "Failed to clear interrupt: %d\n", err);
+		return err;
+	}
+
+	/* Set interrupt mode to edge */
+	err = regmap_update_bits(haptics->regmap, AW8695_DBGCTRL,
+		AW8695_DBGCTRL_INT_MODE_MASK,
+		AW8695_DBGCTRL_INT_MODE_EDGE);
+	if (err) {
+		dev_err(dev, "Failed to set interrupt mode: %d\n", err);
+		return err;
+	}
+
+	/* Configure interrupts */
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+		AW8695_SYSINTM_BSTERR_OFF, AW8695_SYSINTM_BSTERR_OFF);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+		AW8695_SYSINTM_OV_OFF, 0);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+		AW8695_SYSINTM_UVLO_OFF, 0);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+		AW8695_SYSINTM_OCD_OFF, 0);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSINTM,
+		AW8695_SYSINTM_OT_OFF, 0);
+	if (err)
+		return err;
+
+	err = aw8695_set_work_mode(haptics, AW8695_STANDBY_MODE);
+	if (err)
+		return err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_PWMDBG,
+		AW8695_PWMDBG_PWM_MODE_MASK, AW8695_PWMDBG_PWM_24K);
+	if (err)
+		return err;
+
+	err = regmap_write(haptics->regmap, AW8695_BSTDBG1, haptics->boost_debug[0]);
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_BSTDBG2, haptics->boost_debug[1]);
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_BSTDBG3, haptics->boost_debug[2]);
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_TSET, haptics->tset);
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_R_SPARE, haptics->r_spare);
+	if (err)
+		return err;
+
+	err = regmap_update_bits(haptics->regmap, AW8695_ANADBG,
+		AW8695_ANADBG_IOC_MASK, AW8695_ANADBG_IOC_4P65A);
+	if (err)
+		return err;
+
+	/* Set boost peak current */
+	err = regmap_update_bits(haptics->regmap, AW8695_BSTCFG,
+		AW8695_BSTCFG_PEAKCUR_MASK, AW8695_BSTCFG_PEAKCUR_2A);
+	if (err)
+		return err;
+
+	/* Adjust motorprotect config */
+	err = regmap_update_bits(haptics->regmap, AW8695_DETCTRL,
+		AW8695_DETCTRL_PROTECT_MASK, AW8695_DETCTRL_PROTECT_NO_ACTION);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_PWMPRC,
+		AW8695_PWMPRC_PRC_ENABLE, 0);
+	if (err)
+		return err;
+	err = regmap_update_bits(haptics->regmap, AW8695_PRLVL,
+		AW8695_PRLVL_PR_ENABLE, 0);
+	if (err)
+		return err;
+
+	/* Adjust auto boost config */
+	err = regmap_update_bits(haptics->regmap, AW8695_BST_AUTO,
+		AW8695_BST_AUTO_BST_AUTOSW_MASK,
+		AW8695_BST_AUTO_BST_MANUAL_BOOST);
+	if (err)
+		return err;
+
+	err = aw8695_haptic_offset_calibration(haptics);
+	if (err)
+		return err;
+
+	/* Set vbat compensation mode */
+	err = regmap_update_bits(haptics->regmap, AW8695_ADCTEST,
+		AW8695_ADCTEST_VBAT_MODE_MASK, AW8695_ADCTEST_VBAT_HW_COMP);
+	if (err)
+		return err;
+
+	err = aw8695_haptic_f0_calibration(haptics);
+	if (err)
+		return err;
+
+	/* beme config */
+	err = regmap_write(haptics->regmap, AW8695_BEMF_VTHH_H,
+			FIELD_GET(AW8695_HIGH_MASK, haptics->bemf_vthh));
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_BEMF_VTHH_L,
+			FIELD_GET(AW8695_LOW_MASK, haptics->bemf_vthh));
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_BEMF_VTHL_H,
+			FIELD_GET(AW8695_HIGH_MASK, haptics->bemf_vthl));
+	if (err)
+		return err;
+	return regmap_write(haptics->regmap, AW8695_BEMF_VTHL_L,
+			FIELD_GET(AW8695_LOW_MASK, haptics->bemf_vthl));
+}
+
+static int aw8695_ram_init(struct aw8695_data *haptics)
+{
+	unsigned char *ptr;
+	int err;
+	int i;
+
+	/* Enable SRAM init */
+	err = regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+		AW8695_SYSCTRL_RAMINIT_EN, AW8695_SYSCTRL_RAMINIT_EN);
+	if (err)
+		return err;
+
+	/* Set RAMDATA write address */
+	err = regmap_write(haptics->regmap, AW8695_RAMADDRH,
+		FIELD_GET(AW8695_HIGH_MASK, AW8695_RAM_BASE_ADDR));
+	if (err)
+		return err;
+	err = regmap_write(haptics->regmap, AW8695_RAMADDRL,
+		FIELD_GET(AW8695_LOW_MASK, AW8695_RAM_BASE_ADDR));
+	if (err)
+		return err;
+
+	/* Write waveform header */
+	ptr = (unsigned char *) &sram_waveform_header;
+	for (i = 0; i < sizeof(sram_waveform_header); i++) {
+		err = regmap_write(haptics->regmap, AW8695_RAMDATA,
+			ptr[i]);
+		if (err)
+			return err;
+	}
+
+	/* Write waveform data */
+	for (i = 0; i < ARRAY_SIZE(aw8695_sine_waveform); i++) {
+		err = regmap_write(haptics->regmap, AW8695_RAMDATA,
+			aw8695_sine_waveform[i]);
+		if (err)
+			return err;
+	}
+
+	/* Disable SRAM init */
+	return regmap_update_bits(haptics->regmap, AW8695_SYSCTRL,
+		AW8695_SYSCTRL_RAMINIT_EN, 0);
+}
+
+static irqreturn_t aw8695_irq(int irq, void *data)
+{
+	struct aw8695_data *haptics = data;
+	struct device *dev = &haptics->client->dev;
+	unsigned int read_buf;
+	int err;
+
+	err = regmap_read(haptics->regmap, AW8695_SYSINT, &read_buf);
+	if (err) {
+		dev_err(dev, "Failed to read SYSINT register: %d\n", err);
+		return err;
+	}
+	dev_dbg(dev, "Interrupt: SYSINT=0x%x\n", read_buf);
+
+	if (read_buf & AW8695_SYSINT_BSTERRI)
+		dev_err(dev, "Received boost short circuit protection or over-voltage protection interrupt!\n");
+	if (read_buf & AW8695_SYSINT_OVI)
+		dev_err(dev, "Received wave data overflow or DPWM DC error interrupt!\n");
+	if (read_buf & AW8695_SYSINT_UVLI)
+		dev_err(dev, "Received under voltage lock out interrupt!\n");
+	if (read_buf & AW8695_SYSINT_OCDI)
+		dev_err(dev, "Received over current interrupt!\n");
+	if (read_buf & AW8695_SYSINT_OTI)
+		dev_err(dev, "Received over temperature interrupt!\n");
+
+	if (read_buf & AW8695_SYSINT_DONEI)
+		dev_dbg(dev, "Received playback done interrupt\n");
+	/* FIFO mode is not (yet) implemented in this driver */
+	if (read_buf & AW8695_SYSINT_FF_AEI)
+		dev_dbg(dev, "Received FIFO almost empty interrupt\n");
+	if (read_buf & AW8695_SYSINT_FF_AFI)
+		dev_dbg(dev, "Received FIFO almost full interrupt\n");
+
+	err = regmap_read(haptics->regmap, AW8695_DBGSTAT, &read_buf);
+	if (err) {
+		dev_err(dev, "Failed to read DBGSTAT register: %d\n", err);
+		return err;
+	}
+	dev_dbg(dev, "Interrupt: DBGSTAT=0x%x\n", read_buf);
+
+	err = regmap_read(haptics->regmap, AW8695_SYSST, &read_buf);
+	if (err) {
+		dev_err(dev, "Failed to read SYSST register: %d\n", err);
+		return err;
+	}
+	dev_dbg(dev, "Interrupt: SYSST=0x%x\n", read_buf);
+
+	return IRQ_HANDLED;
+}
+
+static const struct regmap_config aw8695_regmap_config = {
+	.reg_bits = 8,
+	.val_bits = 8,
+
+	.max_register = AW8695_MAX_REG,
+	.cache_type = REGCACHE_NONE,
+};
+
+static int aw8695_probe(struct i2c_client *client,
+			const struct i2c_device_id *id)
+{
+	struct device *dev = &client->dev;
+	struct aw8695_data *haptics;
+	int err;
+
+	haptics = devm_kzalloc(dev, sizeof(*haptics), GFP_KERNEL);
+	if (!haptics)
+		return -ENOMEM;
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-preset", &haptics->f0_preset);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,f0-preset\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-coefficient",
+				   &haptics->f0_coefficient);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,f0-coefficient\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-calibration-percent",
+				   &haptics->f0_cali_percent);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,f0-coefficient\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,drive-level", &haptics->drive_level);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,drive-level\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-detection-play-time",
+				   &haptics->f0_det_play);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,f0-detection-play-time\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-detection-wait-time",
+				   &haptics->f0_det_wait);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,f0-detection-wait-time\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-detection-repeat",
+				   &haptics->f0_det_repeat);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,f0-detection-repeat\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,f0-detection-trace",
+				   &haptics->f0_det_trace);
+	if (err)
+		dev_err_probe(dev, err, "Failed to read awinic,f0-detection-trace\n");
+
+	err = of_property_read_u8_array(dev->of_node, "awinic,boost-debug",
+					haptics->boost_debug, ARRAY_SIZE(haptics->boost_debug));
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,boost-debug\n");
+
+	err = of_property_read_u8(dev->of_node, "awinic,tset", &haptics->tset);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,tset\n");
+
+	err = of_property_read_u8(dev->of_node, "awinic,r-spare", &haptics->r_spare);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,r-spare\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,bemf-upper-threshold",
+				   &haptics->bemf_vthh);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,bemf-upper-threshold\n");
+
+	err = of_property_read_u32(dev->of_node, "awinic,bemf-lower-threshold",
+				   &haptics->bemf_vthl);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to read awinic,bemf-lower-threshold\n");
+
+	haptics->input_dev = devm_input_allocate_device(dev);
+	if (!haptics->input_dev)
+		return -ENOMEM;
+
+	haptics->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
+	if (IS_ERR(haptics->reset_gpio))
+		return dev_err_probe(dev, PTR_ERR(haptics->reset_gpio),
+				     "Failed to get reset gpio\n");
+
+	err = devm_request_threaded_irq(dev, client->irq, NULL, aw8695_irq,
+		IRQF_ONESHOT, NULL, haptics);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to request interrupt\n");
+
+	INIT_WORK(&haptics->play_work, aw8695_haptics_play_work);
+
+	haptics->input_dev->name = "aw8695-haptics";
+	haptics->input_dev->close = aw8695_close;
+
+	input_set_drvdata(haptics->input_dev, haptics);
+	input_set_capability(haptics->input_dev, EV_FF, FF_RUMBLE);
+
+	err = input_ff_create_memless(haptics->input_dev, NULL,
+				      aw8695_haptics_play);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to create FF dev\n");
+
+	haptics->client = client;
+	i2c_set_clientdata(client, haptics);
+
+	haptics->regmap = devm_regmap_init_i2c(client, &aw8695_regmap_config);
+	if (IS_ERR(haptics->regmap))
+		return dev_err_probe(dev, PTR_ERR(haptics->regmap),
+				     "Failed to allocate register map\n");
+
+	err = aw8695_init(haptics);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to init aw8695\n");
+
+	err = aw8695_ram_init(haptics);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to init aw8695 sram\n");
+
+	err = input_register_device(haptics->input_dev);
+	if (err)
+		return dev_err_probe(dev, err, "Failed to register input device\n");
+
+	return 0;
+}
+
+static const struct of_device_id aw8695_of_id[] = {
+	{ .compatible = "awinic,aw8695", },
+	{ /* sentinel */ }
+};
+
+MODULE_DEVICE_TABLE(of, aw8695_of_id);
+
+static struct i2c_driver aw8695_driver = {
+	.driver = {
+		.name = "aw8695-haptics",
+		.of_match_table = aw8695_of_id,
+	},
+	.probe = aw8695_probe,
+};
+
+module_i2c_driver(aw8695_driver);
+
+MODULE_AUTHOR("Luca Weiss <luca.weiss@fairphone.com>");
+MODULE_DESCRIPTION("AW8695 LRA Haptic Driver");
+MODULE_LICENSE("GPL");
-- 
2.35.1