160 lines
6.0 KiB
C
160 lines
6.0 KiB
C
|
/* Copyright (c) 2015, The Linux Foundation. All rights reserved.
|
||
|
|
*
|
||
|
|
* Redistribution and use in source and binary forms, with or without
|
||
|
|
* modification, are permitted provided that the following conditions are
|
||
|
|
* met:
|
||
|
|
* * Redistributions of source code must retain the above copyright
|
||
|
|
* notice, this list of conditions and the following disclaimer.
|
||
|
|
* * Redistributions in binary form must reproduce the above
|
||
|
|
* copyright notice, this list of conditions and the following
|
||
|
|
* disclaimer in the documentation and/or other materials provided
|
||
|
|
* with the distribution.
|
||
|
|
* * Neither the name of The Linux Foundation nor the names of its
|
||
|
|
* contributors may be used to endorse or promote products derived
|
||
|
|
* from this software without specific prior written permission.
|
||
|
|
*
|
||
|
|
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
||
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
|
||
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
|
||
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
||
|
|
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
||
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
|
||
|
|
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
|
||
|
|
* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <spmi.h>
|
||
|
|
#include <platform/iomap.h>
|
||
|
|
#include <pm_vib.h>
|
||
|
|
#include <target.h>
|
||
|
|
#include <vibrator.h>
|
||
|
|
|
||
|
|
#define HAPTIC_BASE (PMI_SECOND_SLAVE_ADDR_BASE+ 0xC000)
|
||
|
|
#define QPNP_HAP_EN_CTL_REG (HAPTIC_BASE + 0x46)
|
||
|
|
#define QPNP_HAP_EN_CTL2_REG (HAPTIC_BASE + 0x48)
|
||
|
|
#define QPNP_HAP_ACT_TYPE_REG (HAPTIC_BASE + 0x4C)
|
||
|
|
#define QPNP_HAP_WAV_SHAPE_REG (HAPTIC_BASE + 0x4D)
|
||
|
|
#define QPNP_HAP_PLAY_MODE_REG (HAPTIC_BASE + 0x4E)
|
||
|
|
#define QPNP_HAP_LRA_AUTO_RES_REG (HAPTIC_BASE + 0x4F)
|
||
|
|
#define QPNP_HAP_VMAX_REG (HAPTIC_BASE + 0x51)
|
||
|
|
#define QPNP_HAP_ILIM_REG (HAPTIC_BASE + 0x52)
|
||
|
|
#define QPNP_HAP_SC_DEB_REG (HAPTIC_BASE + 0x53)
|
||
|
|
#define QPNP_HAP_RATE_CFG1_REG (HAPTIC_BASE + 0x54)
|
||
|
|
#define QPNP_HAP_RATE_CFG2_REG (HAPTIC_BASE + 0x55)
|
||
|
|
#define QPNP_HAP_INT_PWM_REG (HAPTIC_BASE + 0x56)
|
||
|
|
#define QPNP_HAP_PWM_CAP_REG (HAPTIC_BASE + 0x58)
|
||
|
|
#define QPNP_HAP_BRAKE_REG (HAPTIC_BASE + 0x5C)
|
||
|
|
#define QPNP_HAP_PLAY_REG (HAPTIC_BASE + 0x70)
|
||
|
|
|
||
|
|
#define QPNP_HAP_ACT_TYPE_MASK 0x01
|
||
|
|
#define QPNP_HAP_PLAY_MODE_MASK 0x3F
|
||
|
|
#define QPNP_HAP_DIRECT 0x0
|
||
|
|
#define QPNP_HAP_VMAX_MASK 0x3F
|
||
|
|
#define QPNP_HAP_VMAX 0x22
|
||
|
|
#define QPNP_HAP_ILIM_MASK 0x01
|
||
|
|
#define QPNP_HAP_ILIM 0x01
|
||
|
|
#define QPNP_HAP_SC_DEB_MASK 0x07
|
||
|
|
#define QPNP_HAP_SC_DEB_8CLK 0x01
|
||
|
|
#define QPNP_HAP_INT_PWM_MASK 0x03
|
||
|
|
#define QPNP_HAP_INT_PWM_505KHZ 0x01
|
||
|
|
#define QPNP_HAP_WAV_SHAPE_MASK 0x01
|
||
|
|
#define QPNP_HAP_WAV_SHAPE_SQUARE 0x01
|
||
|
|
#define QPNP_HAP_PWM_CAP_MASK 0x03
|
||
|
|
#define QPNP_HAP_PWM_CAP_13PF 0x01
|
||
|
|
#define QPNP_HAP_RATE_CFG1_MASK 0xFF
|
||
|
|
#define QPNP_HAP_RATE_CFG1_7_0 0x1C
|
||
|
|
#define QPNP_HAP_RATE_CFG2_MASK 0x0F
|
||
|
|
#define QPNP_HAP_RATE_CFG2_11_8 0x04
|
||
|
|
#define QPNP_HAP_EN_BRAKE_EN_MASK 0x01
|
||
|
|
#define QPNP_HAP_EN_BRAKING_EN 0x01
|
||
|
|
#define QPNP_HAP_BRAKE_VMAX_MASK 0xFF
|
||
|
|
#define QPNP_HAP_BRAKE_VMAX 0xF
|
||
|
|
#define QPNP_HAP_ERM 0x1
|
||
|
|
#define QPNP_HAP_LRA 0x0
|
||
|
|
#define QPNP_HAP_PLAY_MASK 0x80
|
||
|
|
#define QPNP_HAP_PLAY_EN 0x80
|
||
|
|
#define QPNP_HAP_MASK 0x80
|
||
|
|
#define QPNP_HAP_EN 0x80
|
||
|
|
#define QPNP_HAP_PLAY_DIS 0x00
|
||
|
|
#define QPNP_HAP_DIS 0x00
|
||
|
|
#define QPNP_HAP_BRAKE_MASK 0xFE
|
||
|
|
#define QPNP_HAP_LRA_AUTO_DISABLE 0x00
|
||
|
|
#define QPNP_HAP_LRA_AUTO_MASK 0x70
|
||
|
|
|
||
|
|
/* Turn on vibrator */
|
||
|
|
void pm_vib_turn_on(void)
|
||
|
|
{
|
||
|
|
uint32_t vib_type = VIB_ERM_TYPE;
|
||
|
|
vib_type = get_vibration_type();
|
||
|
|
/* Configure the ACTUATOR TYPE register as ERM*/
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_ACT_TYPE_REG,
|
||
|
|
QPNP_HAP_ACT_TYPE_MASK,
|
||
|
|
VIB_ERM_TYPE == vib_type ? QPNP_HAP_ERM
|
||
|
|
: QPNP_HAP_LRA);
|
||
|
|
|
||
|
|
/* Disable auto resonance for ERM */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_LRA_AUTO_RES_REG,
|
||
|
|
QPNP_HAP_LRA_AUTO_MASK,
|
||
|
|
QPNP_HAP_LRA_AUTO_DISABLE);
|
||
|
|
|
||
|
|
/* Configure the PLAY MODE register as direct*/
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_PLAY_MODE_REG,
|
||
|
|
QPNP_HAP_PLAY_MODE_MASK,
|
||
|
|
QPNP_HAP_DIRECT);
|
||
|
|
|
||
|
|
/* Configure the VMAX register */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_VMAX_REG,
|
||
|
|
QPNP_HAP_VMAX_MASK, QPNP_HAP_VMAX);
|
||
|
|
|
||
|
|
/* Sets current limit to 800mA*/
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_ILIM_REG,
|
||
|
|
QPNP_HAP_ILIM_MASK, QPNP_HAP_ILIM);
|
||
|
|
|
||
|
|
/* Configure the short circuit debounce register as DEB_8CLK*/
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_SC_DEB_REG,
|
||
|
|
QPNP_HAP_SC_DEB_MASK, QPNP_HAP_SC_DEB_8CLK);
|
||
|
|
|
||
|
|
/* Configure the INTERNAL_PWM register as 505KHZ and 13PF*/
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_INT_PWM_REG,
|
||
|
|
QPNP_HAP_INT_PWM_MASK, QPNP_HAP_INT_PWM_505KHZ);
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_PWM_CAP_REG,
|
||
|
|
QPNP_HAP_PWM_CAP_MASK, QPNP_HAP_PWM_CAP_13PF);
|
||
|
|
|
||
|
|
/* Configure the WAVE SHAPE register as SQUARE*/
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_WAV_SHAPE_REG,
|
||
|
|
QPNP_HAP_WAV_SHAPE_MASK, QPNP_HAP_WAV_SHAPE_SQUARE);
|
||
|
|
|
||
|
|
/* Configure RATE_CFG1 and RATE_CFG2 registers for haptic rate. */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_RATE_CFG1_REG,
|
||
|
|
QPNP_HAP_RATE_CFG1_MASK, QPNP_HAP_RATE_CFG1_7_0);
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_RATE_CFG2_REG,
|
||
|
|
QPNP_HAP_RATE_CFG2_MASK, QPNP_HAP_RATE_CFG2_11_8);
|
||
|
|
|
||
|
|
/* Configure BRAKE register, PATTERN1 & PATTERN2 as VMAX. */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_EN_CTL2_REG,
|
||
|
|
QPNP_HAP_EN_BRAKE_EN_MASK, QPNP_HAP_EN_BRAKING_EN);
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_BRAKE_REG,
|
||
|
|
QPNP_HAP_BRAKE_VMAX_MASK, QPNP_HAP_BRAKE_VMAX);
|
||
|
|
|
||
|
|
/* Enable control register */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_EN_CTL_REG,
|
||
|
|
QPNP_HAP_PLAY_MASK, QPNP_HAP_PLAY_EN);
|
||
|
|
|
||
|
|
/* Enable play register */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_PLAY_REG, QPNP_HAP_MASK, QPNP_HAP_EN);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Turn off vibrator */
|
||
|
|
void pm_vib_turn_off(void)
|
||
|
|
{
|
||
|
|
/* Disable control register */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_EN_CTL_REG,
|
||
|
|
QPNP_HAP_PLAY_MASK, QPNP_HAP_PLAY_DIS);
|
||
|
|
|
||
|
|
/* Disable play register */
|
||
|
|
pmic_spmi_reg_mask_write(QPNP_HAP_PLAY_REG, QPNP_HAP_MASK, QPNP_HAP_DIS);
|
||
|
|
}
|