aubrey/kernel_samsung_a34x-permissive
1
0
Fork 0
Code Issues Pull requests Actions Packages Projects Releases Wiki Activity
kernel_samsung_a34x-permissive/sound/soc/codecs/mt6357-accdet.c
Fede2782 6db4831e98
Import A346BXXU4BWK2 kernel source 
Android 14
2024-04-28 15:51:13 +02:00

2447 lines
67 KiB
C
Raw Blame History

// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (C) 2019 MediaTek Inc.
* Author: Argus Lin <argus.lin@mediatek.com>
*/
#define DEBUG
#include <linux/of_gpio.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_device.h>
#include <linux/of_address.h>
#include <linux/input.h>
#include <linux/kthread.h>
#include <linux/io.h>
#include <linux/sched/clock.h>
#include <linux/workqueue.h>
#include <linux/timer.h>
#include <linux/delay.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/iio/consumer.h>
#include <linux/nvmem-consumer.h>
#include <linux/init.h>
#include <linux/irqdomain.h>
#include <linux/irq.h>
#include <linux/regmap.h>
#include <sound/soc.h>
#include <sound/jack.h>
#include <linux/mfd/mt6357/registers.h>
#include <linux/mfd/mt6397/core.h>
#include <linux/mfd/mt6357/core.h>
#include "mt6357-accdet.h"
#include "mt6357.h"
#ifdef CONFIG_SND_SOC_SAMSUNG_AUDIO
#include "../samsung/sec_accdet_sysfs_cb.h"
#endif
/* grobal variable definitions */
#define NO_USE_COMPARATOR 1
#if NO_USE_COMPARATOR
/* for headset pole type definition */
#define TYPE_AB_00 (0x00)/* 3-pole or hook_switch */
#define TYPE_AB_01 (0x01)/* 4-pole */
#define TYPE_AB_11 (0x03)/* plug-out */
#define TYPE_AB_10 (0x02)/* Illegal state */
struct Vol_Set {/* mv */
unsigned int vol_min_3pole;
unsigned int vol_max_3pole;
unsigned int vol_min_4pole;
unsigned int vol_max_4pole;
unsigned int vol_bias;/* >2500: 2800; others: 2500 */
};
static struct Vol_Set cust_vol_set;
#endif
#define REGISTER_VAL(x) (x - 1)
#define HAS_CAP(_c, _x) (((_c) & (_x)) == (_x))
#define ACCDET_PMIC_EINT_IRQ BIT(0)
#define ACCDET_AP_GPIO_EINT BIT(1)
#define ACCDET_PMIC_EINT0 BIT(2)
#define ACCDET_PMIC_EINT1 BIT(3)
#define ACCDET_PMIC_BI_EINT BIT(4)
#define ACCDET_PMIC_GPIO_TRIG_EINT BIT(5)
#define ACCDET_PMIC_INVERTER_TRIG_EINT BIT(6)
#define ACCDET_PMIC_RSV_EINT BIT(7)
#define ACCDET_THREE_KEY BIT(8)
#define ACCDET_FOUR_KEY BIT(9)
#define ACCDET_TRI_KEY_CDD BIT(10)
#define ACCDET_RSV_KEY BIT(11)
#define ACCDET_ANALOG_FASTDISCHARGE BIT(12)
#define ACCDET_DIGITAL_FASTDISCHARGE BIT(13)
#define ACCDET_AD_FASTDISCHRAGE BIT(14)
#define ACCDET_MOISTURE_DETECTED BIT(15)
#define RET_LT_5K (-1)
#define RET_GT_5K (0)
/* Used to let accdet know if the pin has been fully plugged-in */
#define EINT_PLUG_OUT (0)
#define EINT_PLUG_IN (1)
#define EINT_MOISTURE_DETECTED (2)
#define EINT_THING_IN (3)
struct mt63xx_accdet_data {
struct snd_soc_jack jack;
struct platform_device *pdev;
struct device *dev;
struct accdet_priv *data;
atomic_t init_once;
struct regmap *regmap;
struct iio_channel *accdet_auxadc;
struct nvmem_device *accdet_efuse;
int accdet_irq;
int accdet_eint0;
int accdet_eint1;
struct wakeup_source *wake_lock;
struct wakeup_source *timer_lock;
struct mutex res_lock;
dev_t accdet_devno;
struct class *accdet_class;
int button_status;
bool eint_sync_flag;
/* accdet FSM State & lock*/
u32 cur_eint_state;
u32 eint0_state;
u32 eint1_state;
u32 accdet_status;
u32 cable_type;
u32 cur_key;
u32 cali_voltage;
int auxadc_offset;
u32 eint_id;
bool thing_in_flag;
/* when caps include ACCDET_AP_GPIO_EINT */
struct pinctrl *pinctrl;
struct pinctrl_state *pins_eint;
u32 gpiopin;
u32 gpio_hp_deb;
u32 gpioirq;
u32 accdet_eint_type;
/* when MICBIAS_DISABLE_TIMER timeout, queue work: dis_micbias_work */
struct work_struct delay_init_work;
struct workqueue_struct *delay_init_workqueue;
struct work_struct dis_micbias_work;
struct workqueue_struct *dis_micbias_workqueue;
struct work_struct accdet_work;
struct workqueue_struct *accdet_workqueue;
/* when eint issued, queue work: eint_work */
struct work_struct eint_work;
struct workqueue_struct *eint_workqueue;
u32 water_r;
u32 moisture_ext_r;
u32 moisture_int_r;
u32 moisture_vm;
u32 moisture_vdd_offset;
u32 moisture_offset;
u32 moisture_eint_offset;
};
static struct mt63xx_accdet_data *accdet;
static struct head_dts_data accdet_dts;
struct pwm_deb_settings *cust_pwm_deb;
struct accdet_priv {
u32 caps;
};
static struct accdet_priv mt6357_accdet[] = {
{
.caps = 0,
},
};
const struct of_device_id accdet_of_match[] = {
{
.compatible = "mediatek,mt6357-accdet",
.data = &mt6357_accdet,
}, {
.compatible = "mediatek,mt8163-accdet",
}, {
.compatible = "mediatek,mt8173-accdet",
}, {
/* sentinel */
},
};
static struct platform_driver accdet_driver;
static const struct snd_soc_component_driver accdet_soc_driver;
static atomic_t accdet_first;
#define ACCDET_INIT_WAIT_TIMER (10 * HZ)
static struct timer_list accdet_init_timer;
static void delay_init_timerhandler(struct timer_list *t);
/* micbias_timer: disable micbias if no accdet irq after eint,
* timeout: 6 seconds
* timerHandler: dis_micbias_timerhandler()
*/
#define MICBIAS_DISABLE_TIMER (6 * HZ)
static struct timer_list micbias_timer;
static void dis_micbias_timerhandler(struct timer_list *t);
#define ACCDET_OPEN_CABLE_TIMER (1 * HZ)
static struct timer_list accdet_open_cable_timer;
static void check_open_cable_timerhandler(struct timer_list *t);
static int moisture_ver = 0xff;
static bool dis_micbias_done;
static char accdet_log_buf[1280];
static bool debug_thread_en;
static bool dump_reg;
static struct task_struct *thread;
#ifdef CONFIG_SND_SOC_SAMSUNG_AUDIO
static struct accdet_data accdet_pdata;
#endif
static u32 button_press_debounce = 0x400;
/* local function declaration */
static void accdet_init_once(void);
static inline void accdet_init(void);
static void accdet_init_debounce(void);
static void config_eint_init_by_mode(void);
static u32 get_triggered_eint(void);
static void send_status_event(u32 cable_type, u32 status);
static inline void check_cable_type(void);
#if NO_USE_COMPARATOR
static unsigned int check_pole_type(void);
#endif
/* global function declaration */
inline u32 accdet_read(u32 addr)
{
u32 val = 0;
regmap_read(accdet->regmap, addr, &val);
return val;
}
inline u32 accdet_read_bits(u32 addr, u32 shift, u32 mask)
{
u32 val = 0;
val = accdet_read(addr);
return ((val>>shift) & mask);
}
inline void accdet_write(u32 addr, u32 wdata)
{
regmap_write(accdet->regmap, addr, wdata);
}
inline void accdet_update_bits(u32 addr, u32 shift, u32 mask, u32 data)
{
regmap_update_bits(accdet->regmap, addr, mask << shift,
data << shift);
}
inline void accdet_update_bit(u32 addr, u32 shift)
{
unsigned int mask = shift;
regmap_update_bits(accdet->regmap, addr, BIT(mask),
BIT(shift));
}
inline void accdet_clear_bits(u32 addr, u32 shift, u32 mask, u32 data)
{
regmap_update_bits(accdet->regmap, addr, mask << shift, 0);
}
inline void accdet_clear_bit(u32 addr, u32 shift)
{
unsigned int mask = shift;
regmap_update_bits(accdet->regmap, addr, BIT(mask), 0);
}
static void dump_register(void)
{
int addr = 0, st_addr = 0, end_addr = 0, idx = 0;
pr_notice("Accdet EINTx support,MODE_%d regs:\n", accdet_dts.mic_mode);
st_addr = RG_AUDACCDETRSV_ADDR;
end_addr = ACCDET_EINT1_CUR_DEB_ADDR;
for (addr = st_addr; addr <= end_addr; addr += 8) {
idx = addr;
pr_notice("(0x%x)=0x%x (0x%x)=0x%x ",
idx, accdet_read(idx),
idx+2, accdet_read(idx+2));
pr_notice("(0x%x)=0x%x (0x%x)=0x%x\n",
idx+4, accdet_read(idx+4),
idx+6, accdet_read(idx+6));
}
pr_notice("(0x%x)=0x%x (0x%x)=0x%x (0x%x)=0x%x (0x%x)=0x%x\n",
RG_RTC32K_CK_PDN_ADDR,
accdet_read(RG_RTC32K_CK_PDN_ADDR),
RG_ACCDET_CK_PDN_ADDR,
accdet_read(RG_ACCDET_CK_PDN_ADDR),
RG_ACCDET_RST_ADDR,
accdet_read(RG_ACCDET_RST_ADDR),
RG_INT_EN_ACCDET_ADDR,
accdet_read(RG_INT_EN_ACCDET_ADDR));
pr_notice("(0x%x)=0x%x (0x%x)=0x%x (0x%x)=0x%x (0x%x)=0x%x\n",
RG_INT_MASK_ACCDET_ADDR,
accdet_read(RG_INT_MASK_ACCDET_ADDR),
RG_INT_STATUS_ACCDET_ADDR,
accdet_read(RG_INT_STATUS_ACCDET_ADDR),
RG_AUDACCDETMICBIAS1PULLLOW_ADDR,
accdet_read(RG_AUDACCDETMICBIAS1PULLLOW_ADDR),
RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR));
pr_notice("(0x%x)=0x%x (0x%x)=0x%x\n",
AUXADC_RQST_CH0_ADDR,
accdet_read(AUXADC_RQST_CH0_ADDR),
AUXADC_ACCDET_AUTO_SPL_ADDR,
accdet_read(AUXADC_ACCDET_AUTO_SPL_ADDR));
pr_notice("accdet_dts:deb0=0x%x,deb1=0x%x,deb3=0x%x,deb4=0x%x\n",
cust_pwm_deb->debounce0, cust_pwm_deb->debounce1,
cust_pwm_deb->debounce3, cust_pwm_deb->debounce4);
}
static void cat_register(char *buf)
{
int addr = 0, st_addr = 0, end_addr = 0, idx = 0, ret = 0;
ret = sprintf(accdet_log_buf, "[Accdet EINTx support][MODE_%d]regs:\n",
accdet_dts.mic_mode);
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
st_addr = RG_AUDACCDETRSV_ADDR;
end_addr = ACCDET_EINT1_CUR_DEB_ADDR;
for (addr = st_addr; addr <= end_addr; addr += 8) {
idx = addr;
ret = sprintf(accdet_log_buf,
"(0x%x)=0x%x (0x%x)=0x%x (0x%x)=0x%x (0x%x)=0x%x\n",
idx, accdet_read(idx),
idx+2, accdet_read(idx+2),
idx+4, accdet_read(idx+4),
idx+6, accdet_read(idx+6));
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
}
ret = sprintf(accdet_log_buf, "[0x%x]=0x%x\n",
RG_RTC32K_CK_PDN_ADDR,
accdet_read(RG_RTC32K_CK_PDN_ADDR));
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
ret = sprintf(accdet_log_buf, "[0x%x]=0x%x\n",
RG_ACCDET_RST_ADDR,
accdet_read(RG_ACCDET_RST_ADDR));
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
ret = sprintf(accdet_log_buf, "[0x%x]=0x%x, [0x%x]=0x%x, [0x%x]=0x%x\n",
RG_INT_EN_ACCDET_ADDR,
accdet_read(RG_INT_EN_ACCDET_ADDR),
RG_INT_MASK_ACCDET_ADDR,
accdet_read(RG_INT_MASK_ACCDET_ADDR),
RG_INT_STATUS_ACCDET_ADDR,
accdet_read(RG_INT_STATUS_ACCDET_ADDR));
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
ret = sprintf(accdet_log_buf, "[0x%x]=0x%x, [0x%x]=0x%x\n",
AUXADC_RQST_CH5_ADDR,
accdet_read(AUXADC_RQST_CH5_ADDR),
AUXADC_ACCDET_AUTO_SPL_ADDR,
accdet_read(AUXADC_ACCDET_AUTO_SPL_ADDR));
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
ret = sprintf(accdet_log_buf,
"dtsInfo:deb0=0x%x,deb1=0x%x,deb3=0x%x,deb4=0x%x\n",
cust_pwm_deb->debounce0, cust_pwm_deb->debounce1,
cust_pwm_deb->debounce3, cust_pwm_deb->debounce4);
if (ret < 0)
pr_notice("sprintf failed\n");
strncat(buf, accdet_log_buf, strlen(accdet_log_buf));
}
static int dbug_thread(void *unused)
{
dump_register();
return 0;
}
static ssize_t start_debug_store(struct device_driver *ddri,
const char *buf, size_t count)
{
int error = 0;
int ret = 0;
if (strlen(buf) < 1) {
pr_notice("%s() Invalid input!!\n", __func__);
return -EINVAL;
}
ret = strncmp(buf, "0", 1);
/* fix syzkaller issue */
if (debug_thread_en == true) {
pr_info("%s() debug thread started, ret!\n", __func__);
return count;
}
if (ret) {
debug_thread_en = true;
thread = kthread_run(dbug_thread, 0, "ACCDET");
if (IS_ERR(thread)) {
error = PTR_ERR(thread);
pr_notice("%s() create thread failed,err:%d\n",
__func__, error);
} else
pr_info("%s() start debug thread!\n", __func__);
} else {
debug_thread_en = false;
pr_info("%s() stop debug thread!\n", __func__);
}
return count;
}
static ssize_t set_reg_store(struct device_driver *ddri,
const char *buf, size_t count)
{
int ret = 0;
u32 addr_tmp = 0;
u32 value_tmp = 0;
if (strlen(buf) < 3) {
pr_notice("%s() Invalid input!!\n", __func__);
return -EINVAL;
}
ret = sscanf(buf, "0x%x,0x%x", &addr_tmp, &value_tmp);
if (ret < 0)
return ret;
pr_info("%s() set addr[0x%x]=0x%x\n", __func__, addr_tmp, value_tmp);
if (addr_tmp < TOP0_ANA_ID_ADDR)
pr_notice("%s() Illegal addr[0x%x]!!\n", __func__, addr_tmp);
else
accdet_write(addr_tmp, value_tmp);
return count;
}
static ssize_t dump_reg_show(struct device_driver *ddri, char *buf)
{
if (buf == NULL) {
pr_notice("%s() *buf is NULL\n", __func__);
return -EINVAL;
}
cat_register(buf);
pr_info("%s() buf_size:%d\n", __func__, (int)strlen(buf));
return strlen(buf);
}
static ssize_t dump_reg_store(struct device_driver *ddri,
const char *buf, size_t count)
{
int ret = 0;
if (strlen(buf) < 1) {
pr_notice("%s() Invalid input!!\n", __func__);
return -EINVAL;
}
ret = strncmp(buf, "0", 1);
if (ret) {
dump_reg = true;
pr_info("%s() start dump regs!\n", __func__);
} else {
dump_reg = false;
pr_info("%s() stop dump regs!\n", __func__);
}
return count;
}
static ssize_t set_headset_mode_store(struct device_driver *ddri,
const char *buf, size_t count)
{
int ret = 0;
int tmp_headset_mode = 0;
if (strlen(buf) < 1) {
pr_notice("%s() Invalid input!\n", __func__);
return -EINVAL;
}
ret = kstrtoint(buf, 10, &tmp_headset_mode);
if (ret < 0) {
pr_notice("%s() kstrtoint failed! ret:%d\n", __func__, ret);
return ret;
}
pr_info("%s() get mic mode: %d\n", __func__, tmp_headset_mode);
switch (tmp_headset_mode&0x0F) {
case HEADSET_MODE_1:
pr_info("%s() Don't support switch to mode_1!\n", __func__);
/* accdet_dts.mic_mode = tmp_headset_mode; */
/* accdet_init(); */
break;
case HEADSET_MODE_2:
accdet_dts.mic_mode = tmp_headset_mode;
accdet_init();
break;
case HEADSET_MODE_6:
accdet_dts.mic_mode = tmp_headset_mode;
accdet_init();
break;
default:
pr_info("%s() Invalid mode: %d\n", __func__, tmp_headset_mode);
break;
}
accdet_init_once();
return count;
}
static ssize_t state_show(struct device_driver *ddri, char *buf)
{
char temp_type = (char)accdet->cable_type;
int ret = 0;
if (buf == NULL) {
pr_notice("[%s] *buf is NULL!\n", __func__);
return -EINVAL;
}
ret = snprintf(buf, 3, "%d\n", temp_type);
if (ret < 0)
pr_notice("snprintf failed\n");
return strlen(buf);
}
static DRIVER_ATTR_WO(start_debug);
static DRIVER_ATTR_WO(set_reg);
static DRIVER_ATTR_RW(dump_reg);
static DRIVER_ATTR_WO(set_headset_mode);
static DRIVER_ATTR_RO(state);
static struct driver_attribute *accdet_attr_list[] = {
&driver_attr_start_debug,
&driver_attr_set_reg,
&driver_attr_dump_reg,
&driver_attr_set_headset_mode,
&driver_attr_state,
};
static int accdet_create_attr(struct device_driver *driver)
{
int idx, err;
int num = ARRAY_SIZE(accdet_attr_list);
if (driver == NULL)
return -EINVAL;
for (idx = 0; idx < num; idx++) {
err = driver_create_file(driver, accdet_attr_list[idx]);
if (err) {
pr_notice("%s() driver_create_file %s err:%d\n",
__func__, accdet_attr_list[idx]->attr.name, err);
break;
}
}
return err;
}
/* get plug-in Resister for audio call */
int accdet_read_audio_res(unsigned int res_value)
{
pr_info("%s() resister value: R=%u(ohm)\n", __func__, res_value);
/* if res < 5k ohm normal device; res >= 5k ohm, lineout device */
if (res_value < 5000)
return RET_LT_5K;
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
accdet->cable_type = LINE_OUT_DEVICE;
accdet->accdet_status = LINE_OUT;
send_status_event(accdet->cable_type, 1);
pr_info("%s() update state:%d\n", __func__, accdet->cable_type);
}
mutex_unlock(&accdet->res_lock);
return RET_GT_5K;
}
EXPORT_SYMBOL(accdet_read_audio_res);
static u64 accdet_get_current_time(void)
{
return sched_clock();
}
static bool accdet_timeout_ns(u64 start_time_ns, u64 timeout_time_ns)
{
u64 cur_time = 0;
u64 elapse_time = 0;
/* get current tick, ns */
cur_time = accdet_get_current_time();
if (cur_time < start_time_ns) {
start_time_ns = cur_time;
/* 400us */
timeout_time_ns = 400 * 1000;
}
elapse_time = cur_time - start_time_ns;
/* check if timeout */
if (timeout_time_ns <= elapse_time)
return false;
return true;
}
static u32 accdet_get_auxadc(void)
{
int vol = 0, ret = 0;
if (!IS_ERR(accdet->accdet_auxadc)) {
ret = iio_read_channel_processed(accdet->accdet_auxadc, &vol);
if (ret < 0) {
pr_notice("Error: %s read fail (%d)\n", __func__, ret);
return ret;
}
}
pr_info("%s() vol_val:%d offset:%d real vol:%d mv!\n", __func__, vol,
accdet->auxadc_offset,
(vol < accdet->auxadc_offset) ? 0 : (vol-accdet->auxadc_offset));
if (vol < accdet->auxadc_offset)
vol = 0;
else
vol -= accdet->auxadc_offset;
return vol;
}
static void accdet_get_efuse(void)
{
unsigned short efuseval = 0;
int ret = 0;
int tmp_div;
unsigned int moisture_eint0;
unsigned int moisture_eint1;
/* accdet offset efuse:
* this efuse must divided by 2
*/
ret = nvmem_device_read(accdet->accdet_efuse, 82*2, 2, &efuseval);
accdet->auxadc_offset = efuseval & 0xFF;
if (accdet->auxadc_offset > 128)
accdet->auxadc_offset -= 256;
accdet->auxadc_offset = (accdet->auxadc_offset >> 1);
/* all of moisture_vdd/moisture_offset0/eint is 2'complement,
* we need to transfer it
*/
/* moisture vdd efuse offset */
ret = nvmem_device_read(accdet->accdet_efuse, 85*2, 2, &efuseval);
accdet->moisture_vdd_offset =
(int)((efuseval >> 8) & ACCDET_CALI_MASK0);
if (accdet->moisture_vdd_offset > 128)
accdet->moisture_vdd_offset -= 256;
pr_info("%s moisture_vdd efuse=0x%x, moisture_vdd_offset=%d mv\n",
__func__, efuseval, accdet->moisture_vdd_offset);
/* moisture offset */
ret = nvmem_device_read(accdet->accdet_efuse, 86*2, 2, &efuseval);
accdet->moisture_offset = (int)(efuseval & ACCDET_CALI_MASK0);
if (accdet->moisture_offset > 128)
accdet->moisture_offset -= 256;
pr_info("%s moisture_efuse efuse=0x%x,moisture_offset=%d mv\n",
__func__, efuseval, accdet->moisture_offset);
if (accdet_dts.moisture_use_ext_res == 0x0) {
/* moisture eint efuse offset */
ret = nvmem_device_read(accdet->accdet_efuse,
84*2, 2, &efuseval);
moisture_eint0 =
(int)((efuseval >> 8) & ACCDET_CALI_MASK0);
pr_info("%s moisture_eint0 efuse=0x%x,moisture_eint0=0x%x\n",
__func__, efuseval, moisture_eint0);
ret = nvmem_device_read(accdet->accdet_efuse,
85*2, 2, &efuseval);
moisture_eint1 = (int)(efuseval & ACCDET_CALI_MASK0);
pr_info("%s moisture_eint1 efuse=0x%x,moisture_eint1=0x%x\n",
__func__, efuseval, moisture_eint1);
accdet->moisture_eint_offset =
(moisture_eint1 << 8) | moisture_eint0;
if (accdet->moisture_eint_offset > 32768)
accdet->moisture_eint_offset -= 65536;
pr_info("%s moisture_eint_offset=%d ohm\n", __func__,
accdet->moisture_eint_offset);
accdet->moisture_vm = (2800 + accdet->moisture_vdd_offset);
accdet->moisture_vm *=
(accdet->water_r + accdet->moisture_int_r);
tmp_div = accdet->water_r + accdet->moisture_int_r +
8 * accdet->moisture_eint_offset + 450000;
accdet->moisture_vm = accdet->moisture_vm / tmp_div;
accdet->moisture_vm =
accdet->moisture_vm + accdet->moisture_offset / 2;
pr_info("%s internal moisture_vm=%d mv\n", __func__,
accdet->moisture_vm);
} else if (accdet_dts.moisture_use_ext_res == 0x1) {
accdet->moisture_vm = (2800 + accdet->moisture_vdd_offset);
accdet->moisture_vm = accdet->moisture_vm * accdet->water_r;
accdet->moisture_vm /=
(accdet->water_r + accdet->moisture_ext_r);
accdet->moisture_vm +=
(accdet->moisture_offset >> 1);
pr_info("%s external moisture_vm=%d mv\n", __func__,
accdet->moisture_vm);
}
pr_info("%s efuse=0x%x,auxadc_val=%dmv\n", __func__, efuseval,
accdet->auxadc_offset);
}
static void accdet_get_efuse_4key(void)
{
unsigned short tmp_val = 0;
unsigned short tmp_8bit = 0;
int ret = 0;
/* 4-key efuse:
* bit[9:2] efuse value is loaded, so every read out value need to be
* left shift 2 bit,and then compare with voltage get from AUXADC.
* AD efuse: key-A Voltage:0--AD;
* DB efuse: key-D Voltage: AD--DB;
* BC efuse: key-B Voltage:DB--BC;
* key-C Voltage: BC--600;
*/
ret = nvmem_device_read(accdet->accdet_efuse, 83*2, 2, &tmp_val);
tmp_8bit = tmp_val & ACCDET_CALI_MASK0;
accdet_dts.four_key.mid = tmp_8bit << 2;
tmp_8bit = (tmp_val >> 8) & ACCDET_CALI_MASK0;
accdet_dts.four_key.voice = tmp_8bit << 2;
ret = nvmem_device_read(accdet->accdet_efuse, 84*2, 2, &tmp_val);
tmp_8bit = tmp_val & ACCDET_CALI_MASK0;
accdet_dts.four_key.up = tmp_8bit << 2;
accdet_dts.four_key.down = 600;
pr_info("accdet key thresh: mid=%dmv,voice=%dmv,up=%dmv,down=%dmv\n",
accdet_dts.four_key.mid, accdet_dts.four_key.voice,
accdet_dts.four_key.up, accdet_dts.four_key.down);
}
static u32 key_check(u32 v)
{
if (HAS_CAP(accdet->data->caps, ACCDET_FOUR_KEY)) {
if ((v < accdet_dts.four_key.down) &&
(v >= accdet_dts.four_key.up))
return DW_KEY;
if ((v < accdet_dts.four_key.up) &&
(v >= accdet_dts.four_key.voice))
return UP_KEY;
if ((v < accdet_dts.four_key.voice) &&
(v >= accdet_dts.four_key.mid))
return AS_KEY;
if (v < accdet_dts.four_key.mid)
return MD_KEY;
} else {
if ((v < accdet_dts.three_key.down) &&
(v >= accdet_dts.three_key.up))
return DW_KEY;
if ((v < accdet_dts.three_key.up) &&
(v >= accdet_dts.three_key.mid))
return UP_KEY;
if (v < accdet_dts.three_key.mid)
return MD_KEY;
}
return NO_KEY;
}
static void send_key_event(u32 keycode, u32 flag)
{
int report = 0;
switch (keycode) {
case DW_KEY:
if (flag != 0)
report = SND_JACK_BTN_1;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_BTN_1);
break;
case UP_KEY:
if (flag != 0)
report = SND_JACK_BTN_2;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_BTN_2);
break;
case MD_KEY:
if (flag != 0)
report = SND_JACK_BTN_0;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_BTN_0);
break;
case AS_KEY:
if (flag != 0)
report = SND_JACK_BTN_3;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_BTN_3);
break;
}
#ifdef CONFIG_SND_SOC_SAMSUNG_AUDIO
accdet_pdata.key_state = (flag) ? 1 : 0;
#endif
}
static void send_status_event(u32 cable_type, u32 status)
{
int report = 0;
switch (cable_type) {
case HEADSET_NO_MIC:
if (status)
report = SND_JACK_HEADPHONE;
else
report = 0;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_HEADPHONE);
/* when plug 4-pole out, if both AB=3 AB=0 happen,3-pole plug
* in will be incorrectly reported, then 3-pole plug-out is
* reported,if no mantory 4-pole plug-out, icon would be
* visible.
*/
if (status == 0) {
report = 0;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_MICROPHONE);
}
pr_info("accdet HEADPHONE(3-pole) %s\n",
status ? "PlugIn" : "PlugOut");
break;
case HEADSET_MIC:
/* when plug 4-pole out, 3-pole plug out should also be
* reported for slow plug-in case
*/
if (status == 0) {
report = 0;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_HEADPHONE);
}
if (status)
report = SND_JACK_MICROPHONE;
else
report = 0;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_MICROPHONE);
pr_info("accdet MICROPHONE(4-pole) %s\n",
status ? "PlugIn" : "PlugOut");
/* when press key for a long time then plug in
* even recoginized as 4-pole
* disable micbias timer still timeout after 6s
* it check AB=00(because keep to press key) then disable
* micbias, it will cause key no response
*/
del_timer_sync(&micbias_timer);
break;
case LINE_OUT_DEVICE:
if (status)
report = SND_JACK_LINEOUT;
else
report = 0;
snd_soc_jack_report(&accdet->jack, report,
SND_JACK_LINEOUT);
pr_info("accdet LineOut %s\n",
status ? "PlugIn" : "PlugOut");
break;
default:
pr_info("%s Invalid cableType\n", __func__);
}
#ifdef CONFIG_SND_SOC_SAMSUNG_AUDIO
if (status == 0)
accdet_pdata.jack_state = NO_DEVICE;
else
accdet_pdata.jack_state = cable_type;
#endif
}
static void multi_key_detection(u32 cur_AB)
{
if (cur_AB == ACCDET_STATE_AB_00)
accdet->cur_key = key_check(accdet->cali_voltage);
#ifdef CONFIG_SND_SOC_SAMSUNG_AUDIO
if (cur_AB == ACCDET_STATE_AB_00)
accdet_pdata.mic_adc = accdet->cali_voltage;
else
accdet_pdata.mic_adc = 0;
#endif
/* delay to fix side effect key when plug-out, when plug-out,seldom
* issued AB=0 and Eint, delay to wait eint been flaged in register.
* or eint handler issued. accdet->cur_eint_state == PLUG_OUT
*/
usleep_range(10000, 12000);
if (HAS_CAP(accdet->data->caps, ACCDET_AP_GPIO_EINT)) {
if (accdet->cur_eint_state == EINT_PLUG_IN)
send_key_event(accdet->cur_key, !cur_AB);
else
accdet->cur_key = NO_KEY;
} else {
bool irq_bit = false;
irq_bit = !(accdet_read(ACCDET_IRQ_ADDR) &
ACCDET_EINT_IRQ_B2_B3);
/* send key when:
* no eint is flaged in reg, and now eint PLUG_IN
*/
if (irq_bit && (accdet->cur_eint_state == EINT_PLUG_IN))
send_key_event(accdet->cur_key, !cur_AB);
else
accdet->cur_key = NO_KEY;
}
if (cur_AB)
accdet->cur_key = NO_KEY;
}
static inline void clear_accdet_int(void)
{
/* it is safe by using polling to adjust when to clear IRQ_CLR_BIT */
accdet_update_bit(ACCDET_IRQ_ADDR, ACCDET_IRQ_CLR_SFT);
}
static inline void clear_accdet_int_check(void)
{
u64 cur_time = accdet_get_current_time();
while ((accdet_read(ACCDET_IRQ_ADDR) & ACCDET_IRQ_MASK_SFT) &&
(accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))
;
/* clear accdet int, modify for fix interrupt trigger twice error */
accdet_clear_bit(ACCDET_IRQ_ADDR, ACCDET_IRQ_CLR_SFT);
accdet_update_bit(RG_INT_STATUS_ACCDET_ADDR,
RG_INT_STATUS_ACCDET_SFT);
}
static inline void clear_accdet_eint(u32 eintid)
{
if ((eintid & PMIC_EINT0) == PMIC_EINT0) {
accdet_update_bit(ACCDET_IRQ_ADDR,
ACCDET_EINT0_IRQ_CLR_SFT);
}
if ((eintid & PMIC_EINT1) == PMIC_EINT1) {
accdet_update_bit(ACCDET_IRQ_ADDR,
ACCDET_EINT1_IRQ_CLR_SFT);
}
}
static inline void clear_accdet_eint_check(u32 eintid)
{
u64 cur_time = accdet_get_current_time();
u32 addr = 0;
addr = ACCDET_IRQ_ADDR;
if ((eintid & PMIC_EINT0) == PMIC_EINT0) {
while ((accdet_read(addr) & ACCDET_EINT0_IRQ_MASK_SFT)
&& (accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))
;
accdet_clear_bit(ACCDET_IRQ_ADDR,
ACCDET_EINT0_IRQ_CLR_SFT);
accdet_update_bit(RG_INT_STATUS_ACCDET_ADDR,
RG_INT_STATUS_ACCDET_EINT0_SFT);
}
if ((eintid & PMIC_EINT1) == PMIC_EINT1) {
while ((accdet_read(addr) & ACCDET_EINT1_IRQ_MASK_SFT)
&& (accdet_timeout_ns(cur_time, ACCDET_TIME_OUT)))
;
accdet_clear_bit(ACCDET_IRQ_ADDR,
ACCDET_EINT1_IRQ_CLR_SFT);
accdet_update_bit(RG_INT_STATUS_ACCDET_ADDR,
RG_INT_STATUS_ACCDET_EINT1_SFT);
}
}
static u32 get_triggered_eint(void)
{
u32 eint_ID = NO_PMIC_EINT;
u32 irq_status = accdet_read(ACCDET_IRQ_ADDR);
if (HAS_CAP(accdet->data->caps,
ACCDET_PMIC_EINT0)) {
if ((irq_status & ACCDET_EINT0_IRQ_MASK_SFT) ==
ACCDET_EINT0_IRQ_MASK_SFT)
eint_ID = PMIC_EINT0;
} else if (HAS_CAP(accdet->data->caps,
ACCDET_PMIC_EINT1)) {
if ((irq_status & ACCDET_EINT1_IRQ_MASK_SFT) ==
ACCDET_EINT1_IRQ_MASK_SFT)
eint_ID = PMIC_EINT1;
} else if (HAS_CAP(accdet->data->caps,
ACCDET_PMIC_BI_EINT)) {
if ((irq_status & ACCDET_EINT0_IRQ_MASK_SFT) ==
ACCDET_EINT0_IRQ_MASK_SFT)
eint_ID |= PMIC_EINT0;
if ((irq_status & ACCDET_EINT1_IRQ_MASK_SFT) ==
ACCDET_EINT1_IRQ_MASK_SFT)
eint_ID |= PMIC_EINT1;
}
return eint_ID;
}
static void eint_polarity_reverse(u32 eint_id)
{
if (eint_id == PMIC_EINT0) {
if (accdet->cur_eint_state == EINT_PLUG_OUT) {
if (accdet->accdet_eint_type == IRQ_TYPE_LEVEL_HIGH)
accdet_clear_bit(ACCDET_EINT0_IRQ_POLARITY_ADDR,
ACCDET_EINT0_IRQ_POLARITY_SFT);
else
accdet_update_bit(
ACCDET_EINT0_IRQ_POLARITY_ADDR,
ACCDET_EINT0_IRQ_POLARITY_SFT);
} else {
if (accdet->accdet_eint_type == IRQ_TYPE_LEVEL_HIGH)
accdet_update_bit(
ACCDET_EINT0_IRQ_POLARITY_ADDR,
ACCDET_EINT0_IRQ_POLARITY_SFT);
else
accdet_clear_bit(ACCDET_EINT0_IRQ_POLARITY_ADDR,
ACCDET_EINT0_IRQ_POLARITY_SFT);
}
} else if (eint_id == PMIC_EINT1) {
if (accdet->cur_eint_state == EINT_PLUG_OUT) {
if (accdet->accdet_eint_type == IRQ_TYPE_LEVEL_HIGH)
accdet_clear_bit(ACCDET_EINT1_IRQ_POLARITY_ADDR,
ACCDET_EINT1_IRQ_POLARITY_SFT);
else
accdet_update_bit(
ACCDET_EINT1_IRQ_POLARITY_ADDR,
ACCDET_EINT1_IRQ_POLARITY_SFT);
} else {
if (accdet->accdet_eint_type == IRQ_TYPE_LEVEL_HIGH)
accdet_update_bit(
ACCDET_EINT1_IRQ_POLARITY_ADDR,
ACCDET_EINT1_IRQ_POLARITY_SFT);
else
accdet_clear_bit(ACCDET_EINT1_IRQ_POLARITY_ADDR,
ACCDET_EINT1_IRQ_POLARITY_SFT);
}
}
}
static inline void enable_accdet(u32 state_swctrl)
{
/* enable ACCDET unit */
accdet_update_bit(ACCDET_EN_ADDR, ACCDET_EN_SFT);
}
static inline void disable_accdet(void)
{
/* sync with accdet_irq_handler set clear accdet irq bit to avoid to
* set clear accdet irq bit after disable accdet disable accdet irq
*/
clear_accdet_int();
udelay(200);
mutex_lock(&accdet->res_lock);
clear_accdet_int_check();
mutex_unlock(&accdet->res_lock);
/* recover accdet debounce0,3 */
accdet_set_debounce(accdet_state000, cust_pwm_deb->debounce0);
accdet_set_debounce(accdet_state011, cust_pwm_deb->debounce3);
accdet_clear_bit(ACCDET_EN_ADDR, ACCDET_EN_SFT);
/* clc ACCDET PWM enable to avoid power leakage */
accdet_clear_bits(ACCDET_CMP_PWM_EN_ADDR,
ACCDET_CMP_PWM_EN_SFT, 0x7, 0x7);
}
static inline void headset_plug_out(void)
{
send_status_event(accdet->cable_type, 0);
accdet->accdet_status = PLUG_OUT;
accdet->cable_type = NO_DEVICE;
if (accdet->cur_key != 0) {
send_key_event(accdet->cur_key, 0);
accdet->cur_key = 0;
}
dis_micbias_done = false;
pr_info("accdet %s, set cable_type = NO_DEVICE %d\n", __func__,
dis_micbias_done);
}
static void dis_micbias_timerhandler(struct timer_list *t)
{
int ret = 0;
ret = queue_work(accdet->dis_micbias_workqueue,
&accdet->dis_micbias_work);
if (!ret)
pr_notice("Error: %s (%d)\n", __func__, ret);
}
static void dis_micbias_work_callback(struct work_struct *work)
{
u32 cur_AB = 0, eintID = 0;
/* check EINT0 status, if plug out,
* not need to disable accdet here
*/
eintID = accdet_read_bits(ACCDET_EINT0_MEM_IN_ADDR,
ACCDET_EINT0_MEM_IN_SFT,
ACCDET_EINT0_MEM_IN_MASK);
if (eintID == M_PLUG_OUT) {
pr_notice("%s Plug-out, no dis micbias\n", __func__);
return;
}
/* if modify_vref_volt called, not need to dis micbias again */
if (dis_micbias_done == true) {
pr_notice("%s modify_vref_volt called\n", __func__);
return;
}
cur_AB = accdet_read(ACCDET_MEM_IN_ADDR) >> ACCDET_STATE_MEM_IN_OFFSET;
cur_AB = cur_AB & ACCDET_STATE_AB_MASK;
/* if 3pole disable accdet
* if <20k + 4pole, disable accdet will disable accdet
* plug out interrupt. The behavior will same as 3pole
*/
if ((accdet->cable_type == HEADSET_NO_MIC) ||
(cur_AB == ACCDET_STATE_AB_00) ||
(cur_AB == ACCDET_STATE_AB_11)) {
/* disable accdet_sw_en=0
* disable accdet_hwmode_en=0
*/
/* setting pwm idle; */
accdet_clear_bits(ACCDET_CMP_PWM_IDLE_ADDR,
ACCDET_CMP_PWM_IDLE_SFT, 0x7, 0x7);
disable_accdet();
}
}
static void eint_work_callback(struct work_struct *work)
{
if (accdet->cur_eint_state == EINT_PLUG_IN) {
mutex_lock(&accdet->res_lock);
accdet->eint_sync_flag = true;
mutex_unlock(&accdet->res_lock);
__pm_wakeup_event(accdet->timer_lock,
jiffies_to_msecs(7 * HZ));
accdet_init();
/* set PWM IDLE on */
accdet_update_bits(ACCDET_CMP_PWM_IDLE_ADDR,
ACCDET_CMP_PWM_IDLE_SFT, 0x7, 0x7);
if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT_IRQ)) {
if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT0)) {
accdet_update_bit(ACCDET_EINT0_PWM_IDLE_ADDR,
ACCDET_EINT0_PWM_IDLE_SFT);
} else if (HAS_CAP(accdet->data->caps,
ACCDET_PMIC_EINT1)) {
accdet_update_bit(ACCDET_EINT1_PWM_IDLE_ADDR,
ACCDET_EINT1_PWM_IDLE_SFT);
} else if (HAS_CAP(accdet->data->caps,
ACCDET_PMIC_BI_EINT)) {
accdet_update_bit(ACCDET_EINT0_PWM_IDLE_ADDR,
ACCDET_EINT0_PWM_IDLE_SFT);
accdet_update_bit(ACCDET_EINT1_PWM_IDLE_ADDR,
ACCDET_EINT1_PWM_IDLE_SFT);
}
}
accdet_update_bits(ACCDET_CMP_PWM_EN_ADDR,
ACCDET_CMP_PWM_EN_SFT, 0x7, 0x7);
enable_accdet(0);
#if NO_USE_COMPARATOR
mdelay(180);/* may be need delay more, relevant to Bias vol. */
check_cable_type();
if (accdet->accdet_status == MIC_BIAS)
accdet->cali_voltage = accdet_get_auxadc();
mod_timer(&accdet_open_cable_timer,
jiffies + ACCDET_OPEN_CABLE_TIMER);
#endif
} else {
mutex_lock(&accdet->res_lock);
accdet->eint_sync_flag = false;
accdet->thing_in_flag = false;
mutex_unlock(&accdet->res_lock);
del_timer_sync(&micbias_timer);
/* disable accdet_sw_en=0
*/
accdet_clear_bits(ACCDET_CMP_PWM_IDLE_ADDR,
ACCDET_CMP_PWM_IDLE_SFT, 0x7, 0x7);
disable_accdet();
headset_plug_out();
}
if (HAS_CAP(accdet->data->caps, ACCDET_AP_GPIO_EINT))
enable_irq(accdet->gpioirq);
}
void accdet_set_debounce(int state, unsigned int debounce)
{
switch (state) {
case accdet_state000:
/* set ACCDET debounce value = debounce/32 ms */
accdet_write(ACCDET_DEBOUNCE0_ADDR, debounce);
break;
case accdet_state001:
accdet_write(ACCDET_DEBOUNCE1_ADDR, debounce);
break;
case accdet_state010:
accdet_write(ACCDET_DEBOUNCE2_ADDR, debounce);
break;
case accdet_state011:
accdet_write(ACCDET_DEBOUNCE3_ADDR, debounce);
break;
case accdet_auxadc:
/* set auxadc debounce:0x42(2ms) */
accdet_write(ACCDET_DEBOUNCE4_ADDR, debounce);
break;
case eint_state000:
accdet_update_bits(ACCDET_EINT0_DEBOUNCE_ADDR,
ACCDET_EINT0_DEBOUNCE_SFT,
ACCDET_EINT0_DEBOUNCE_MASK,
debounce);
break;
case eint_state001:
accdet_update_bits(ACCDET_EINT1_DEBOUNCE_ADDR,
ACCDET_EINT1_DEBOUNCE_SFT,
ACCDET_EINT1_DEBOUNCE_MASK,
debounce);
break;
default:
pr_notice("Error: %s error state (%d)\n", __func__, state);
break;
}
}
#if NO_USE_COMPARATOR
static unsigned int check_pole_type(void)
{
unsigned int vol = 0;
vol = accdet_get_auxadc();
if ((vol < (cust_vol_set.vol_max_4pole + 1)) &&
(vol > (cust_vol_set.vol_min_4pole - 1))) {
pr_notice("[accdet] pole check:%d mv, AB=%d\n",
vol, TYPE_AB_01);
return TYPE_AB_01;
} else if ((vol < (cust_vol_set.vol_max_3pole + 1)) &&
(vol > cust_vol_set.vol_min_3pole)) {
pr_notice("[accdet] pole check:%d mv, AB=%d\n",
vol, TYPE_AB_00);
return TYPE_AB_00;
}
/* illegal state */
pr_notice("[accdet] pole check:%d mv, AB=%d\n", vol, TYPE_AB_10);
return TYPE_AB_10;
}
#endif
static inline void check_cable_type(void)
{
u32 cur_AB = 0;
#if NO_USE_COMPARATOR
cur_AB = check_pole_type();
pr_notice("accdet %s(), cur_status:%s current AB = %d\n", __func__,
accdet->accdet_status, cur_AB);
#else
cur_AB = accdet_read(ACCDET_MEM_IN_ADDR) >> ACCDET_STATE_MEM_IN_OFFSET;
cur_AB = cur_AB & ACCDET_STATE_AB_MASK;
#endif
accdet->button_status = 0;
switch (accdet->accdet_status) {
case PLUG_OUT:
if (cur_AB == ACCDET_STATE_AB_00) {
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
accdet->cable_type = HEADSET_NO_MIC;
accdet->accdet_status = HOOK_SWITCH;
} else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
} else if (cur_AB == ACCDET_STATE_AB_01) {
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
accdet->accdet_status = MIC_BIAS;
accdet->cable_type = HEADSET_MIC;
accdet_set_debounce(accdet_state011,
cust_pwm_deb->debounce3 * 30);
} else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
/* solution: adjust hook switch debounce time
* for fast key press condition, avoid to miss key
*/
accdet_set_debounce(accdet_state000,
button_press_debounce);
} else if (cur_AB == ACCDET_STATE_AB_11) {
/* accdet PLUG_OUT state not change */
if (HAS_CAP(accdet->data->caps,
ACCDET_PMIC_EINT_IRQ)) {
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
accdet->accdet_status = PLUG_OUT;
accdet->cable_type = NO_DEVICE;
} else
pr_notice("accdet hp been plug-out\n");
mutex_unlock(&accdet->res_lock);
}
} else {
pr_notice("accdet %s Invalid AB.Do nothing\n",
__func__);
}
break;
case MIC_BIAS:
if (cur_AB == ACCDET_STATE_AB_00) {
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
accdet->button_status = 1;
accdet->accdet_status = HOOK_SWITCH;
multi_key_detection(cur_AB);
} else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
} else if (cur_AB == ACCDET_STATE_AB_01) {
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
accdet->accdet_status = MIC_BIAS;
accdet->cable_type = HEADSET_MIC;
/* accdet MIC_BIAS state not change */
} else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
} else if (cur_AB == ACCDET_STATE_AB_11) {
/* accdet Don't send plug out in MIC_BIAS */
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag)
accdet->accdet_status = PLUG_OUT;
else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
} else {
pr_notice("accdet %s Invalid AB.Do nothing\n",
__func__);
}
break;
case HOOK_SWITCH:
if (cur_AB == ACCDET_STATE_AB_00) {
} else if (cur_AB == ACCDET_STATE_AB_01) {
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
multi_key_detection(cur_AB);
accdet->accdet_status = MIC_BIAS;
accdet->cable_type = HEADSET_MIC;
} else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
} else if (cur_AB == ACCDET_STATE_AB_11) {
/* accdet Don't send plugout in HOOK_SWITCH */
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag)
accdet->accdet_status = PLUG_OUT;
else
pr_notice("accdet hp has been plug-out\n");
mutex_unlock(&accdet->res_lock);
} else {
pr_notice("accdet %s Invalid AB.Do nothing\n",
__func__);
}
break;
case STAND_BY:
/* accdet %s STANDBY state.Err!Do nothing */
break;
default:
/* accdet %s Error state.Do nothing */
break;
}
}
static void accdet_work_callback(struct work_struct *work)
{
u32 pre_cable_type = accdet->cable_type;
__pm_stay_awake(accdet->wake_lock);
check_cable_type();
mutex_lock(&accdet->res_lock);
if (accdet->eint_sync_flag) {
if ((pre_cable_type != accdet->cable_type) ||
(accdet->cable_type == HEADSET_MIC))
send_status_event(accdet->cable_type, 1);
}
mutex_unlock(&accdet->res_lock);
__pm_relax(accdet->wake_lock);
}
static void accdet_queue_work(void)
{
int ret;
if (accdet->accdet_status == MIC_BIAS)
accdet->cali_voltage = accdet_get_auxadc();
ret = queue_work(accdet->accdet_workqueue, &accdet->accdet_work);
if (!ret)
pr_notice("Error: %s (%d)\n", __func__, ret);
}
static int pmic_eint_queue_work(int eintID)
{
int ret = 0;
if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT0)) {
if (eintID == PMIC_EINT0) {
if (accdet->cur_eint_state == EINT_PLUG_IN) {
accdet_set_debounce(eint_state000,
ACCDET_EINT0_DEB_IN_256);
accdet_set_debounce(accdet_state011,
cust_pwm_deb->debounce3);
accdet->cur_eint_state = EINT_PLUG_OUT;
} else {
accdet_set_debounce(eint_state000,
ACCDET_EINT0_DEB_OUT_012);
if (accdet->eint_id != M_PLUG_OUT) {
accdet->cur_eint_state = EINT_PLUG_IN;
mod_timer(&micbias_timer,
jiffies + MICBIAS_DISABLE_TIMER);
}
}
ret = queue_work(accdet->eint_workqueue,
&accdet->eint_work);
} else
pr_notice("%s invalid EINT ID!\n", __func__);
} else if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT1)) {
if (eintID == PMIC_EINT1) {
if (accdet->cur_eint_state == EINT_PLUG_IN) {
accdet_set_debounce(eint_state001,
ACCDET_EINT0_DEB_IN_256);
accdet_set_debounce(accdet_state011,
cust_pwm_deb->debounce3);
accdet->cur_eint_state = EINT_PLUG_OUT;
} else {
accdet_set_debounce(eint_state001,
ACCDET_EINT0_DEB_OUT_012);
if (accdet->eint_id != M_PLUG_OUT) {
accdet->cur_eint_state = EINT_PLUG_IN;
mod_timer(&micbias_timer,
jiffies + MICBIAS_DISABLE_TIMER);
}
}
ret = queue_work(accdet->eint_workqueue,
&accdet->eint_work);
} else
pr_notice("%s invalid EINT ID!\n", __func__);
} else if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_BI_EINT)) {
if ((eintID & PMIC_EINT0) == PMIC_EINT0) {
if (accdet->eint0_state == EINT_PLUG_IN) {
accdet_set_debounce(accdet_state011,
cust_pwm_deb->debounce3);
accdet->eint0_state = EINT_PLUG_OUT;
} else {
if (accdet->eint_id != M_PLUG_OUT)
accdet->eint0_state = EINT_PLUG_IN;
}
}
if ((eintID & PMIC_EINT1) == PMIC_EINT1) {
if (accdet->eint1_state == EINT_PLUG_IN) {
accdet_set_debounce(accdet_state011,
cust_pwm_deb->debounce3);
accdet->eint1_state = EINT_PLUG_OUT;
} else {
if (accdet->eint_id != M_PLUG_OUT)
accdet->eint1_state = EINT_PLUG_IN;
}
}
/* bi_eint trigger issued current state, may */
if (accdet->cur_eint_state == EINT_PLUG_OUT) {
accdet->cur_eint_state =
accdet->eint0_state & accdet->eint1_state;
if (accdet->cur_eint_state == EINT_PLUG_IN) {
mod_timer(&micbias_timer,
jiffies + MICBIAS_DISABLE_TIMER);
ret = queue_work(accdet->eint_workqueue,
&accdet->eint_work);
}
} else if (accdet->cur_eint_state == EINT_PLUG_IN) {
if ((accdet->eint0_state|accdet->eint1_state)
== EINT_PLUG_OUT) {
clear_accdet_eint_check(PMIC_EINT0);
clear_accdet_eint_check(PMIC_EINT1);
} else if ((accdet->eint0_state & accdet->eint1_state)
== EINT_PLUG_OUT) {
accdet->cur_eint_state = EINT_PLUG_OUT;
ret = queue_work(accdet->eint_workqueue,
&accdet->eint_work);
}
}
}
return ret;
}
static u32 moisture_detect(void)
{
u32 moisture_vol = 0;
u32 tmp_1 = 0, tmp_2 = 0, tmp_3 = 0;
tmp_1 = accdet_read(RG_AUDACCDETRSV_ADDR);
tmp_2 = accdet_read(RG_AUDPWDBMICBIAS1_ADDR);
tmp_3 = accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR);
/* Disable ACCDET to AUXADC */
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR) & 0x1FFF);
accdet_write(RG_AUDACCDETRSV_ADDR,
accdet_read(RG_AUDACCDETRSV_ADDR) & 0xFBFF);
accdet_write(RG_AUDACCDETRSV_ADDR,
accdet_read(RG_AUDACCDETRSV_ADDR) | 0x800);
/* Enable moisture detection, set 219A bit[13] = 1*/
accdet_write(RG_AUDPWDBMICBIAS1_ADDR,
accdet_read(RG_AUDPWDBMICBIAS1_ADDR) | 0x2000);
/* select PAD_HP_EINT for moisture detection, set 219A bit[14] = 0*/
accdet_write(RG_AUDPWDBMICBIAS1_ADDR,
accdet_read(RG_AUDPWDBMICBIAS1_ADDR) & 0xBFFF);
if (accdet_dts.moisture_use_ext_res == 0x0) {
/* select VTH to 2v and 500k, use internal resitance,
* 219C bit[10][11][12] = 1
*/
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR) | 0x1C00);
} else if (accdet_dts.moisture_use_ext_res == 0x1) {
/* select VTH to 2v and 500k, use external resitance
* set 219C bit[10] = 1, bit[11] [12]= 0
*/
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR) & 0xE7FF);
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR) | 0x0400);
}
moisture_vol = accdet_get_auxadc();
pr_info("%s accdet Moisture Read Auxadc=%d\n", __func__, moisture_vol);
/* reverse register setting after reading moisture voltage */
accdet_write(RG_AUDACCDETRSV_ADDR, tmp_1);
accdet_write(RG_AUDPWDBMICBIAS1_ADDR, tmp_2);
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR, tmp_3);
return moisture_vol;
}
void accdet_irq_handle(void)
{
u32 eintID = 0;
u32 irq_status = 0, acc_sts = 0, eint_sts = 0;
unsigned int moisture_vol = 0;
eintID = get_triggered_eint();
irq_status = accdet_read(ACCDET_IRQ_ADDR);
acc_sts = accdet_read(ACCDET_MEM_IN_ADDR);
eint_sts = accdet_read(ACCDET_EINT0_MEM_IN_ADDR);
if ((irq_status & ACCDET_IRQ_MASK_SFT) && (eintID == 0)) {
/* delete open cable timer if normal HP in */
del_timer_sync(&accdet_open_cable_timer);
clear_accdet_int();
accdet_queue_work();
clear_accdet_int_check();
} else if (eintID != NO_PMIC_EINT) {
pr_info("%s() IRQ:0x%x, eint-%s trig. cur_eint_state:%d\n",
__func__, irq_status,
(eintID == PMIC_EINT0)?"0":((eintID == PMIC_EINT1)?"1":"BI"),
accdet->cur_eint_state);
/* check EINT0 status */
accdet->eint_id = accdet_read_bits(
ACCDET_EINT0_MEM_IN_ADDR,
ACCDET_EINT0_MEM_IN_SFT,
ACCDET_EINT0_MEM_IN_MASK);
/* adjust eint digital/analog setting */
if (accdet->water_r != 0) {
if (accdet->cur_eint_state ==
EINT_MOISTURE_DETECTED) {
pr_info("%s Moisture plug out detectecd\n",
__func__);
eint_polarity_reverse(eintID);
accdet->cur_eint_state = EINT_PLUG_OUT;
clear_accdet_eint(eintID);
clear_accdet_eint_check(eintID);
return;
}
if (accdet->cur_eint_state == EINT_PLUG_OUT) {
pr_info("%s now check moisture\n", __func__);
moisture_vol = moisture_detect();
if (moisture_vol > accdet->moisture_vm) {
eint_polarity_reverse(eintID);
accdet->cur_eint_state =
EINT_MOISTURE_DETECTED;
clear_accdet_eint(eintID);
clear_accdet_eint_check(eintID);
pr_info("%s Moisture plug in detectecd!\n",
__func__);
return;
}
pr_info("%s check moisture done,not water.\n",
__func__);
}
}
eint_polarity_reverse(eintID);
clear_accdet_eint(eintID);
clear_accdet_eint_check(eintID);
pmic_eint_queue_work(eintID);
} else {
pr_notice("%s no interrupt detected!\n", __func__);
}
}
static irqreturn_t mtk_accdet_irq_handler_thread(int irq, void *data)
{
accdet_irq_handle();
return IRQ_HANDLED;
}
static void check_open_cable_timerhandler(struct timer_list *t)
{
int ret;
ret = queue_work(accdet->accdet_workqueue, &accdet->accdet_work);
if (!ret)
pr_info("%s return:%d!\n", __func__, ret);
}
static irqreturn_t ex_eint_handler(int irq, void *data)
{
int ret = 0;
if (accdet->cur_eint_state == EINT_PLUG_IN) {
/* To trigger EINT when the headset was plugged in
* We set the polarity back as we initialed.
*/
if (accdet->accdet_eint_type == IRQ_TYPE_LEVEL_HIGH)
irq_set_irq_type(accdet->gpioirq, IRQ_TYPE_LEVEL_HIGH);
else
irq_set_irq_type(accdet->gpioirq, IRQ_TYPE_LEVEL_LOW);
gpio_set_debounce(accdet->gpiopin, accdet->gpio_hp_deb);
accdet->cur_eint_state = EINT_PLUG_OUT;
} else {
/* To trigger EINT when the headset was plugged out
* We set the opposite polarity to what we initialed.
*/
if (accdet->accdet_eint_type == IRQ_TYPE_LEVEL_HIGH)
irq_set_irq_type(accdet->gpioirq, IRQ_TYPE_LEVEL_LOW);
else
irq_set_irq_type(accdet->gpioirq, IRQ_TYPE_LEVEL_HIGH);
gpio_set_debounce(accdet->gpiopin,
accdet_dts.plugout_deb * 1000);
accdet->cur_eint_state = EINT_PLUG_IN;
mod_timer(&micbias_timer,
jiffies + MICBIAS_DISABLE_TIMER);
}
disable_irq_nosync(accdet->gpioirq);
ret = queue_work(accdet->eint_workqueue, &accdet->eint_work);
return IRQ_HANDLED;
}
static inline int ext_eint_setup(struct platform_device *platform_device)
{
int ret = 0;
u32 ints[4] = { 0 };
struct device_node *node = NULL;
struct pinctrl_state *pins_default = NULL;
accdet->pinctrl = devm_pinctrl_get(&platform_device->dev);
if (IS_ERR(accdet->pinctrl)) {
ret = PTR_ERR(accdet->pinctrl);
return ret;
}
pins_default = pinctrl_lookup_state(accdet->pinctrl, "default");
if (IS_ERR(pins_default))
ret = PTR_ERR(pins_default);
accdet->pins_eint = pinctrl_lookup_state(accdet->pinctrl,
"state_eint_as_int");
if (IS_ERR(accdet->pins_eint)) {
ret = PTR_ERR(accdet->pins_eint);
return ret;
}
pinctrl_select_state(accdet->pinctrl, accdet->pins_eint);
node = of_find_matching_node(node, accdet_of_match);
if (!node)
return -1;
accdet->gpiopin = of_get_named_gpio(node, "deb-gpios", 0);
ret = of_property_read_u32(node, "debounce",
&accdet->gpio_hp_deb);
if (ret < 0)
return ret;
gpio_set_debounce(accdet->gpiopin, accdet->gpio_hp_deb);
accdet->gpioirq = irq_of_parse_and_map(node, 0);
ret = of_property_read_u32_array(node, "interrupts", ints,
ARRAY_SIZE(ints));
if (ret)
return ret;
accdet->accdet_eint_type = ints[1];
ret = request_irq(accdet->gpioirq, ex_eint_handler, IRQF_TRIGGER_NONE,
"accdet-eint", NULL);
if (ret)
return ret;
return 0;
}
static int accdet_get_dts_data(void)
{
int ret = 0;
struct device_node *node = NULL;
int pwm_deb[8] = {0};
int three_key[4] = {0};
u32 tmp = 0;
#if NO_USE_COMPARATOR
unsigned int vol_thresh[5] = { 0 };
#endif
node = of_find_matching_node(node, accdet_of_match);
if (!node) {
pr_notice("Error: %s can't find compatible dts node\n",
__func__);
return -1;
}
ret = of_property_read_u32(node, "moisture-ver", &moisture_ver);
if (ret)
moisture_ver = 0x2;
ret = of_property_read_u32(node,
"accdet-mic-vol", &accdet_dts.mic_vol);
if (ret)
accdet_dts.mic_vol = 6;
ret = of_property_read_u32(node, "accdet-plugout-debounce",
&accdet_dts.plugout_deb);
if (ret)
accdet_dts.plugout_deb = 1;
ret = of_property_read_u32(node,
"accdet-mic-mode", &accdet_dts.mic_mode);
if (ret)
accdet_dts.mic_mode = 2;
ret = of_property_read_u32_array(node, "headset-mode-setting", pwm_deb,
ARRAY_SIZE(pwm_deb));
/* debounce8(auxadc debounce) is default, needn't get from dts */
if (!ret)
memcpy(&accdet_dts.pwm_deb, pwm_deb, sizeof(pwm_deb));
cust_pwm_deb = &accdet_dts.pwm_deb;
ret = of_property_read_u32(node, "headset-eint-level-pol",
&accdet_dts.eint_pol);
if (ret)
accdet_dts.eint_pol = 8;
pr_info("accdet mic_vol=%d, plugout_deb=%d mic_mode=%d eint_pol=%d\n",
accdet_dts.mic_vol, accdet_dts.plugout_deb,
accdet_dts.mic_mode, accdet_dts.eint_pol);
ret = of_property_read_u32(node,
"headset-use-ap-eint", &tmp);
if (ret)
tmp = 0;
if (tmp == 0)
accdet->data->caps |= ACCDET_PMIC_EINT_IRQ;
else if (tmp == 1)
accdet->data->caps |= ACCDET_AP_GPIO_EINT;
ret = of_property_read_u32(node,
"headset-eint-num", &tmp);
if (ret)
tmp = 0;
if (tmp == 0)
accdet->data->caps |= ACCDET_PMIC_EINT0;
else if (tmp == 1)
accdet->data->caps |= ACCDET_PMIC_EINT1;
else if (tmp == 2)
accdet->data->caps |= ACCDET_PMIC_BI_EINT;
ret = of_property_read_u32(node,
"headset-eint-trig-mode", &tmp);
if (ret)
tmp = 0;
if (tmp == 0)
accdet->data->caps |= ACCDET_PMIC_GPIO_TRIG_EINT;
else if (tmp == 1)
accdet->data->caps |= ACCDET_PMIC_INVERTER_TRIG_EINT;
ret = of_property_read_u32(node,
"headset-key-mode", &tmp);
if (ret)
tmp = 0;
if (tmp == 0)
accdet->data->caps |= ACCDET_THREE_KEY;
else if (tmp == 1)
accdet->data->caps |= ACCDET_FOUR_KEY;
else if (tmp == 2)
accdet->data->caps |= ACCDET_TRI_KEY_CDD;
pr_info("accdet caps=%x\n", accdet->data->caps);
if (HAS_CAP(accdet->data->caps, ACCDET_FOUR_KEY)) {
int four_key[5];
ret = of_property_read_u32_array(node,
"headset-four-key-threshold",
four_key, ARRAY_SIZE(four_key));
if (!ret)
memcpy(&accdet_dts.four_key, four_key+1,
sizeof(struct four_key_threshold));
else {
pr_notice("accdet no 4-key-thrsh dts, use efuse\n");
accdet_get_efuse_4key();
}
} else {
if (HAS_CAP(accdet->data->caps, ACCDET_THREE_KEY)) {
ret = of_property_read_u32_array(node,
"headset-three-key-threshold",
three_key, ARRAY_SIZE(three_key));
} else {
ret = of_property_read_u32_array(node,
"headset-three-key-threshold-CDD", three_key,
ARRAY_SIZE(three_key));
}
if (!ret)
memcpy(&accdet_dts.three_key, three_key+1,
sizeof(struct three_key_threshold));
}
dis_micbias_done = false;
ret = of_property_read_u32(node, "moisture-water-r", &accdet->water_r);
if (ret) {
/* no moisture detection */
accdet->water_r = 0x0;
}
ret = of_property_read_u32(node, "moisture_use_ext_res",
&accdet_dts.moisture_use_ext_res);
if (ret) {
/* no moisture detection */
accdet_dts.moisture_use_ext_res = -1;
}
if (accdet_dts.moisture_use_ext_res == 0x1) {
of_property_read_u32(node, "moisture-external-r",
&accdet->moisture_ext_r);
pr_info("Moisture_EXT support water_r=%d, ext_r=%d\n",
accdet->water_r, accdet->moisture_ext_r);
} else if (accdet_dts.moisture_use_ext_res == 0x0) {
of_property_read_u32(node, "moisture-internal-r",
&accdet->moisture_int_r);
pr_info("Moisture_INT support water_r=%d, int_r=%d\n",
accdet->water_r, accdet->moisture_int_r);
}
ret = of_property_read_u32(node, "eint_use_ext_res",
&accdet_dts.eint_use_ext_res);
if (ret) {
/* eint use internal resister */
accdet_dts.eint_use_ext_res = 0x0;
}
#if NO_USE_COMPARATOR
ret = of_property_read_u32_array(node, "headset-vol-threshold",
vol_thresh, ARRAY_SIZE(vol_thresh));
if (!ret)
memcpy(&cust_vol_set, vol_thresh, sizeof(vol_thresh));
else
pr_info("accdet get headset-vol-thrsh fail\n");
pr_info("[Accdet] min_3pole = %d, max_3pole = %d\n",
cust_vol_set.vol_min_3pole, cust_vol_set.vol_max_3pole);
pr_info("[Accdet] min_4pole = %d, max_4pole = %d\n",
cust_vol_set.vol_min_4pole, cust_vol_set.vol_max_4pole);
if (cust_vol_set.vol_bias > 2600) {
cust_vol_set.vol_bias = 2600;/* 2600mv */
pr_notice("[Accdet]bias vol set %d mv--->2600 mv\n",
cust_vol_set.vol_bias);
} else {
pr_info("[Accdet]bias vol set %d mv\n", cust_vol_set.vol_bias);
}
#endif
return 0;
}
static void config_digital_init_by_mode(void)
{
unsigned int reg = 0;
/* sw mode, */
reg = accdet_read(ACCDET_HWEN_SEL_ADDR);
accdet_write(ACCDET_HWEN_SEL_ADDR,
(reg & (~ACCDET_HWMODE_SEL_BIT)) | ACCDET_FAST_DISCAHRGE);
}
static void config_eint_init_by_mode(void)
{
if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT0)) {
accdet_update_bits(ACCDET_EINT0_PWM_THRESH_ADDR, 0x8, 0x6, 0x6);
accdet_update_bits(ACCDET_EINT0_PWM_WIDTH_ADDR, 0xc, 0x2, 0x2);
accdet_update_bit(ACCDET_EINT0_PWM_EN_ADDR,
ACCDET_EINT0_PWM_EN_SFT);
accdet_update_bit(ACCDET_EINT0_PWM_IDLE_ADDR,
ACCDET_EINT0_PWM_IDLE_SFT);
accdet_update_bit(ACCDET_EINT0_EN_ADDR,
ACCDET_EINT0_EN_SFT);
} else if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT1)) {
accdet_update_bits(ACCDET_EINT0_PWM_THRESH_ADDR, 0x8, 0x6, 0x6);
accdet_update_bits(ACCDET_EINT0_PWM_WIDTH_ADDR, 0xc, 0x2, 0x2);
accdet_update_bit(ACCDET_EINT1_PWM_EN_ADDR,
ACCDET_EINT1_PWM_EN_SFT);
accdet_update_bit(ACCDET_EINT1_PWM_IDLE_ADDR,
ACCDET_EINT1_PWM_IDLE_SFT);
accdet_update_bit(ACCDET_EINT1_EN_ADDR,
ACCDET_EINT1_EN_SFT);
} else if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_BI_EINT)) {
accdet_update_bits(ACCDET_EINT0_PWM_THRESH_ADDR, 0x8, 0x6, 0x6);
accdet_update_bits(ACCDET_EINT0_PWM_WIDTH_ADDR, 0xc, 0x2, 0x2);
accdet_update_bit(ACCDET_EINT0_PWM_EN_ADDR,
ACCDET_EINT0_PWM_EN_SFT);
accdet_update_bit(ACCDET_EINT0_PWM_IDLE_ADDR,
ACCDET_EINT0_PWM_IDLE_SFT);
accdet_update_bits(ACCDET_EINT0_PWM_THRESH_ADDR, 0x8, 0x6, 0x6);
accdet_update_bits(ACCDET_EINT0_PWM_WIDTH_ADDR, 0xc, 0x2, 0x2);
accdet_update_bit(ACCDET_EINT1_PWM_EN_ADDR,
ACCDET_EINT1_PWM_EN_SFT);
accdet_update_bit(ACCDET_EINT1_PWM_IDLE_ADDR,
ACCDET_EINT1_PWM_IDLE_SFT);
accdet_update_bit(ACCDET_EINT0_EN_ADDR,
ACCDET_EINT0_EN_SFT);
accdet_update_bit(ACCDET_EINT1_EN_ADDR,
ACCDET_EINT1_EN_SFT);
}
}
static void accdet_init_once(void)
{
unsigned int reg = 0;
/* reset the accdet unit */
accdet_update_bit(RG_ACCDET_RST_ADDR,
RG_ACCDET_RST_SFT);
accdet_clear_bit(RG_ACCDET_RST_ADDR,
RG_ACCDET_RST_SFT);
/* init pwm frequency, duty & rise/falling delay */
accdet_write(ACCDET_PWM_WIDTH_ADDR,
REGISTER_VAL(cust_pwm_deb->pwm_width));
accdet_write(ACCDET_PWM_THRESH_ADDR,
REGISTER_VAL(cust_pwm_deb->pwm_thresh));
accdet_write(ACCDET_RISE_DELAY_ADDR,
(cust_pwm_deb->fall_delay << 15 | cust_pwm_deb->rise_delay));
/* config micbias voltage, micbias1 vref is only controlled by accdet
* if we need 2.8V, config [12:13]
*/
reg = accdet_read(RG_AUDPWDBMICBIAS1_ADDR);
if (accdet_dts.mic_vol <= 7) {
/* micbias1 <= 2.7V */
accdet_write(RG_AUDPWDBMICBIAS1_ADDR,
reg | (accdet_dts.mic_vol<<RG_AUDMICBIAS1VREF_SFT));
}
/* mic mode setting */
reg = accdet_read(RG_AUDACCDETMICBIAS0PULLLOW_ADDR);
if (accdet_dts.mic_mode == HEADSET_MODE_1) {
/* ACC mode*/
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
reg | RG_ACCDET_MODE_ANA11_MODE1);
} else if (accdet_dts.mic_mode == HEADSET_MODE_2) {
/* DCC mode Low cost mode without internal bias*/
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
reg | RG_ACCDET_MODE_ANA11_MODE2);
} else if (accdet_dts.mic_mode == HEADSET_MODE_6) {
/* DCC mode Low cost mode with internal bias,
* bit8 = 1 to use internal bias
*/
accdet_write(RG_AUDACCDETMICBIAS0PULLLOW_ADDR,
reg | RG_ACCDET_MODE_ANA11_MODE6);
accdet_update_bit(RG_AUDPWDBMICBIAS1_ADDR,
RG_AUDMICBIAS1DCSW1PEN_SFT);
}
/* enable analog fast discharge */
reg = accdet_read(RG_AUDSPARE_ADDR);
accdet_write(RG_AUDSPARE_ADDR, reg | RG_AUDSPARE_FSTDSCHRG_IMPR_EN |
RG_AUDSPARE_FSTDSCHRG_ANALOG_DIR_EN);
if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT_IRQ)) {
config_eint_init_by_mode();
config_digital_init_by_mode();
} else if (HAS_CAP(accdet->data->caps, ACCDET_AP_GPIO_EINT)) {
//TBD
}
pr_info("%s done!\n", __func__);
}
static void accdet_init_debounce(void)
{
}
static inline void accdet_init(void)
{
/* set and clear initial bit every eint interrutp */
accdet_update_bit(ACCDET_SEQ_INIT_ADDR,
ACCDET_SEQ_INIT_SFT);
usleep_range(2000, 3000);
accdet_clear_bit(ACCDET_SEQ_INIT_ADDR,
ACCDET_SEQ_INIT_SFT);
usleep_range(1000, 1500);
/* init the debounce time (debounce/32768)sec */
accdet_set_debounce(accdet_state000, cust_pwm_deb->debounce0);
accdet_set_debounce(accdet_state001, cust_pwm_deb->debounce1);
accdet_set_debounce(accdet_state011, cust_pwm_deb->debounce3);
/* auxadc:2ms */
accdet_set_debounce(accdet_auxadc, cust_pwm_deb->debounce4);
}
/* late init for DC trim, and this API Will be called by audio */
void accdet_late_init(unsigned long data)
{
pr_info("%s() now init accdet!\n", __func__);
if (atomic_cmpxchg(&accdet_first, 1, 0)) {
del_timer_sync(&accdet_init_timer);
accdet_init();
accdet_init_debounce();
accdet_init_once();
} else
pr_info("%s inited dts fail\n", __func__);
}
EXPORT_SYMBOL(accdet_late_init);
int mtk_accdet_init(struct snd_soc_component *component)
{
int ret = 0;
struct mt63xx_accdet_data *priv =
snd_soc_card_get_drvdata(component->card);
struct snd_soc_card *card = component->card;
/* Enable Headset and 4 Buttons Jack detection */
ret = snd_soc_card_jack_new(card,
"Headset Jack",
SND_JACK_HEADSET |
SND_JACK_LINEOUT |
SND_JACK_MECHANICAL,
&priv->jack,
NULL, 0);
if (ret) {
dev_err(card->dev, "Can't new Headset Jack %x\n", ret);
return ret;
}
accdet->jack.jack->input_dev->id.bustype = BUS_HOST;
snd_jack_set_key(accdet->jack.jack, SND_JACK_BTN_0, KEY_MEDIA);
snd_jack_set_key(accdet->jack.jack, SND_JACK_BTN_1, KEY_VOLUMEDOWN);
snd_jack_set_key(accdet->jack.jack, SND_JACK_BTN_2, KEY_VOLUMEUP);
snd_jack_set_key(accdet->jack.jack, SND_JACK_BTN_3, KEY_VOICECOMMAND);
ret = snd_soc_component_set_jack(component, &priv->jack, NULL);
if (ret)
return ret;
return ret;
}
EXPORT_SYMBOL(mtk_accdet_init);
int mtk_accdet_set_drvdata(struct snd_soc_card *card)
{
snd_soc_card_set_drvdata(card, accdet);
return 0;
}
EXPORT_SYMBOL(mtk_accdet_set_drvdata);
static void delay_init_work_callback(struct work_struct *work)
{
accdet_init();
accdet_init_debounce();
accdet_init_once();
pr_info("%s() done\n", __func__);
}
static void delay_init_timerhandler(struct timer_list *t)
{
int ret = 0;
ret = queue_work(accdet->delay_init_workqueue,
&accdet->delay_init_work);
if (!ret)
pr_notice("Error: %s (%d)\n", __func__, ret);
}
static int accdet_probe(struct platform_device *pdev)
{
int ret = 0;
struct resource *res;
struct mt6397_chip *mt6397_chip = dev_get_drvdata(pdev->dev.parent);
const struct of_device_id *of_id =
of_match_device(accdet_of_match, &pdev->dev);
if (!of_id) {
dev_dbg(&pdev->dev, "Error: No device match found\n");
return -ENODEV;
}
accdet = devm_kzalloc(&pdev->dev, sizeof(*accdet), GFP_KERNEL);
if (!accdet)
return -ENOMEM;
accdet->data = (struct accdet_priv *)of_id->data;
accdet->pdev = pdev;
/* parse dts attributes */
ret = accdet_get_dts_data();
if (ret) {
dev_dbg(&pdev->dev, "Error: Get dts data failed (%d)\n",
ret);
return ret;
}
/* init lock */
accdet->wake_lock = wakeup_source_register(NULL, "accdet_wake_lock");
if (!accdet->wake_lock)
return -ENOMEM;
accdet->timer_lock = wakeup_source_register(NULL, "accdet_timer_lock");
if (!accdet->timer_lock)
return -ENOMEM;
mutex_init(&accdet->res_lock);
platform_set_drvdata(pdev, accdet);
/* Important. must to register */
ret = devm_snd_soc_register_component(&pdev->dev, &accdet_soc_driver,
NULL, 0);
if (ret)
return ret;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
accdet->regmap = mt6397_chip->regmap;
accdet->dev = &pdev->dev;
/* get pmic auxadc iio channel handler */
accdet->accdet_auxadc = devm_iio_channel_get(&pdev->dev,
"pmic_accdet");
ret = PTR_ERR_OR_ZERO(accdet->accdet_auxadc);
if (ret) {
if (ret != -EPROBE_DEFER)
dev_dbg(&pdev->dev, "Error: Get iio ch failed (%d)\n",
ret);
return ret;
}
/* get pmic efuse handler */
accdet->accdet_efuse = devm_nvmem_device_get(&pdev->dev,
"mt63xx-accdet-efuse");
ret = PTR_ERR_OR_ZERO(accdet->accdet_efuse);
if (ret) {
if (ret != -EPROBE_DEFER)
dev_dbg(&pdev->dev, "Error: Get efuse failed (%d)\n",
ret);
return ret;
}
accdet_get_efuse();
/* register pmic interrupt */
accdet->accdet_irq = platform_get_irq(pdev, 0);
if (accdet->accdet_irq < 0) {
dev_dbg(&pdev->dev,
"Error: Get accdet irq failed (%d)\n",
accdet->accdet_irq);
return accdet->accdet_irq;
}
ret = devm_request_threaded_irq(&pdev->dev, accdet->accdet_irq,
NULL, mtk_accdet_irq_handler_thread,
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
"ACCDET_IRQ", accdet);
if (ret) {
dev_dbg(&pdev->dev,
"Error: Get thread irq request failed (%d) (%d)\n",
accdet->accdet_irq, ret);
return ret;
}
if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT0)) {
accdet->accdet_eint0 = platform_get_irq(pdev, 1);
if (accdet->accdet_eint0 < 0) {
dev_dbg(&pdev->dev,
"Error: Get eint0 irq failed (%d)\n",
accdet->accdet_eint0);
return accdet->accdet_eint0;
}
ret = devm_request_threaded_irq(&pdev->dev,
accdet->accdet_eint0,
NULL, mtk_accdet_irq_handler_thread,
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
"ACCDET_EINT0", accdet);
if (ret) {
dev_dbg(&pdev->dev,
"Error: Get eint0 irq request failed (%d)\n",
ret);
return ret;
}
} else if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_EINT1)) {
accdet->accdet_eint1 = platform_get_irq(pdev, 2);
if (accdet->accdet_eint1 < 0) {
dev_dbg(&pdev->dev,
"Error: Get eint1 irq failed (%d)\n",
accdet->accdet_eint1);
return accdet->accdet_eint1;
}
ret = devm_request_threaded_irq(&pdev->dev,
accdet->accdet_eint1,
NULL, mtk_accdet_irq_handler_thread,
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
"ACCDET_EINT1", accdet);
if (ret) {
dev_dbg(&pdev->dev,
"Error: Get eint1 irq request failed (%d)\n",
ret);
return ret;
}
} else if (HAS_CAP(accdet->data->caps, ACCDET_PMIC_BI_EINT)) {
accdet->accdet_eint0 = platform_get_irq(pdev, 1);
if (accdet->accdet_eint0 < 0) {
dev_dbg(&pdev->dev,
"Error: Get eint0 irq failed (%d)\n",
accdet->accdet_eint0);
return accdet->accdet_eint0;
}
ret = devm_request_threaded_irq(&pdev->dev,
accdet->accdet_eint0,
NULL, mtk_accdet_irq_handler_thread,
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
"ACCDET_EINT0", accdet);
if (ret) {
dev_dbg(&pdev->dev,
"Error: Get eint0 irq request failed (%d)\n",
ret);
return ret;
}
accdet->accdet_eint1 = platform_get_irq(pdev, 2);
if (accdet->accdet_eint1 < 0) {
dev_dbg(&pdev->dev,
"Error: Get eint1 irq failed (%d)\n",
accdet->accdet_eint1);
return accdet->accdet_eint1;
}
ret = devm_request_threaded_irq(&pdev->dev,
accdet->accdet_eint1,
NULL, mtk_accdet_irq_handler_thread,
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
"ACCDET_EINT1", accdet);
if (ret) {
dev_dbg(&pdev->dev,
"Error: Get eint1 irq request failed (%d)\n",
ret);
return ret;
}
}
/* register char device number, Create normal device for auido use */
ret = alloc_chrdev_region(&accdet->accdet_devno, 0, 1, ACCDET_DEVNAME);
if (ret)
goto err_chrdevregion;
/* create class in sysfs, "sys/class/", so udev in userspace can create
* device node, when device_create is called
*/
accdet->accdet_class = class_create(THIS_MODULE, ACCDET_DEVNAME);
if (!accdet->accdet_class) {
dev_dbg(&pdev->dev,
"Error: Create class failed (%d)\n", ret);
ret = -1;
}
/* setup timer */
timer_setup(&micbias_timer, dis_micbias_timerhandler, 0);
micbias_timer.expires = jiffies + MICBIAS_DISABLE_TIMER;
timer_setup(&accdet_init_timer, delay_init_timerhandler, 0);
accdet_init_timer.expires = jiffies + ACCDET_INIT_WAIT_TIMER;
timer_setup(&accdet_open_cable_timer,
check_open_cable_timerhandler, 0);
accdet_open_cable_timer.expires = jiffies + ACCDET_OPEN_CABLE_TIMER;
/* Create workqueue */
accdet->delay_init_workqueue =
create_singlethread_workqueue("delay_init");
INIT_WORK(&accdet->delay_init_work, delay_init_work_callback);
if (!accdet->delay_init_workqueue) {
dev_dbg(&pdev->dev, "Error: Create dinit workqueue failed\n");
ret = -1;
goto err_device_create;
}
accdet->accdet_workqueue = create_singlethread_workqueue("accdet");
INIT_WORK(&accdet->accdet_work, accdet_work_callback);
if (!accdet->accdet_workqueue) {
dev_dbg(&pdev->dev, "Error: Create accdet workqueue failed\n");
ret = -1;
goto err_device_create;
}
accdet->dis_micbias_workqueue =
create_singlethread_workqueue("dismicQueue");
INIT_WORK(&accdet->dis_micbias_work, dis_micbias_work_callback);
if (!accdet->dis_micbias_workqueue) {
dev_dbg(&pdev->dev, "Error: Create dismic workqueue failed\n");
ret = -1;
goto err;
}
accdet->eint_workqueue = create_singlethread_workqueue("accdet_eint");
INIT_WORK(&accdet->eint_work, eint_work_callback);
if (!accdet->eint_workqueue) {
dev_dbg(&pdev->dev, "Error: Create eint workqueue failed\n");
ret = -1;
goto err_create_workqueue;
}
if (HAS_CAP(accdet->data->caps, ACCDET_AP_GPIO_EINT)) {
accdet->accdet_eint_type = IRQ_TYPE_LEVEL_LOW;
ret = ext_eint_setup(pdev);
if (ret)
destroy_workqueue(accdet->eint_workqueue);
}
ret = accdet_create_attr(&accdet_driver.driver);
if (ret) {
pr_notice("%s create_attr fail, ret = %d\n", __func__, ret);
goto err_create_workqueue;
}
atomic_set(&accdet_first, 1);
mod_timer(&accdet_init_timer, (jiffies + ACCDET_INIT_WAIT_TIMER));
#ifdef CONFIG_SND_SOC_SAMSUNG_AUDIO
register_accdet_jack_cb(&accdet_pdata);
#endif
pr_info("%s done!\n", __func__);
return 0;
err_create_workqueue:
destroy_workqueue(accdet->dis_micbias_workqueue);
err:
destroy_workqueue(accdet->accdet_workqueue);
destroy_workqueue(accdet->delay_init_workqueue);
err_device_create:
class_destroy(accdet->accdet_class);
err_chrdevregion:
pr_notice("%s error. now exit.!\n", __func__);
return ret;
}
static int accdet_remove(struct platform_device *pdev)
{
destroy_workqueue(accdet->eint_workqueue);
destroy_workqueue(accdet->dis_micbias_workqueue);
destroy_workqueue(accdet->accdet_workqueue);
destroy_workqueue(accdet->delay_init_workqueue);
class_destroy(accdet->accdet_class);
unregister_chrdev_region(accdet->accdet_devno, 1);
devm_kfree(&pdev->dev, accdet);
return 0;
}
static long mt_accdet_unlocked_ioctl(struct file *file, unsigned int cmd,
unsigned long arg)
{
switch (cmd) {
case GET_BUTTON_STATUS:
return accdet->button_status;
default:
break;
}
return 0;
}
static const struct file_operations accdet_fops = {
.owner = THIS_MODULE,
.unlocked_ioctl = mt_accdet_unlocked_ioctl,
};
const struct file_operations *accdet_get_fops(void)
{
return &accdet_fops;
}
static struct platform_driver accdet_driver = {
.probe = accdet_probe,
.remove = accdet_remove,
.driver = {
.name = "pmic-codec-accdet",
.of_match_table = accdet_of_match,
},
};
static int __init accdet_soc_init(void)
{
int ret = 0;
ret = platform_driver_register(&accdet_driver);
if (ret)
return -ENODEV;
return 0;
}
static void __exit accdet_soc_exit(void)
{
platform_driver_unregister(&accdet_driver);
}
module_init(accdet_soc_init);
module_exit(accdet_soc_exit);
/* Module information */
MODULE_DESCRIPTION("MT6357 ALSA SoC accdet driver");
MODULE_AUTHOR("Argus Lin <argus.lin@mediatek.com>");
MODULE_LICENSE("GPL v2");
Reference in a new issue View git blame Copy permalink