1240 lines
36 KiB
C
1240 lines
36 KiB
C
|
/*
|
||
|
* sm5713-muic-afc.c - afc driver for the SiliconMitus sm5713
|
||
|
*
|
||
|
* Copyright (C) 2017 SiliconMitus
|
||
|
*
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
* (at your option) any later version.
|
||
|
*
|
||
|
*
|
||
|
* This driver is based on max77843-muic-afc.c
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/gpio.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/err.h>
|
||
|
#include <linux/platform_device.h>
|
||
|
#include <linux/workqueue.h>
|
||
|
#include <linux/wakelock.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/power_supply.h>
|
||
|
#include <linux/device.h>
|
||
|
#include <linux/battery/sec_battery.h>
|
||
|
|
||
|
#include <linux/mfd/sm5713.h>
|
||
|
#include <linux/mfd/sm5713-private.h>
|
||
|
|
||
|
/* MUIC header file */
|
||
|
#include <linux/muic/muic.h>
|
||
|
#include <linux/muic/sm5713-muic.h>
|
||
|
|
||
|
|
||
|
#if defined(CONFIG_MUIC_NOTIFIER)
|
||
|
#include <linux/muic/muic_notifier.h>
|
||
|
#endif /* CONFIG_MUIC_NOTIFIER */
|
||
|
|
||
|
#define SM5713_MUIC_REG_AFCTASTATUS 0x2D
|
||
|
#define SM5713_MUIC_REG_REVID1 0x3e
|
||
|
|
||
|
#define SM5713_MUIC_AFC_TA 0x00
|
||
|
#define SM5713_MUIC_QC20 0x01
|
||
|
|
||
|
static struct sm5713_muic_data *afc_init_data;
|
||
|
|
||
|
/* To make AFC work properly on boot */
|
||
|
static int is_charger_ready;
|
||
|
static struct work_struct muic_afc_init_work;
|
||
|
|
||
|
static int afc_prepare_afctxd;
|
||
|
static int afc_prepare_qc20;
|
||
|
|
||
|
static int sm5713_muic_voltage_control(int afctxd, int qc20)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
|
||
|
pr_info("[%s:%s] old_afctxd(0x%x), afctxd(0x%x), qc20(0x%x)\n",
|
||
|
MUIC_DEV_NAME, __func__, muic_data->old_afctxd,
|
||
|
afctxd, qc20);
|
||
|
|
||
|
muic_data->attached_dev = ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
|
||
|
afc_prepare_afctxd = afctxd;
|
||
|
afc_prepare_qc20 = qc20;
|
||
|
|
||
|
cancel_delayed_work(&muic_data->afc_prepare_work);
|
||
|
schedule_delayed_work(&muic_data->afc_prepare_work,
|
||
|
msecs_to_jiffies(100)); /* 100ms */
|
||
|
pr_info("[%s:%s] afc_prepare_work(afctxd=0x%x,qc20=%d) start\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
afc_prepare_afctxd, afc_prepare_qc20);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int muic_disable_afc(int disable)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int ret = 0;
|
||
|
|
||
|
pr_info("[%s:%s] disable: %d\n", MUIC_DEV_NAME, __func__, disable);
|
||
|
|
||
|
if (disable) { /* AFC disable : 9V(12V) -> 5V */
|
||
|
switch (muic_data->attached_dev) {
|
||
|
case ATTACHED_DEV_AFC_CHARGER_9V_MUIC:
|
||
|
case ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_9V_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_PREPARE_MUIC:
|
||
|
pr_info("[%s:%s] attached_dev(%d)\n", MUIC_DEV_NAME,
|
||
|
__func__, muic_data->attached_dev);
|
||
|
|
||
|
if (muic_data->attached_dev ==
|
||
|
ATTACHED_DEV_QC_CHARGER_9V_MUIC) {
|
||
|
muic_data->old_afctxd = muic_data->qc20_vbus;
|
||
|
sm5713_muic_voltage_control(SM5713_ENQC20_5V,
|
||
|
SM5713_MUIC_QC20);
|
||
|
} else {
|
||
|
muic_data->old_afctxd = sm5713_i2c_read_byte(
|
||
|
i2c, SM5713_MUIC_REG_AFCTXD);
|
||
|
sm5713_muic_voltage_control(SM5713_MUIC_HV_5V,
|
||
|
SM5713_MUIC_AFC_TA);
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
pr_info("[%s:%s] skip: attached_dev(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
break;
|
||
|
}
|
||
|
} else { /* AFC enable : 5V -> 9V(12V) */
|
||
|
#if defined(CONFIG_MUIC_SUPPORT_CCIC)
|
||
|
if (muic_data->ccic_afc_state == SM5713_MUIC_AFC_ABNORMAL) {
|
||
|
pr_info("[%s:%s] ccic abnormal: AFC(QC20) skip\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return 0;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
switch (muic_data->attached_dev) {
|
||
|
case ATTACHED_DEV_AFC_CHARGER_5V_MUIC:
|
||
|
case ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_5V_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_PREPARE_MUIC:
|
||
|
pr_info("[%s:%s] attached_dev(%d), old_afctxd(0x%x)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev,
|
||
|
muic_data->old_afctxd);
|
||
|
|
||
|
if (muic_data->attached_dev ==
|
||
|
ATTACHED_DEV_QC_CHARGER_5V_MUIC) {
|
||
|
muic_data->old_afctxd = muic_data->qc20_vbus;
|
||
|
sm5713_muic_voltage_control(SM5713_ENQC20_9V,
|
||
|
SM5713_MUIC_QC20);
|
||
|
} else {
|
||
|
if (muic_data->old_afctxd == 0x00) {
|
||
|
sm5713_muic_voltage_control(
|
||
|
SM5713_MUIC_HV_9V,
|
||
|
SM5713_MUIC_AFC_TA);
|
||
|
} else {
|
||
|
sm5713_muic_voltage_control(
|
||
|
muic_data->old_afctxd,
|
||
|
SM5713_MUIC_AFC_TA);
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
pr_info("[%s:%s] skip: attached_dev(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
int muic_request_disable_afc_state(void)
|
||
|
{
|
||
|
pr_info("[%s:%s]\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
muic_disable_afc(1); /* 9V(12V) -> 5V */
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
EXPORT_SYMBOL(muic_request_disable_afc_state);
|
||
|
|
||
|
int muic_check_fled_state(bool enable, u8 mode)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
|
||
|
pr_info("[%s:%s] enable(%d), mode(%d)\n", MUIC_DEV_NAME, __func__,
|
||
|
enable, mode);
|
||
|
|
||
|
if (mode == FLED_MODE_TORCH) { /* torch */
|
||
|
cancel_delayed_work(&muic_data->afc_torch_work);
|
||
|
pr_info("[%s:%s] afc_torch_work cancel\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
muic_data->fled_torch_enable = enable;
|
||
|
} else if (mode == FLED_MODE_FLASH) { /* flash */
|
||
|
muic_data->fled_flash_enable = enable;
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s] fled_torch_enable(%d), fled_flash_enable(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, muic_data->fled_torch_enable,
|
||
|
muic_data->fled_flash_enable);
|
||
|
|
||
|
if ((muic_data->fled_torch_enable == false) &&
|
||
|
(muic_data->fled_flash_enable == false)) {
|
||
|
if (muic_data->hv_voltage == 5) {
|
||
|
pr_info("[%s:%s] skip high voltage setting\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return 0;
|
||
|
}
|
||
|
if ((mode == FLED_MODE_TORCH) && (enable == false)) {
|
||
|
cancel_delayed_work(&muic_data->afc_torch_work);
|
||
|
schedule_delayed_work(&muic_data->afc_torch_work,
|
||
|
msecs_to_jiffies(5000));
|
||
|
pr_info("[%s:%s] afc_torch_work start(5sec)\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
} else {
|
||
|
muic_disable_afc(0); /* 5V -> 9V(12V) */
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
EXPORT_SYMBOL(muic_check_fled_state);
|
||
|
|
||
|
int sm5713_set_afc_ctrl_reg(struct sm5713_muic_data *muic_data, int shift,
|
||
|
bool on)
|
||
|
{
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
u8 reg_val = 0;
|
||
|
int ret = 0;
|
||
|
|
||
|
pr_info("[%s:%s] Register[%d], set [%d]\n", MUIC_DEV_NAME, __func__,
|
||
|
shift, on);
|
||
|
ret = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCCNTL);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s](%d)\n", MUIC_DEV_NAME, __func__, ret);
|
||
|
if (on)
|
||
|
reg_val = ret | (0x1 << shift);
|
||
|
else
|
||
|
reg_val = ret & ~(0x1 << shift);
|
||
|
|
||
|
if (reg_val ^ ret) {
|
||
|
pr_debug("[%s:%s] reg_val(0x%x) != AFC_CTRL reg(0x%x), update reg\n",
|
||
|
MUIC_DEV_NAME, __func__, reg_val, ret);
|
||
|
|
||
|
ret = sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCCNTL,
|
||
|
reg_val);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s] err write AFC_CTRL(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
} else {
|
||
|
pr_debug("[%s:%s] (0x%x), just return\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
ret = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCCNTL);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s] err read AFC_CTRL(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
else
|
||
|
pr_debug("[%s:%s] AFC_CTRL reg after change(0x%x)\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int muic_get_vbus_value(void)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int vbus_voltage = 0, voltage1 = 0, voltage2 = 0;
|
||
|
int irqvbus = 0;
|
||
|
int intmask2 = 0;
|
||
|
int retry = 0;
|
||
|
|
||
|
pr_info("[%s:%s] attached_dev(%d)\n", MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
|
||
|
intmask2 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_INTMASK2);
|
||
|
intmask2 = intmask2 | 0x04;
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_INTMASK2, intmask2);
|
||
|
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_VBUS_READ, 1);
|
||
|
|
||
|
for (retry = 0; retry < 10 ; retry++) {
|
||
|
msleep(20);
|
||
|
irqvbus = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_INT2);
|
||
|
if (irqvbus & INT2_VBUS_UPDATE_MASK) {
|
||
|
pr_info("[%s:%s] VBUS update Success(%d), retry: %d)\n",
|
||
|
MUIC_DEV_NAME, __func__, irqvbus, retry);
|
||
|
break;
|
||
|
}
|
||
|
pr_info("[%s:%s] VBUS update Fail(%d), retry: %d)\n",
|
||
|
MUIC_DEV_NAME, __func__, irqvbus, retry);
|
||
|
}
|
||
|
intmask2 = intmask2 & 0xFB;
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_INTMASK2, intmask2);
|
||
|
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_VBUS_READ, 0);
|
||
|
|
||
|
if (retry >= 10) {
|
||
|
pr_info("[%s:%s] VBUS update Failed(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, retry);
|
||
|
return 0;
|
||
|
}
|
||
|
voltage1 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_VBUS_VOLTAGE1);
|
||
|
voltage2 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_VBUS_VOLTAGE2);
|
||
|
vbus_voltage = voltage1*1000 + (voltage2*3900)/1000;
|
||
|
|
||
|
pr_info("[%s:%s] voltage1=[0x%02x], voltage2=[0x%02x], vbus_voltage=%d mV\n",
|
||
|
MUIC_DEV_NAME, __func__, voltage1, voltage2, vbus_voltage);
|
||
|
|
||
|
return vbus_voltage;
|
||
|
}
|
||
|
|
||
|
static void muic_afc_prepare_work(struct work_struct *work)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
union power_supply_propval value;
|
||
|
int ret = 0, reg_val = 0;
|
||
|
int retry = 0;
|
||
|
int intmask2 = 0;
|
||
|
int irqafc = 0;
|
||
|
int afcstatus = 0, afc_dpreset = 0;
|
||
|
int vbus_voltage = 0;
|
||
|
int vbus_txd_voltage = 0;
|
||
|
int voltage_min = 0, voltage_max = 0;
|
||
|
|
||
|
pr_info("[%s:%s]\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
for (retry = 0; retry < 10; retry++) {
|
||
|
psy_do_property("sm5713-charger", get,
|
||
|
POWER_SUPPLY_PROP_CURRENT_MAX, value);
|
||
|
if (value.intval <= 500) {
|
||
|
pr_info("[%s:%s]PREPARE Success(%d), retry(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
value.intval, retry);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (value.intval == 1650) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s]PREPARE fail(%d), retry(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, value.intval, retry);
|
||
|
msleep(50);
|
||
|
}
|
||
|
|
||
|
mutex_lock(&muic_data->afc_mutex);
|
||
|
|
||
|
/* QC20 */
|
||
|
if (afc_prepare_qc20 == SM5713_MUIC_QC20) {
|
||
|
pr_info("[%s:%s]QC20: afctxd(0x%x)\n", MUIC_DEV_NAME, __func__,
|
||
|
afc_prepare_afctxd);
|
||
|
|
||
|
ret = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCCNTL);
|
||
|
reg_val = (ret & 0x3F) | (afc_prepare_afctxd<<6);
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCCNTL, reg_val);
|
||
|
pr_info("[%s:%s] read REG_AFCCNTL=0x%x , write REG_AFCCNTL=0x%x , qc20_vbus=%d\n",
|
||
|
MUIC_DEV_NAME, __func__, ret, reg_val,
|
||
|
afc_prepare_afctxd);
|
||
|
|
||
|
muic_data->qc20_vbus = afc_prepare_afctxd;
|
||
|
|
||
|
if (muic_data->qc20_vbus == SM5713_ENQC20_5V) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
} else if (muic_data->qc20_vbus == SM5713_ENQC20_9V) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
} else {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
} else { /* AFC TA */
|
||
|
pr_info("[%s:%s] AFC: afctxd(0x%x), old_afctxd(0x%x)\n",
|
||
|
MUIC_DEV_NAME, __func__, afc_prepare_afctxd,
|
||
|
muic_data->old_afctxd);
|
||
|
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCTXD,
|
||
|
afc_prepare_afctxd);
|
||
|
|
||
|
/* AFC(INT2) mask */
|
||
|
intmask2 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_INTMASK2);
|
||
|
intmask2 = intmask2 | 0x3F;
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_INTMASK2, intmask2);
|
||
|
|
||
|
/* ENAFC set '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 1);
|
||
|
|
||
|
afc_dpreset = 0;
|
||
|
|
||
|
for (retry = 0; retry < 30 ; retry++) {
|
||
|
msleep(50);
|
||
|
irqafc = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_INT2);
|
||
|
if (irqafc & INT2_AFC_ACCEPTED_MASK) {
|
||
|
pr_info("[%s:%s] AFC_ACCEPTED Success(0x%x), retry(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
irqafc, retry);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if ((irqafc & INT2_AFC_TA_ATTACHED_MASK) &&
|
||
|
(afc_dpreset == 1)) {
|
||
|
pr_info("[%s:%s] AFC_TA_ATTACHED(0x%x), retry(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
irqafc, retry);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (irqafc & INT2_AFC_ERROR_MASK) {
|
||
|
/* ENAFC set '0' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data,
|
||
|
AFCCTRL_ENAFC, 0);
|
||
|
/* read AFC_STATUS */
|
||
|
afcstatus = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFCSTATUS);
|
||
|
|
||
|
pr_info("[%s:%s] AFC_ERROR(0x%x), afcstatus(0x%x), retry(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, irqafc,
|
||
|
afcstatus, retry);
|
||
|
|
||
|
/* DP_RESET '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data,
|
||
|
AFCCTRL_DP_RESET, 1);
|
||
|
afc_dpreset = 1;
|
||
|
} else {
|
||
|
pr_info("[%s:%s] AFC_ACCEPTED Fail(0x%x), retry(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
irqafc, retry);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* ENAFC set '0' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 0);
|
||
|
|
||
|
/* AFC(INT2) unmask */
|
||
|
intmask2 = intmask2 & 0xC0;
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_INTMASK2, intmask2);
|
||
|
|
||
|
vbus_voltage = muic_get_vbus_value();
|
||
|
|
||
|
vbus_txd_voltage = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFCTXD);
|
||
|
pr_info("[%s:%s] AFC_TXD [0x%02x]\n", MUIC_DEV_NAME, __func__,
|
||
|
vbus_txd_voltage);
|
||
|
vbus_txd_voltage = 5000 + ((vbus_txd_voltage&0xF0)>>4)*1000;
|
||
|
|
||
|
pr_info("[%s:%s] vbus_voltage:%d mV , AFC_TXD_VOLTAGE:%d mV\n",
|
||
|
MUIC_DEV_NAME, __func__, vbus_voltage,
|
||
|
vbus_txd_voltage);
|
||
|
|
||
|
voltage_min = vbus_txd_voltage - 2000; /* - 2000mV */
|
||
|
voltage_max = vbus_txd_voltage + 1000; /* + 1000mV */
|
||
|
|
||
|
if ((voltage_min <= vbus_voltage) &&
|
||
|
(vbus_voltage <= voltage_max)) { /* AFC DONE */
|
||
|
if (vbus_txd_voltage == 12000) { /* 12V */
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 12V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
} else if (vbus_txd_voltage == 9000) { /* 9V */
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 9V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
} else { /* 5V */
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 5V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
} else {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 5V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
}
|
||
|
afc_prepare_qc20 = 0;
|
||
|
|
||
|
mutex_unlock(&muic_data->afc_mutex);
|
||
|
}
|
||
|
|
||
|
int sm5713_afc_ta_attach(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
union power_supply_propval value;
|
||
|
int ret = 0, afctxd = 0;
|
||
|
int retry = 0;
|
||
|
|
||
|
if (!is_charger_ready) {
|
||
|
pr_info("[%s:%s] charger is not ready, return\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
if (muic_data->pdata->afc_disable) {
|
||
|
pr_info("[%s:%s] AFC is disabled by USER, return\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
muic_data->attached_dev = ATTACHED_DEV_AFC_CHARGER_DISABLED_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s] AFC_TA_ATTACHED\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
/* read VBUS VALID */
|
||
|
ret = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_REVID1);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s] err read VBUS\n", MUIC_DEV_NAME, __func__);
|
||
|
pr_info("[%s:%s] VBUS[0x%02x]\n", MUIC_DEV_NAME, __func__, ret);
|
||
|
if ((ret&0x01) == 0x00) {
|
||
|
pr_info("[%s:%s] VBUS NOT VALID [0x%02x] just return\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* read clear : AFC_STATUS */
|
||
|
ret = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCSTATUS);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s] err read AFC_STATUS\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
pr_info("[%s:%s] AFC_STATUS [0x%02x]\n", MUIC_DEV_NAME, __func__, ret);
|
||
|
|
||
|
if ((muic_data->fled_torch_enable == 1) ||
|
||
|
(muic_data->fled_flash_enable == 1)) {
|
||
|
pr_info("[%s:%s] FLASH or Torch On, Skip AFC\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
muic_data->attached_dev = ATTACHED_DEV_AFC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#if defined(CONFIG_MUIC_SUPPORT_CCIC)
|
||
|
if (muic_data->ccic_afc_state == SM5713_MUIC_AFC_ABNORMAL) {
|
||
|
muic_data->ccic_afc_state_count = 0;
|
||
|
cancel_delayed_work(&muic_data->ccic_afc_work);
|
||
|
cancel_delayed_work(&muic_data->afc_retry_work);
|
||
|
schedule_delayed_work(&muic_data->ccic_afc_work,
|
||
|
msecs_to_jiffies(200));
|
||
|
pr_info("[%s:%s] CCIC Abnormal State, ccic_afc_work(%d) start\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->ccic_afc_state_count);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
muic_data->attached_dev = ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
|
||
|
for (retry = 0; retry < 20; retry++) {
|
||
|
msleep(50);
|
||
|
psy_do_property("sm5713-charger", get,
|
||
|
POWER_SUPPLY_PROP_CURRENT_MAX, value);
|
||
|
if (value.intval <= 500) {
|
||
|
pr_info("[%s:%s]PREPARE Success(%d mA)\n",
|
||
|
MUIC_DEV_NAME, __func__, value.intval);
|
||
|
break;
|
||
|
}
|
||
|
pr_info("[%s:%s]PREPARE fail(%d mA)\n", MUIC_DEV_NAME, __func__,
|
||
|
value.intval);
|
||
|
}
|
||
|
|
||
|
cancel_delayed_work(&muic_data->afc_retry_work);
|
||
|
schedule_delayed_work(&muic_data->afc_retry_work,
|
||
|
msecs_to_jiffies(5000)); /* 5sec */
|
||
|
pr_info("[%s:%s] afc_retry_work(ATTACH) start\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
/* voltage(9.0V) + current(1.65A) setting : 0x46 */
|
||
|
/* voltage(12.0V) + current(2.1A) setting : 0x79 */
|
||
|
afctxd = AFC_TXBYTE_9V_1_65A;
|
||
|
ret = sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCTXD, afctxd);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s] err write AFC_TXD(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
pr_info("[%s:%s] AFC_TXD [0x%02x]\n", MUIC_DEV_NAME, __func__, afctxd);
|
||
|
|
||
|
/* ENAFC set '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 1);
|
||
|
pr_info("[%s:%s] AFCCTRL_ENAFC 1\n", MUIC_DEV_NAME, __func__);
|
||
|
muic_data->afc_retry_count = 0;
|
||
|
muic_data->afc_vbus_retry_count = 0;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int sm5713_afc_ta_accept(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int dev1 = 0;
|
||
|
|
||
|
pr_info("[%s:%s] AFC_ACCEPTED\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
/* ENAFC set '0' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 0);
|
||
|
|
||
|
cancel_delayed_work(&muic_data->afc_retry_work);
|
||
|
pr_info("[%s:%s] afc_retry_work(ACCEPTED) cancel\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
if ((muic_data->fled_torch_enable == 1) ||
|
||
|
(muic_data->fled_flash_enable == 1)) {
|
||
|
pr_info("[%s:%s] FLASH or Torch On, AFC_ACCEPTED VBUS(9V->5V)\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
muic_disable_afc(1); /* 9V(12V) -> 5V */
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
dev1 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_DEVICETYPE1);
|
||
|
pr_info("[%s:%s] dev1 [0x%02x]\n", MUIC_DEV_NAME, __func__, dev1);
|
||
|
if (dev1 & DEV_TYPE1_AFC_TA) {
|
||
|
/* VBUS_READ */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_VBUS_READ, 1);
|
||
|
|
||
|
pr_info("[%s:%s] VBUS READ start(AFC)\n", MUIC_DEV_NAME,
|
||
|
__func__);
|
||
|
if (muic_data->attached_dev !=
|
||
|
ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
muic_data->afc_vbus_retry_count = 0;
|
||
|
} else {
|
||
|
muic_data->attached_dev = ATTACHED_DEV_AFC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] attached_dev(%d)\n", MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int sm5713_afc_vbus_update(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int vbus_txd_voltage = 0;
|
||
|
int vbus_voltage = 0, voltage1 = 0, voltage2 = 0;
|
||
|
int voltage_min = 0, voltage_max = 0;
|
||
|
int dev1 = 0;
|
||
|
int ret = 0, reg_val = 0;
|
||
|
|
||
|
pr_info("[%s:%s] AFC_VBUS_UPDATE\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_VBUS_READ, 0);
|
||
|
|
||
|
if (muic_data->attached_dev == ATTACHED_DEV_NONE_MUIC) {
|
||
|
pr_info("[%s:%s] Device type is None\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
voltage1 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_VBUS_VOLTAGE1);
|
||
|
voltage2 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_VBUS_VOLTAGE2);
|
||
|
vbus_voltage = voltage1*1000 + (voltage2*3900)/1000;
|
||
|
|
||
|
pr_info("[%s:%s] voltage1=[0x%02x], voltage2=[0x%02x], vbus_voltage=%d mV\n",
|
||
|
MUIC_DEV_NAME, __func__, voltage1, voltage2, vbus_voltage);
|
||
|
|
||
|
dev1 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_DEVICETYPE1);
|
||
|
pr_info("[%s:%s] DEVICE_TYPE1 [0x%02x]\n", MUIC_DEV_NAME, __func__,
|
||
|
dev1);
|
||
|
if (dev1 & DEV_TYPE1_QC20_TA) { /* QC20_TA vbus update */
|
||
|
if (muic_data->qc20_vbus == SM5713_ENQC20_12V) {
|
||
|
voltage_min = 10000; /* - 10000mV */
|
||
|
voltage_max = 13000; /* + 13000mV */
|
||
|
} else if (muic_data->qc20_vbus == SM5713_ENQC20_9V) {
|
||
|
voltage_min = 7000; /* - 7000mV */
|
||
|
voltage_max = 10000; /* + 10000mV */
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s] QC20 vbus_voltage:%d mV (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
vbus_voltage, muic_data->qc20_vbus);
|
||
|
|
||
|
if ((voltage_min <= vbus_voltage) &&
|
||
|
(vbus_voltage <= voltage_max)) { /* AFC DONE */
|
||
|
if (muic_data->qc20_vbus == SM5713_ENQC20_12V) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] QC20 12V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
} else if (muic_data->qc20_vbus == SM5713_ENQC20_9V) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] QC20 9V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
} else if (muic_data->qc20_vbus == SM5713_ENQC20_5V) {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] QC20 5V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
} else { /* vbus fail */
|
||
|
if (muic_data->afc_vbus_retry_count < 3) {
|
||
|
msleep(100);
|
||
|
muic_data->afc_vbus_retry_count++;
|
||
|
|
||
|
/* VBUS_READ */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data,
|
||
|
AFCCTRL_VBUS_READ, 1);
|
||
|
pr_info("[%s:%s] [QC20] VBUS READ retry = %d\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->afc_vbus_retry_count);
|
||
|
} else {
|
||
|
msleep(100);
|
||
|
muic_data->qc20_vbus = SM5713_ENQC20_9V;
|
||
|
ret = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFCCNTL);
|
||
|
/* QC20 9V */
|
||
|
reg_val = (ret & 0x3F) |
|
||
|
(muic_data->qc20_vbus<<6);
|
||
|
sm5713_i2c_write_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFCCNTL,
|
||
|
reg_val);
|
||
|
pr_info("[%s:%s] read REG_AFCCNTL=0x%x, write REG_AFCCNTL=0x%x, qc20_vbus=%d\n",
|
||
|
MUIC_DEV_NAME, __func__, ret,
|
||
|
reg_val, muic_data->qc20_vbus);
|
||
|
|
||
|
if (muic_data->qc20_vbus == SM5713_ENQC20_12V) {
|
||
|
/* VBUS_READ */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data,
|
||
|
AFCCTRL_VBUS_READ, 1);
|
||
|
pr_info("[%s:%s] VBUS READ start(QC20-9V)\n",
|
||
|
MUIC_DEV_NAME,
|
||
|
__func__);
|
||
|
muic_data->afc_vbus_retry_count = 0;
|
||
|
} else {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
} else if (dev1 & DEV_TYPE1_AFC_TA) { /* AFC vbus update */
|
||
|
vbus_txd_voltage = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFCTXD);
|
||
|
pr_info("[%s:%s] AFC_TXD [0x%02x]\n", MUIC_DEV_NAME, __func__,
|
||
|
vbus_txd_voltage);
|
||
|
vbus_txd_voltage = 5000 + ((vbus_txd_voltage&0xF0)>>4)*1000;
|
||
|
|
||
|
pr_info("[%s:%s] vbus_voltage:%d mV , AFC_TXD_VOLTAGE:%d mV\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
vbus_voltage, vbus_txd_voltage);
|
||
|
|
||
|
voltage_min = vbus_txd_voltage - 2000; /* - 2000mV */
|
||
|
voltage_max = vbus_txd_voltage + 1000; /* + 1000mV */
|
||
|
|
||
|
if ((voltage_min <= vbus_voltage) &&
|
||
|
(vbus_voltage <= voltage_max)) { /* AFC DONE */
|
||
|
muic_data->afc_vbus_retry_count = 0;
|
||
|
|
||
|
pr_info("[%s:%s] AFC done\n", MUIC_DEV_NAME, __func__);
|
||
|
if (vbus_txd_voltage == 12000) { /* 12V */
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_12V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 12V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
} else if (vbus_txd_voltage == 9000) { /* 9V */
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_9V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 9V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
} else { /* 5V */
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
pr_info("[%s:%s] AFC 5V (%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
}
|
||
|
} else {
|
||
|
/* VBUS_READ */
|
||
|
if (muic_data->afc_vbus_retry_count < 3) {
|
||
|
msleep(100);
|
||
|
muic_data->afc_vbus_retry_count++;
|
||
|
|
||
|
/* VBUS_READ */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data,
|
||
|
AFCCTRL_VBUS_READ, 1);
|
||
|
pr_info("[%s:%s] VBUS READ retry = %d\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->afc_vbus_retry_count);
|
||
|
} else {
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_5V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
muic_data->afc_vbus_retry_count = 0;
|
||
|
}
|
||
|
}
|
||
|
} /* if (dev1 & DEV_TYPE1_QC20_TA){ // QC20_TA vbus update */
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int sm5713_afc_multi_byte(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int multi_byte[15] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
|
||
|
int i = 0;
|
||
|
int ret = 0;
|
||
|
int voltage_find = 0;
|
||
|
|
||
|
pr_info("[%s:%s] AFC_MULTI_BYTE\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
/* ENAFC set '0' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 0);
|
||
|
|
||
|
/* read AFC_RXD1 ~ RXD15 */
|
||
|
voltage_find = 0;
|
||
|
for (i = 0 ; i < 15 ; i++) {
|
||
|
multi_byte[i] = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFC_RXD1 + i);
|
||
|
if (multi_byte[i] < 0) {
|
||
|
pr_err("[%s:%s] err read AFC_RXD%d %d\n",
|
||
|
MUIC_DEV_NAME, __func__, i+1, multi_byte[i]);
|
||
|
}
|
||
|
pr_info("[%s:%s] AFC_RXD%d [0x%02x]\n", MUIC_DEV_NAME, __func__,
|
||
|
i+1, multi_byte[i]);
|
||
|
if (multi_byte[i] == 0x00)
|
||
|
break;
|
||
|
if (i >= 1) /* voltate find */
|
||
|
if (((multi_byte[i]&0xF0)>>4) >=
|
||
|
((multi_byte[voltage_find]&0xF0)>>4))
|
||
|
voltage_find = i;
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s] AFC_RXD%d multi_byte[%d]=0x%02x\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
voltage_find+1, voltage_find, multi_byte[voltage_find]);
|
||
|
|
||
|
ret = sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCTXD,
|
||
|
multi_byte[voltage_find]);
|
||
|
if (ret < 0)
|
||
|
pr_err("[%s:%s] err write AFC_TXD(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
|
||
|
/* ENAFC set '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 1);
|
||
|
pr_info("[%s:%s] AFCCTRL_ENAFC 1\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int sm5713_afc_error(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int value = 0;
|
||
|
int dev1 = 0;
|
||
|
int ret = 0, reg_val = 0;
|
||
|
|
||
|
pr_info("[%s:%s] AFC_ERROR (%d)\n", MUIC_DEV_NAME, __func__,
|
||
|
muic_data->afc_retry_count);
|
||
|
|
||
|
/* ENAFC set '0' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 0);
|
||
|
|
||
|
/* read AFC_STATUS */
|
||
|
value = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCSTATUS);
|
||
|
if (value < 0)
|
||
|
pr_err("[%s:%s] err read AFC_STATUS %d\n",
|
||
|
MUIC_DEV_NAME, __func__, value);
|
||
|
pr_info("[%s:%s] REG_AFCSTATUS [0x%02x]\n", MUIC_DEV_NAME, __func__,
|
||
|
value);
|
||
|
|
||
|
dev1 = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_DEVICETYPE1);
|
||
|
|
||
|
if (muic_data->afc_retry_count < 5) {
|
||
|
pr_info("[%s:%s] DEVICE_TYPE1 [0x%02x]\n",
|
||
|
MUIC_DEV_NAME, __func__, dev1);
|
||
|
if ((dev1 & DEV_TYPE1_QC20_TA) &&
|
||
|
(muic_data->afc_retry_count >= 2)) {
|
||
|
/* QC20_9V_TA */
|
||
|
muic_data->qc20_vbus = SM5713_ENQC20_9V;
|
||
|
ret = sm5713_i2c_read_byte(i2c,
|
||
|
SM5713_MUIC_REG_AFCCNTL);
|
||
|
reg_val = (ret & 0x3F) | (SM5713_ENQC20_9V<<6);
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCCNTL,
|
||
|
reg_val);
|
||
|
pr_info("[%s:%s] read REG_AFCCNTL=0x%x , write REG_AFCCNTL=0x%x , qc20_vbus=%d\n",
|
||
|
MUIC_DEV_NAME, __func__, ret, reg_val,
|
||
|
muic_data->qc20_vbus);
|
||
|
/* VBUS_READ */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data,
|
||
|
AFCCTRL_VBUS_READ, 1);
|
||
|
pr_info("[%s:%s] VBUS READ start(QC20-9V)\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
msleep(50); /* 50ms delay */
|
||
|
} else {
|
||
|
msleep(100); /* 100ms delay */
|
||
|
/* ENAFC set '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 1);
|
||
|
muic_data->afc_retry_count++;
|
||
|
pr_info("[%s:%s] re-start AFC (afc_retry_count=%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
muic_data->afc_retry_count);
|
||
|
}
|
||
|
} else {
|
||
|
pr_info("[%s:%s] ENAFC end = %d\n", MUIC_DEV_NAME, __func__,
|
||
|
muic_data->afc_retry_count);
|
||
|
if (dev1 & DEV_TYPE1_QC20_TA)
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_ERR_V_MUIC;
|
||
|
else
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_AFC_CHARGER_ERR_V_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int sm5713_afc_sta_chg(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
pr_info("[%s:%s] AFC_STA_CHG (attached_dev: %d)\n",
|
||
|
MUIC_DEV_NAME, __func__, muic_data->attached_dev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void hv_muic_change_afc_voltage(int tx_data)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
u8 val = 0;
|
||
|
union power_supply_propval value;
|
||
|
int retry = 0;
|
||
|
|
||
|
|
||
|
pr_info("[%s:%s] change afc voltage(%x)\n",
|
||
|
MUIC_DEV_NAME, __func__, tx_data);
|
||
|
|
||
|
/* QC20 */
|
||
|
if ((muic_data->attached_dev == ATTACHED_DEV_QC_CHARGER_9V_MUIC) ||
|
||
|
(muic_data->attached_dev == ATTACHED_DEV_QC_CHARGER_5V_MUIC)) {
|
||
|
switch (tx_data) {
|
||
|
case SM5713_MUIC_HV_5V:
|
||
|
/* QC20 5V */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_QC20_9V, 0);
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_5V_MUIC;
|
||
|
break;
|
||
|
case SM5713_MUIC_HV_9V:
|
||
|
/* QC20 9V */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_QC20_9V, 1);
|
||
|
muic_data->attached_dev =
|
||
|
ATTACHED_DEV_QC_CHARGER_9V_MUIC;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
} else { /* AFC */
|
||
|
val = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCTXD);
|
||
|
if (val == tx_data) {
|
||
|
pr_info("[%s:%s] same to current voltage 0x%x\n",
|
||
|
MUIC_DEV_NAME, __func__, val);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
for (retry = 0; retry < 10; retry++) {
|
||
|
msleep(50);
|
||
|
psy_do_property("sm5713-charger", get,
|
||
|
POWER_SUPPLY_PROP_CURRENT_MAX, value);
|
||
|
if (value.intval <= 500) {
|
||
|
pr_info("[%s:%s]PREPARE Success(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__,
|
||
|
value.intval);
|
||
|
break;
|
||
|
}
|
||
|
pr_info("[%s:%s]PREPARE fail(%d)\n",
|
||
|
MUIC_DEV_NAME, __func__, value.intval);
|
||
|
}
|
||
|
|
||
|
cancel_delayed_work(&muic_data->afc_retry_work);
|
||
|
schedule_delayed_work(&muic_data->afc_retry_work,
|
||
|
msecs_to_jiffies(5000)); /* 5sec */
|
||
|
pr_info("[%s:%s] afc_retry_work(afc voltage) start\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
sm5713_i2c_write_byte(i2c, SM5713_MUIC_REG_AFCTXD, tx_data);
|
||
|
/* ENAFC set '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 1);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
int sm5713_muic_afc_set_voltage(int vol)
|
||
|
{
|
||
|
int now_vol = 0;
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
|
||
|
switch (muic_data->attached_dev) {
|
||
|
case ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC:
|
||
|
case ATTACHED_DEV_AFC_CHARGER_5V_MUIC:
|
||
|
case ATTACHED_DEV_AFC_CHARGER_5V_DUPLI_MUIC:
|
||
|
case ATTACHED_DEV_AFC_CHARGER_9V_MUIC:
|
||
|
case ATTACHED_DEV_AFC_CHARGER_9V_DUPLI_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_PREPARE_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_5V_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_9V_MUIC:
|
||
|
break;
|
||
|
default:
|
||
|
pr_info("[%s:%s] not HV charger, returnV\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
switch (muic_data->attached_dev) {
|
||
|
case ATTACHED_DEV_AFC_CHARGER_9V_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_9V_MUIC:
|
||
|
now_vol = 9;
|
||
|
break;
|
||
|
case ATTACHED_DEV_AFC_CHARGER_5V_MUIC:
|
||
|
case ATTACHED_DEV_QC_CHARGER_5V_MUIC:
|
||
|
now_vol = 5;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (now_vol == vol) {
|
||
|
pr_info("[%s:%s] same voltage(%d), return\n",
|
||
|
MUIC_DEV_NAME, __func__, vol);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* do not set high voltage at below conditions */
|
||
|
if (vol > 5) {
|
||
|
if ((muic_data->fled_torch_enable == 1) ||
|
||
|
(muic_data->fled_flash_enable == 1)) {
|
||
|
pr_info("[%s:%s] FLASH or Torch On, Skip AFC\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#if defined(CONFIG_MUIC_SUPPORT_CCIC)
|
||
|
if (muic_data->ccic_afc_state == SM5713_MUIC_AFC_ABNORMAL) {
|
||
|
pr_info("[%s:%s] ccic abnormal: AFC(QC20) skip\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return 0;
|
||
|
}
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s] vol = %dV\n", MUIC_DEV_NAME, __func__, vol);
|
||
|
muic_data->hv_voltage = vol;
|
||
|
|
||
|
if (vol == 5) {
|
||
|
hv_muic_change_afc_voltage(SM5713_MUIC_HV_5V);
|
||
|
} else if (vol == 9) {
|
||
|
hv_muic_change_afc_voltage(SM5713_MUIC_HV_9V);
|
||
|
} else if (vol == 12) {
|
||
|
hv_muic_change_afc_voltage(SM5713_MUIC_HV_12V);
|
||
|
} else {
|
||
|
pr_warn("[%s:%s]invalid value\n", MUIC_DEV_NAME, __func__);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void muic_afc_torch_work(struct work_struct *work)
|
||
|
{
|
||
|
pr_info("[%s:%s]\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
muic_disable_afc(0); /* 5V -> 9V(12V) */
|
||
|
}
|
||
|
|
||
|
|
||
|
static void muic_afc_retry_work(struct work_struct *work)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
struct i2c_client *i2c = muic_data->i2c;
|
||
|
int ret = 0, vbus = 0;
|
||
|
|
||
|
ret = sm5713_i2c_read_byte(i2c, SM5713_MUIC_REG_AFCSTATUS);
|
||
|
pr_info("[%s:%s]: Read REG_AFCSTATUS = [0x%02x]\n",
|
||
|
MUIC_DEV_NAME, __func__, ret);
|
||
|
|
||
|
pr_info("[%s:%s] attached_dev = %d\n", MUIC_DEV_NAME, __func__,
|
||
|
muic_data->attached_dev);
|
||
|
|
||
|
if (muic_data->attached_dev == ATTACHED_DEV_AFC_CHARGER_PREPARE_MUIC) {
|
||
|
vbus = sm5713_i2c_read_byte(i2c, 0x3E);
|
||
|
if (!(vbus & 0x01)) {
|
||
|
pr_info("[%s:%s] VBUS is nothing\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
muic_notifier_detach_attached_dev(
|
||
|
muic_data->attached_dev);
|
||
|
muic_data->attached_dev = ATTACHED_DEV_NONE_MUIC;
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
pr_info("[%s:%s] [MUIC] device type is afc prepare, DP_RESET\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
/* DP_RESET '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_DP_RESET, 1);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
#if defined(CONFIG_MUIC_SUPPORT_CCIC)
|
||
|
static void sm5713_muic_ccic_afc_handler(struct work_struct *work)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data =
|
||
|
container_of(work, struct sm5713_muic_data, ccic_afc_work.work);
|
||
|
|
||
|
pr_info("[%s:%s] ccic_afc_state:%d, ccic_afc_state_count:%d\n",
|
||
|
MUIC_DEV_NAME, __func__, muic_data->ccic_afc_state,
|
||
|
muic_data->ccic_afc_state_count);
|
||
|
|
||
|
if (muic_data->ccic_afc_state_count > 4) {
|
||
|
cancel_delayed_work(&muic_data->ccic_afc_work);
|
||
|
muic_data->attached_dev = ATTACHED_DEV_TA_MUIC;
|
||
|
muic_notifier_attach_attached_dev(muic_data->attached_dev);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (muic_data->ccic_afc_state == SM5713_MUIC_AFC_NORMAL) {
|
||
|
pr_info("[%s:%s] SM5713_MUIC_AFC_NORMAL\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
/* ENAFC set '1' */
|
||
|
sm5713_set_afc_ctrl_reg(muic_data, AFCCTRL_ENAFC, 1);
|
||
|
pr_info("[%s:%s] AFCCTRL_ENAFC 1\n", MUIC_DEV_NAME, __func__);
|
||
|
muic_data->afc_retry_count = 0;
|
||
|
muic_data->afc_vbus_retry_count = 0;
|
||
|
} else {
|
||
|
muic_data->ccic_afc_state_count++;
|
||
|
cancel_delayed_work(&muic_data->ccic_afc_work);
|
||
|
schedule_delayed_work(&muic_data->ccic_afc_work,
|
||
|
msecs_to_jiffies(200));
|
||
|
pr_info("[%s:%s] ccic_afc_work(%d) start\n", MUIC_DEV_NAME,
|
||
|
__func__, muic_data->ccic_afc_state_count);
|
||
|
}
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
static void sm5713_hv_muic_init_detect(struct work_struct *work)
|
||
|
{
|
||
|
struct sm5713_muic_data *muic_data = afc_init_data;
|
||
|
int afc_ta_attached = 0;
|
||
|
|
||
|
pr_info("[%s:%s]\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
afc_ta_attached = sm5713_i2c_read_byte(muic_data->i2c,
|
||
|
SM5713_MUIC_REG_AFCTASTATUS);
|
||
|
pr_info("[%s:%s] REG_AFCTASTATUS:[0x%02x]\n", MUIC_DEV_NAME, __func__,
|
||
|
afc_ta_attached);
|
||
|
|
||
|
/* AFC_TA_ATTACHED */
|
||
|
if (afc_ta_attached & 0x01)
|
||
|
sm5713_afc_ta_attach(muic_data);
|
||
|
}
|
||
|
|
||
|
int sm5713_muic_charger_init(void)
|
||
|
{
|
||
|
int ret = -EINVAL;
|
||
|
|
||
|
pr_info("[%s:%s]\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
if (!afc_init_data) {
|
||
|
pr_info("[%s:%s] MUIC AFC is not ready.\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
if (is_charger_ready) {
|
||
|
pr_info("[%s:%s] charger is already ready.\n",
|
||
|
MUIC_DEV_NAME, __func__);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
is_charger_ready = true;
|
||
|
|
||
|
if (afc_init_data->attached_dev == ATTACHED_DEV_TA_MUIC)
|
||
|
schedule_work(&muic_afc_init_work);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void sm5713_hv_muic_initialize(struct sm5713_muic_data *muic_data)
|
||
|
{
|
||
|
pr_info("[%s:%s]\n", MUIC_DEV_NAME, __func__);
|
||
|
|
||
|
afc_init_data = muic_data;
|
||
|
|
||
|
is_charger_ready = false;
|
||
|
|
||
|
/* To make AFC work properly on boot */
|
||
|
INIT_WORK(&muic_afc_init_work, sm5713_hv_muic_init_detect);
|
||
|
|
||
|
INIT_DELAYED_WORK(&muic_data->afc_retry_work, muic_afc_retry_work);
|
||
|
INIT_DELAYED_WORK(&muic_data->afc_torch_work, muic_afc_torch_work);
|
||
|
INIT_DELAYED_WORK(&muic_data->afc_prepare_work, muic_afc_prepare_work);
|
||
|
|
||
|
#if defined(CONFIG_MUIC_SUPPORT_CCIC)
|
||
|
INIT_DELAYED_WORK(&muic_data->ccic_afc_work,
|
||
|
sm5713_muic_ccic_afc_handler);
|
||
|
#endif
|
||
|
}
|
||
|
|