On Fri 01 Apr 13:26 PDT 2022, Caleb Connolly wrote:
> Add a driver for the SMB2 charger block found in the Qualcomm PMI8998
> and PM660.
Are there any differences between the two? Or would it be warranted to
add pm660 in the match table?
>
> Signed-off-by: Caleb Connolly <caleb.connolly@xxxxxxxxxx>
> ---
> drivers/power/supply/Kconfig | 9 +
> drivers/power/supply/Makefile | 1 +
> drivers/power/supply/qcom_smb2.c | 930 +++++++++++++++++++++++++++++++
> 3 files changed, 940 insertions(+)
> create mode 100644 drivers/power/supply/qcom_smb2.c
>
> diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig
> index 1aa8323ad9f6..c72da3d75258 100644
> --- a/drivers/power/supply/Kconfig
> +++ b/drivers/power/supply/Kconfig
> @@ -897,4 +897,13 @@ config BATTERY_UG3105
> device is off or suspended, the functionality of this driver is
> limited to reporting capacity only.
>
> +config CHARGER_QCOM_SMB2
> + tristate "Qualcomm PMIC charger driver"
> + depends on MFD_SPMI_PMIC
> + depends on IIO
> + help
> + Say Y here to enable the Qualcomm PMIC Charger driver. This
> + adds support for the SMB2 switch mode battery charger found
> + in PMI8998 and related PMICs.
> +
> endif # POWER_SUPPLY
> diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile
> index 7f02f36aea55..e5db9eda6a9b 100644
> --- a/drivers/power/supply/Makefile
> +++ b/drivers/power/supply/Makefile
> @@ -108,3 +108,4 @@ obj-$(CONFIG_BATTERY_ACER_A500) += acer_a500_battery.o
> obj-$(CONFIG_BATTERY_SURFACE) += surface_battery.o
> obj-$(CONFIG_CHARGER_SURFACE) += surface_charger.o
> obj-$(CONFIG_BATTERY_UG3105) += ug3105_battery.o
> +obj-$(CONFIG_CHARGER_QCOM_SMB2) += qcom_smb2.o
> diff --git a/drivers/power/supply/qcom_smb2.c b/drivers/power/supply/qcom_smb2.c
> new file mode 100644
> index 000000000000..63100cfc3300
> --- /dev/null
> +++ b/drivers/power/supply/qcom_smb2.c
> @@ -0,0 +1,930 @@
> +// SPDX-License-Identifier: GPL-2.0-only
> +/*
> + * Copyright (c) 2016-2019 The Linux Foundation. All rights reserved.
> + * Copyright (c) 2021, Linaro Ltd.
2021-2022
> + * Author: Caleb Connolly <caleb.connolly@xxxxxxxxxx>
There's two spaces before Author...
> + *
> + * This driver is for the switch-mode battery charger and boost
> + * hardware found in pmi8998 and related PMICs.
> + */
> +
> +#include <linux/bits.h>
> +#include <linux/kernel.h>
> +#include <linux/minmax.h>
> +#include <linux/platform_device.h>
> +#include <linux/of_address.h>
> +#include <linux/regmap.h>
> +#include <linux/regulator/driver.h>
> +#include <linux/device.h>
> +#include <linux/iio/consumer.h>
> +#include <linux/mutex.h>
> +#include <linux/types.h>
> +#include <linux/power_supply.h>
> +#include <linux/module.h>
> +#include <linux/math64.h>
> +#include <linux/of_irq.h>
> +#include <linux/interrupt.h>
> +#include <linux/workqueue.h>
> +
> +#define BATTERY_CHARGER_STATUS_2_REG 0x07
It would be nice if the value of all these defines where indented, to
make these easier to read.
> +#define INPUT_CURRENT_LIMITED_BIT BIT(7)
> +#define CHARGER_ERROR_STATUS_SFT_EXPIRE_BIT BIT(6)
> +#define CHARGER_ERROR_STATUS_BAT_OV_BIT BIT(5)
> +#define CHARGER_ERROR_STATUS_BAT_TERM_MISSING_BIT BIT(4)
> +#define BAT_TEMP_STATUS_MASK GENMASK(3, 0)
> +#define BAT_TEMP_STATUS_SOFT_LIMIT_MASK GENMASK(3, 2)
> +#define BAT_TEMP_STATUS_HOT_SOFT_LIMIT_BIT BIT(3)
> +#define BAT_TEMP_STATUS_COLD_SOFT_LIMIT_BIT BIT(2)
> +#define BAT_TEMP_STATUS_TOO_HOT_BIT BIT(1)
> +#define BAT_TEMP_STATUS_TOO_COLD_BIT BIT(0)
> +
> +#define CHARGING_ENABLE_CMD_REG 0x42
> +#define CHARGING_ENABLE_CMD_BIT BIT(0)
> +
> +#define CHGR_CFG2_REG 0x51
> +#define CHG_EN_SRC_BIT BIT(7)
> +#define CHG_EN_POLARITY_BIT BIT(6)
> +#define PRETOFAST_TRANSITION_CFG_BIT BIT(5)
> +#define BAT_OV_ECC_BIT BIT(4)
> +#define I_TERM_BIT BIT(3)
> +#define AUTO_RECHG_BIT BIT(2)
> +#define EN_ANALOG_DROP_IN_VBATT_BIT BIT(1)
> +#define CHARGER_INHIBIT_BIT BIT(0)
> +
> +#define FAST_CHARGE_CURRENT_CFG_REG 0x61
> +#define FAST_CHARGE_CURRENT_SETTING_MASK GENMASK(7, 0)
> +
> +#define FLOAT_VOLTAGE_CFG_REG 0x70
> +#define FLOAT_VOLTAGE_SETTING_MASK GENMASK(7, 0)
> +
> +#define FG_UPDATE_CFG_2_SEL_REG 0x7D
> +#define SOC_LT_OTG_THRESH_SEL_BIT BIT(3)
> +#define SOC_LT_CHG_RECHARGE_THRESH_SEL_BIT BIT(2)
> +#define VBT_LT_CHG_RECHARGE_THRESH_SEL_BIT BIT(1)
> +#define IBT_LT_CHG_TERM_THRESH_SEL_BIT BIT(0)
> +
> +#define JEITA_EN_CFG_REG 0x90
> +#define JEITA_EN_HARDLIMIT_BIT BIT(4)
> +#define JEITA_EN_HOT_SL_FCV_BIT BIT(3)
> +#define JEITA_EN_COLD_SL_FCV_BIT BIT(2)
> +#define JEITA_EN_HOT_SL_CCC_BIT BIT(1)
> +#define JEITA_EN_COLD_SL_CCC_BIT BIT(0)
> +
> +#define INT_RT_STS 0x310
> +#define TYPE_C_CHANGE_RT_STS_BIT BIT(7)
> +#define USBIN_ICL_CHANGE_RT_STS_BIT BIT(6)
> +#define USBIN_SOURCE_CHANGE_RT_STS_BIT BIT(5)
> +#define USBIN_PLUGIN_RT_STS_BIT BIT(4)
> +#define USBIN_OV_RT_STS_BIT BIT(3)
> +#define USBIN_UV_RT_STS_BIT BIT(2)
> +#define USBIN_LT_3P6V_RT_STS_BIT BIT(1)
> +#define USBIN_COLLAPSE_RT_STS_BIT BIT(0)
> +
> +#define BATTERY_CHARGER_STATUS_1_REG 0x06
> +#define BVR_INITIAL_RAMP_BIT BIT(7)
> +#define CC_SOFT_TERMINATE_BIT BIT(6)
> +#define STEP_CHARGING_STATUS_SHIFT 3
> +#define STEP_CHARGING_STATUS_MASK GENMASK(5, 3)
> +#define BATTERY_CHARGER_STATUS_MASK GENMASK(2, 0)
> +
> +#define BATTERY_HEALTH_STATUS_REG 0x07
> +
> +#define OTG_CFG_REG 0x153
> +#define OTG_RESERVED_MASK GENMASK(7, 6)
> +#define DIS_OTG_ON_TLIM_BIT BIT(5)
> +#define QUICKSTART_OTG_FASTROLESWAP_BIT BIT(4)
> +#define INCREASE_DFP_TIME_BIT BIT(3)
> +#define ENABLE_OTG_IN_DEBUG_MODE_BIT BIT(2)
> +#define OTG_EN_SRC_CFG_BIT BIT(1)
> +#define CONCURRENT_MODE_CFG_BIT BIT(0)
> +
> +#define OTG_ENG_OTG_CFG_REG 0x1C0
> +#define ENG_BUCKBOOST_HALT1_8_MODE_BIT BIT(0)
> +
> +#define APSD_STATUS_REG 0x307
> +#define APSD_STATUS_7_BIT BIT(7)
> +#define HVDCP_CHECK_TIMEOUT_BIT BIT(6)
> +#define SLOW_PLUGIN_TIMEOUT_BIT BIT(5)
> +#define ENUMERATION_DONE_BIT BIT(4)
> +#define VADP_CHANGE_DONE_AFTER_AUTH_BIT BIT(3)
> +#define QC_AUTH_DONE_STATUS_BIT BIT(2)
> +#define QC_CHARGER_BIT BIT(1)
> +#define APSD_DTC_STATUS_DONE_BIT BIT(0)
> +
> +#define APSD_RESULT_STATUS_REG 0x308
> +#define ICL_OVERRIDE_LATCH_BIT BIT(7)
> +#define APSD_RESULT_STATUS_MASK GENMASK(6, 0)
> +#define QC_3P0_BIT BIT(6)
> +#define QC_2P0_BIT BIT(5)
> +#define FLOAT_CHARGER_BIT BIT(4)
> +#define DCP_CHARGER_BIT BIT(3)
> +#define CDP_CHARGER_BIT BIT(2)
> +#define OCP_CHARGER_BIT BIT(1)
> +#define SDP_CHARGER_BIT BIT(0)
> +
> +#define TYPE_C_STATUS_1_REG 0x30B
> +#define UFP_TYPEC_MASK GENMASK(7, 5)
> +#define UFP_TYPEC_RDSTD_BIT BIT(7)
> +#define UFP_TYPEC_RD1P5_BIT BIT(6)
> +#define UFP_TYPEC_RD3P0_BIT BIT(5)
> +#define UFP_TYPEC_FMB_255K_BIT BIT(4)
> +#define UFP_TYPEC_FMB_301K_BIT BIT(3)
> +#define UFP_TYPEC_FMB_523K_BIT BIT(2)
> +#define UFP_TYPEC_FMB_619K_BIT BIT(1)
> +#define UFP_TYPEC_OPEN_OPEN_BIT BIT(0)
> +
> +#define TYPE_C_STATUS_2_REG 0x30C
> +#define DFP_RA_OPEN_BIT BIT(7)
> +#define TIMER_STAGE_BIT BIT(6)
> +#define EXIT_UFP_MODE_BIT BIT(5)
> +#define EXIT_DFP_MODE_BIT BIT(4)
> +#define DFP_TYPEC_MASK GENMASK(3, 0)
> +#define DFP_RD_OPEN_BIT BIT(3)
> +#define DFP_RD_RA_VCONN_BIT BIT(2)
> +#define DFP_RD_RD_BIT BIT(1)
> +#define DFP_RA_RA_BIT BIT(0)
> +
> +#define TYPE_C_STATUS_3_REG 0x30D
> +#define ENABLE_BANDGAP_BIT BIT(7)
> +#define U_USB_GND_NOVBUS_BIT BIT(6)
> +#define U_USB_FLOAT_NOVBUS_BIT BIT(5)
> +#define U_USB_GND_BIT BIT(4)
> +#define U_USB_FMB1_BIT BIT(3)
> +#define U_USB_FLOAT1_BIT BIT(2)
> +#define U_USB_FMB2_BIT BIT(1)
> +#define U_USB_FLOAT2_BIT BIT(0)
> +
> +#define TYPE_C_STATUS_4_REG 0x30E
> +#define UFP_DFP_MODE_STATUS_BIT BIT(7)
> +#define TYPEC_VBUS_STATUS_BIT BIT(6)
> +#define TYPEC_VBUS_ERROR_STATUS_BIT BIT(5)
> +#define TYPEC_DEBOUNCE_DONE_STATUS_BIT BIT(4)
> +#define TYPEC_UFP_AUDIO_ADAPT_STATUS_BIT BIT(3)
> +#define TYPEC_VCONN_OVERCURR_STATUS_BIT BIT(2)
> +#define CC_ORIENTATION_BIT BIT(1)
> +#define CC_ATTACHED_BIT BIT(0)
> +
> +#define TYPE_C_STATUS_5_REG 0x30F
> +#define TRY_SOURCE_FAILED_BIT BIT(6)
> +#define TRY_SINK_FAILED_BIT BIT(5)
> +#define TIMER_STAGE_2_BIT BIT(4)
> +#define TYPEC_LEGACY_CABLE_STATUS_BIT BIT(3)
> +#define TYPEC_NONCOMP_LEGACY_CABLE_STATUS_BIT BIT(2)
> +#define TYPEC_TRYSOURCE_DETECT_STATUS_BIT BIT(1)
> +#define TYPEC_TRYSINK_DETECT_STATUS_BIT BIT(0)
> +
> +#define CMD_APSD_REG 0x341
> +#define ICL_OVERRIDE_BIT BIT(1)
> +#define APSD_RERUN_BIT BIT(0)
> +
> +#define TYPE_C_CFG_REG 0x358
> +#define APSD_START_ON_CC_BIT BIT(7)
> +#define WAIT_FOR_APSD_BIT BIT(6)
> +#define FACTORY_MODE_DETECTION_EN_BIT BIT(5)
> +#define FACTORY_MODE_ICL_3A_4A_BIT BIT(4)
> +#define FACTORY_MODE_DIS_CHGING_CFG_BIT BIT(3)
> +#define SUSPEND_NON_COMPLIANT_CFG_BIT BIT(2)
> +#define VCONN_OC_CFG_BIT BIT(1)
> +#define TYPE_C_OR_U_USB_BIT BIT(0)
> +
> +#define TYPE_C_CFG_2_REG 0x359
> +#define TYPE_C_DFP_CURRSRC_MODE_BIT BIT(7)
> +#define DFP_CC_1P4V_OR_1P6V_BIT BIT(6)
> +#define VCONN_SOFTSTART_CFG_MASK GENMASK(5, 4)
> +#define EN_TRY_SOURCE_MODE_BIT BIT(3)
> +#define USB_FACTORY_MODE_ENABLE_BIT BIT(2)
> +#define TYPE_C_UFP_MODE_BIT BIT(1)
> +#define EN_80UA_180UA_CUR_SOURCE_BIT BIT(0)
> +
> +#define TYPE_C_CFG_3_REG 0x35A
> +#define TVBUS_DEBOUNCE_BIT BIT(7)
> +#define TYPEC_LEGACY_CABLE_INT_EN_BIT BIT(6)
> +#define TYPEC_NONCOMPLIANT_LEGACY_CABLE_INT_EN_BIT BIT(5)
> +#define TYPEC_TRYSOURCE_DETECT_INT_EN_BIT BIT(4)
> +#define TYPEC_TRYSINK_DETECT_INT_EN_BIT BIT(3)
> +#define EN_TRYSINK_MODE_BIT BIT(2)
> +#define EN_LEGACY_CABLE_DETECTION_BIT BIT(1)
> +#define ALLOW_PD_DRING_UFP_TCCDB_BIT BIT(0)
> +
> +#define USBIN_OPTIONS_1_CFG_REG 0x362
> +#define CABLE_R_SEL_BIT BIT(7)
> +#define HVDCP_AUTH_ALG_EN_CFG_BIT BIT(6)
> +#define HVDCP_AUTONOMOUS_MODE_EN_CFG_BIT BIT(5)
> +#define INPUT_PRIORITY_BIT BIT(4)
> +#define AUTO_SRC_DETECT_BIT BIT(3)
> +#define HVDCP_EN_BIT BIT(2)
> +#define VADP_INCREMENT_VOLTAGE_LIMIT_BIT BIT(1)
> +#define VADP_TAPER_TIMER_EN_BIT BIT(0)
> +
> +#define USBIN_OPTIONS_2_CFG_REG 0x363
> +#define WIPWR_RST_EUD_CFG_BIT BIT(7)
> +#define SWITCHER_START_CFG_BIT BIT(6)
> +#define DCD_TIMEOUT_SEL_BIT BIT(5)
> +#define OCD_CURRENT_SEL_BIT BIT(4)
> +#define SLOW_PLUGIN_TIMER_EN_CFG_BIT BIT(3)
> +#define FLOAT_OPTIONS_MASK GENMASK(2, 0)
> +#define FLOAT_DIS_CHGING_CFG_BIT BIT(2)
> +#define SUSPEND_FLOAT_CFG_BIT BIT(1)
> +#define FORCE_FLOAT_SDP_CFG_BIT BIT(0)
> +
> +#define TAPER_TIMER_SEL_CFG_REG 0x364
> +#define TYPEC_SPARE_CFG_BIT BIT(7)
> +#define TYPEC_DRP_DFP_TIME_CFG_BIT BIT(5)
> +#define TAPER_TIMER_SEL_MASK GENMASK(1, 0)
> +
> +#define USBIN_LOAD_CFG_REG 0x365
> +#define USBIN_OV_CH_LOAD_OPTION_BIT BIT(7)
> +#define ICL_OVERRIDE_AFTER_APSD_BIT BIT(4)
> +
> +#define USBIN_ICL_OPTIONS_REG 0x366
> +#define CFG_USB3P0_SEL_BIT BIT(2)
> +#define USB51_MODE_BIT BIT(1)
> +#define USBIN_MODE_CHG_BIT BIT(0)
> +
> +#define TYPE_C_INTRPT_ENB_SOFTWARE_CTRL_REG 0x368
> +#define EXIT_SNK_BASED_ON_CC_BIT BIT(7)
> +#define VCONN_EN_ORIENTATION_BIT BIT(6)
> +#define TYPEC_VCONN_OVERCURR_INT_EN_BIT BIT(5)
> +#define VCONN_EN_SRC_BIT BIT(4)
> +#define VCONN_EN_VALUE_BIT BIT(3)
> +#define TYPEC_POWER_ROLE_CMD_MASK GENMASK(2, 0)
> +#define UFP_EN_CMD_BIT BIT(2)
> +#define DFP_EN_CMD_BIT BIT(1)
> +#define TYPEC_DISABLE_CMD_BIT BIT(0)
> +
> +#define USBIN_CURRENT_LIMIT_CFG_REG 0x370
> +#define USBIN_CURRENT_LIMIT_MASK GENMASK(7, 0)
> +
> +#define USBIN_AICL_OPTIONS_CFG_REG 0x380
> +#define SUSPEND_ON_COLLAPSE_USBIN_BIT BIT(7)
> +#define USBIN_AICL_HDC_EN_BIT BIT(6)
> +#define USBIN_AICL_START_AT_MAX_BIT BIT(5)
> +#define USBIN_AICL_RERUN_EN_BIT BIT(4)
> +#define USBIN_AICL_ADC_EN_BIT BIT(3)
> +#define USBIN_AICL_EN_BIT BIT(2)
> +#define USBIN_HV_COLLAPSE_RESPONSE_BIT BIT(1)
> +#define USBIN_LV_COLLAPSE_RESPONSE_BIT BIT(0)
> +
> +#define DC_ENG_SSUPPLY_CFG2_REG 0x4C1
> +#define ENG_SSUPPLY_IVREF_OTG_SS_MASK GENMASK(2, 0)
> +#define OTG_SS_SLOW 0x3
> +
> +#define DCIN_AICL_REF_SEL_CFG_REG 0x481
> +#define DCIN_CONT_AICL_THRESHOLD_CFG_MASK GENMASK(5, 0)
> +
> +#define WI_PWR_OPTIONS_REG 0x495
> +#define CHG_OK_BIT BIT(7)
> +#define WIPWR_UVLO_IRQ_OPT_BIT BIT(6)
> +#define BUCK_HOLDOFF_ENABLE_BIT BIT(5)
> +#define CHG_OK_HW_SW_SELECT_BIT BIT(4)
> +#define WIPWR_RST_ENABLE_BIT BIT(3)
> +#define DCIN_WIPWR_IRQ_SELECT_BIT BIT(2)
> +#define AICL_SWITCH_ENABLE_BIT BIT(1)
> +#define ZIN_ICL_ENABLE_BIT BIT(0)
> +
> +#define ICL_STATUS_REG 0x607
> +#define INPUT_CURRENT_LIMIT_MASK GENMASK(7, 0)
> +
> +#define POWER_PATH_STATUS_REG 0x60B
> +#define P_PATH_INPUT_SS_DONE_BIT BIT(7)
> +#define P_PATH_USBIN_SUSPEND_STS_BIT BIT(6)
> +#define P_PATH_DCIN_SUSPEND_STS_BIT BIT(5)
> +#define P_PATH_USE_USBIN_BIT BIT(4)
> +#define P_PATH_USE_DCIN_BIT BIT(3)
> +#define P_PATH_POWER_PATH_MASK GENMASK(2, 1)
> +#define P_PATH_VALID_INPUT_POWER_SOURCE_STS_BIT BIT(0)
> +
> +#define WD_CFG_REG 0x651
> +#define WATCHDOG_TRIGGER_AFP_EN_BIT BIT(7)
> +#define BARK_WDOG_INT_EN_BIT BIT(6)
> +#define BITE_WDOG_INT_EN_BIT BIT(5)
> +#define SFT_AFTER_WDOG_IRQ_MASK GENMASK(4, 3)
> +#define WDOG_IRQ_SFT_BIT BIT(2)
> +#define WDOG_TIMER_EN_ON_PLUGIN_BIT BIT(1)
> +#define WDOG_TIMER_EN_BIT BIT(0)
> +
> +#define AICL_RERUN_TIME_CFG_REG 0x661
> +#define AICL_RERUN_TIME_MASK GENMASK(1, 0)
> +
> +#define SDP_CURRENT_UA 500000
> +#define CDP_CURRENT_UA 1500000
> +#define DCP_CURRENT_UA 1500000
> +
> +enum charger_status {
> + TRICKLE_CHARGE = 0,
> + PRE_CHARGE,
> + FAST_CHARGE,
> + FULLON_CHARGE,
> + TAPER_CHARGE,
> + TERMINATE_CHARGE,
> + INHIBIT_CHARGE,
> + DISABLE_CHARGE,
> +};
> +
> +struct smb2_register {
> + u16 addr;
> + u8 mask;
> + u8 val;
> +};
> +
> +/**
> + * struct smb2_chip - smb2 chip structure
> + * @dev: Device reference for power_supply
@name
> + * @base: Base address for smb2 registers
> + * @regmap: Register map
> + * @reg_lock: Mutex for register access
> + * @batt_info: Battery data from DT
status_change_work
> + * @usbin_i_chan: USBIN current measurement channel
> + * @usbin_v_chan: USBIN voltage measurement channel
> + * @chg_psy: Charger power supply instance
> + * @usb_present: True if a charger is attached
> + */
> +struct smb2_chip {
> + struct device *dev;
> + const char *name;
> + unsigned int base;
> + struct regmap *regmap;
> + struct mutex reg_lock;
> + struct power_supply_battery_info *batt_info;
> +
> + struct delayed_work status_change_work;
> +
> + struct iio_channel *usbin_i_chan;
> + struct iio_channel *usbin_v_chan;
> +
> + struct power_supply *chg_psy;
> +
> + bool usb_present;
> +};
> +
> +static enum power_supply_property smb2_properties[] = {
> + POWER_SUPPLY_PROP_MANUFACTURER, POWER_SUPPLY_PROP_MODEL_NAME,
> + POWER_SUPPLY_PROP_CURRENT_MAX, POWER_SUPPLY_PROP_CURRENT_NOW,
> + POWER_SUPPLY_PROP_VOLTAGE_NOW, POWER_SUPPLY_PROP_STATUS,
> + POWER_SUPPLY_PROP_HEALTH, POWER_SUPPLY_PROP_ONLINE,
> + POWER_SUPPLY_PROP_USB_TYPE,
> +};
> +
> +static enum power_supply_usb_type smb2_usb_types[] = {
> + POWER_SUPPLY_USB_TYPE_SDP, POWER_SUPPLY_USB_TYPE_DCP,
> + POWER_SUPPLY_USB_TYPE_CDP, POWER_SUPPLY_USB_TYPE_C,
> + POWER_SUPPLY_USB_TYPE_PD_DRP
> +};
> +
> +/*
> + * Qualcomm "automatic power source detection" aka APSD
> + * tells us what type of charger we're connected to.
> + */
> +static int smb2_apsd_get_charger_type(struct smb2_chip *chip, int *val)
> +{
> + int rc;
> + unsigned int apsd_stat, stat;
> +
> + mutex_lock(&chip->reg_lock);
> +
> + rc = regmap_read(chip->regmap, chip->base + APSD_STATUS_REG,
> + &apsd_stat);
> + if (rc < 0) {
> + dev_err(chip->dev, "Failed to read apsd status, rc = %d", rc);
> + return rc;
> + }
> + if (!(apsd_stat & APSD_DTC_STATUS_DONE_BIT)) {
> + dev_err(chip->dev, "Apsd not ready");
> + return -EAGAIN;
> + }
> +
> + rc = regmap_read(chip->regmap, chip->base + APSD_RESULT_STATUS_REG,
> + &stat);
> + if (rc < 0) {
> + dev_err(chip->dev, "Failed to read apsd result, rc = %d", rc);
> + return rc;
> + }
> +
> + mutex_unlock(&chip->reg_lock);
> +
> + stat &= APSD_RESULT_STATUS_MASK;
> +
> + if (stat & CDP_CHARGER_BIT) {
> + *val = POWER_SUPPLY_USB_TYPE_CDP;
> + } else if (stat &
> + (DCP_CHARGER_BIT | OCP_CHARGER_BIT | FLOAT_CHARGER_BIT)) {
> + *val = POWER_SUPPLY_USB_TYPE_DCP;
> + } else { /* SDP_CHARGER_BIT (or others) */
> + *val = POWER_SUPPLY_USB_TYPE_SDP;
> + }
> +
> + return 0;
> +}
> +
> +int smb2_get_prop_usb_online(struct smb2_chip *chip, int *val)
> +{
> + unsigned int stat;
> + int rc;
> +
> + rc = regmap_read(chip->regmap, chip->base + POWER_PATH_STATUS_REG,
> + &stat);
> + if (rc < 0) {
> + dev_err(chip->dev, "Couldn't read POWER_PATH_STATUS! ret=%d\n",
> + rc);
> + return rc;
> + }
> +
> + *val = (stat & P_PATH_USE_USBIN_BIT) &&
> + (stat & P_PATH_VALID_INPUT_POWER_SOURCE_STS_BIT);
> + return rc;
return 0;
> +}
> +
> +int smb2_get_prop_status(struct smb2_chip *chip, int *val)
> +{
> + int usb_online_val;
> + unsigned int stat;
> + int rc;
> + bool usb_online;
> +
> + mutex_lock(&chip->reg_lock);
> +
> + rc = smb2_get_prop_usb_online(chip, &usb_online_val);
> + if (rc < 0) {
> + dev_err(chip->dev, "Couldn't get usb online property rc = %d\n",
> + rc);
> + return rc;
> + }
> + usb_online = (bool)usb_online_val;
No need to move this value over to a bool variable, just to check if
it's 0.
> +
> + if (!usb_online) {
> + *val = POWER_SUPPLY_STATUS_DISCHARGING;
> + return rc;
> + }
> +
> + rc = regmap_read(chip->regmap,
> + chip->base + BATTERY_CHARGER_STATUS_1_REG, &stat);
> + if (rc < 0) {
> + dev_err(chip->dev,
> + "Failed to read charging status ret=%d\n", rc);
> + return rc;
> + }
> +
> + mutex_unlock(&chip->reg_lock);
> +
> + stat = stat & BATTERY_CHARGER_STATUS_MASK;
> +
> + switch (stat) {
> + case TRICKLE_CHARGE:
> + case PRE_CHARGE:
> + case FAST_CHARGE:
> + case FULLON_CHARGE:
> + case TAPER_CHARGE:
> + *val = POWER_SUPPLY_STATUS_CHARGING;
> + return rc;
> + case DISABLE_CHARGE:
> + *val = POWER_SUPPLY_STATUS_NOT_CHARGING;
> + return rc;
> + case TERMINATE_CHARGE:
> + *val = POWER_SUPPLY_STATUS_FULL;
> + return rc;
> + case INHIBIT_CHARGE:
> + default:
> + *val = POWER_SUPPLY_STATUS_UNKNOWN;
> + return rc;
> + }
> +}
> +
> +static inline int smb2_get_current_limit(struct smb2_chip *chip,
> + unsigned int *val)
> +{
> + int rc = regmap_read(chip->regmap, chip->base + ICL_STATUS_REG, val);
> +
> + if (rc >= 0)
> + *val *= 25000;
> + return rc;
> +}
> +
> +static inline int smb2_set_current_limit(struct smb2_chip *chip,
> + unsigned int val)
> +{
> + unsigned char val_raw;
> +
> + if (val > 4800000) {
> + dev_err(chip->dev,
> + "Can't set current limit higher than 4800000uA");
> + return -EINVAL;
> + }
> + val_raw = val / 25000;
> + return regmap_write(chip->regmap,
> + chip->base + USBIN_CURRENT_LIMIT_CFG_REG, val_raw);
> +}
> +
> +void smb2_status_change_work(struct work_struct *work)
> +{
> + struct smb2_chip *chip =
> + container_of(work, struct smb2_chip, status_change_work.work);
> + unsigned int charger_type, current_ua;
> + int usb_online, count, rc;
> +
> + mutex_lock(&chip->reg_lock);
> +
> + smb2_get_prop_usb_online(chip, &usb_online);
> + if (usb_online == 0)
reg_lock is held here.
> + return;
> +
> + for (count = 0; count < 3; count++) {
> + dev_info(chip->dev, "get charger type retry %d\n", count);
> + rc = smb2_apsd_get_charger_type(chip, &charger_type);
> + if (rc == 0)
> + break;
> + msleep(100);
> + }
> +
> + if (rc < 0) {
> + rc = regmap_update_bits(chip->regmap, chip->base + CMD_APSD_REG,
> + APSD_RERUN_BIT, APSD_RERUN_BIT);
> + schedule_delayed_work(&chip->status_change_work,
> + msecs_to_jiffies(1500));
reg_lock is held here.
> + return;
> + }
> +
> + switch (charger_type) {
> + case POWER_SUPPLY_USB_TYPE_CDP:
> + current_ua = CDP_CURRENT_UA;
> + break;
> + case POWER_SUPPLY_USB_TYPE_DCP:
> + current_ua = DCP_CURRENT_UA;
> + break;
> + case POWER_SUPPLY_USB_TYPE_SDP:
> + default:
> + current_ua = SDP_CURRENT_UA;
> + break;
> + }
> +
> + smb2_set_current_limit(chip, current_ua);
> + mutex_unlock(&chip->reg_lock);
> + power_supply_changed(chip->chg_psy);
> +}
> +
> +int smb2_get_iio_chan(struct smb2_chip *chip, struct iio_channel *chan,
> + int *val)
> +{
> + int rc = 0;
First use of "rc" is an assignment, no need to initialize it here.
> + union power_supply_propval status;
> +
> + rc = power_supply_get_property(chip->chg_psy, POWER_SUPPLY_PROP_STATUS,
> + &status);
> + if (rc < 0 || status.intval != POWER_SUPPLY_STATUS_CHARGING) {
> + *val = 0;
> + return 0;
> + }
> +
> + if (IS_ERR(chan)) {
> + dev_err(chip->dev, "Failed to chan, err = %li", PTR_ERR(chan));
> + return PTR_ERR(chan);
> + }
> +
> + rc = iio_read_channel_processed(chan, val);
return iio_read_channel_processed()
> + return rc;
> +}
> +
> +int smb2_get_prop_health(struct smb2_chip *chip, int *val)
> +{
> + int rc;
> + unsigned int stat;
> +
> + *val = POWER_SUPPLY_HEALTH_UNKNOWN;
> +
> + rc = regmap_read(chip->regmap,
> + chip->base + BATTERY_CHARGER_STATUS_2_REG, &stat);
> + if (rc < 0) {
> + dev_err(chip->dev, "Couldn't read charger status rc=%d\n", rc);
> + return rc;
> + }
> +
> + switch (stat & BATTERY_CHARGER_STATUS_MASK) {
> + case CHARGER_ERROR_STATUS_BAT_OV_BIT:
> + *val = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
> + return 0;
> + case BAT_TEMP_STATUS_TOO_COLD_BIT:
> + *val = POWER_SUPPLY_HEALTH_COLD;
> + return 0;
> + case BAT_TEMP_STATUS_TOO_HOT_BIT:
> + *val = POWER_SUPPLY_HEALTH_OVERHEAT;
> + return 0;
> + case BAT_TEMP_STATUS_COLD_SOFT_LIMIT_BIT:
> + *val = POWER_SUPPLY_HEALTH_COOL;
> + return 0;
> + case BAT_TEMP_STATUS_HOT_SOFT_LIMIT_BIT:
> + *val = POWER_SUPPLY_HEALTH_WARM;
> + return 0;
> + default:
> + *val = POWER_SUPPLY_HEALTH_GOOD;
> + return 0;
> + }
> +}
> +
> +static int smb2_get_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + union power_supply_propval *val)
> +{
> + struct smb2_chip *chip = power_supply_get_drvdata(psy);
> + int error = 0;
error is only ever assigned, never used. Perhaps drop it?
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_MANUFACTURER:
> + val->strval = "Qualcomm";
> + return 0;
> + case POWER_SUPPLY_PROP_MODEL_NAME:
> + val->strval = chip->name;
> + return 0;
> + case POWER_SUPPLY_PROP_CURRENT_MAX:
> + error = smb2_get_current_limit(chip, &val->intval);
> + return 0;
> + case POWER_SUPPLY_PROP_CURRENT_NOW:
> + error = smb2_get_iio_chan(chip, chip->usbin_i_chan,
> + &val->intval);
> + return 0;
> + case POWER_SUPPLY_PROP_VOLTAGE_NOW:
> + error = smb2_get_iio_chan(chip, chip->usbin_v_chan,
> + &val->intval);
> + return 0;
> + case POWER_SUPPLY_PROP_ONLINE:
> + error = smb2_get_prop_usb_online(chip, &val->intval);
> + return 0;
> + case POWER_SUPPLY_PROP_STATUS:
> + error = smb2_get_prop_status(chip, &val->intval);
> + return 0;
> + case POWER_SUPPLY_PROP_HEALTH:
> + error = smb2_get_prop_health(chip, &val->intval);
> + return 0;
> + case POWER_SUPPLY_PROP_USB_TYPE:
> + error = smb2_apsd_get_charger_type(chip, &val->intval);
> + return 0;
> + default:
> + dev_err(chip->dev, "invalid property: %d\n", psp);
> + return -EINVAL;
> + }
> +}
> +
> +static int smb2_set_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + const union power_supply_propval *val)
> +{
> + struct smb2_chip *chip = power_supply_get_drvdata(psy);
> + int error = 0;
All code paths to return assigned error, no need to assign it here.
> +
> + dev_info(chip->dev, "Setting property: %d", psp);
> +
> + mutex_lock(&chip->reg_lock);
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_CURRENT_MAX:
> + error = smb2_set_current_limit(chip, val->intval);
> + break;
> + default:
> + dev_err(chip->dev, "No setter for property: %d\n", psp);
> + error = -EINVAL;
> + }
> +
> + mutex_unlock(&chip->reg_lock);
> +
> + return error;
> +}
> +
> +static int smb2_property_is_writable(struct power_supply *psy,
> + enum power_supply_property psp)
> +{
> + switch (psp) {
> + case POWER_SUPPLY_PROP_CURRENT_MAX:
> + return 1;
> + default:
> + return 0;
> + }
> +}
> +
> +irqreturn_t smb2_handle_usb_plugin(int irq, void *data)
> +{
> + struct smb2_chip *chip = data;
> + int rc;
> + unsigned int intrt_stat;
> +
> + rc = regmap_read(chip->regmap, chip->base + INT_RT_STS, &intrt_stat);
> + if (rc < 0) {
> + dev_err(chip->dev,
> + "Couldn't read USB status from reg! ret=%d\n", rc);
> + return rc;
> + }
> +
> + chip->usb_present = (bool)(intrt_stat & USBIN_PLUGIN_RT_STS_BIT);
No need to explicitly cast this to bool.
> +
> + power_supply_changed(chip->chg_psy);
> +
> + schedule_delayed_work(&chip->status_change_work,
> + msecs_to_jiffies(1000));
> +
> + return IRQ_HANDLED;
> +}
> +
> +static const struct power_supply_desc smb2_psy_desc = {
> + .name = "usb",
> + .type = POWER_SUPPLY_TYPE_USB,
> + .usb_types = smb2_usb_types,
> + .num_usb_types = ARRAY_SIZE(smb2_usb_types),
> + .properties = smb2_properties,
> + .num_properties = ARRAY_SIZE(smb2_properties),
> + .get_property = smb2_get_property,
> + .set_property = smb2_set_property,
> + .property_is_writeable = smb2_property_is_writable,
> +};
> +
> +/* Init sequence derived from downstream driver */
> +static struct smb2_register smb2_init_seq[] = {
> + { .addr = AICL_RERUN_TIME_CFG_REG,
> + .mask = AICL_RERUN_TIME_MASK,
> + .val = 0 },
> + { .addr = USBIN_AICL_OPTIONS_CFG_REG,
> + .mask = USBIN_AICL_START_AT_MAX_BIT | USBIN_AICL_ADC_EN_BIT,
> + .val = 0 },
> + /*
> + * By default configure us as an upstream facing port
> + * FIXME: for OTG we should set UFP_EN_CMD_BIT and DFP_EN_CMD_BIT both to 0
> + */
> + { .addr = TYPE_C_INTRPT_ENB_SOFTWARE_CTRL_REG,
> + .mask = TYPEC_POWER_ROLE_CMD_MASK | VCONN_EN_SRC_BIT |
> + VCONN_EN_VALUE_BIT,
> + .val = VCONN_EN_SRC_BIT | UFP_EN_CMD_BIT },
> + /*
> + * disable Type-C factory mode and stay in Attached.SRC state when VCONN
> + * over-current happens
> + */
> + { .addr = TYPE_C_CFG_REG,
> + .mask = FACTORY_MODE_DETECTION_EN_BIT | VCONN_OC_CFG_BIT,
> + .val = 0 },
> + /* Configure VBUS for software control */
> + { .addr = OTG_CFG_REG, .mask = OTG_EN_SRC_CFG_BIT, .val = 0 },
> + { .addr = FG_UPDATE_CFG_2_SEL_REG,
> + .mask = SOC_LT_CHG_RECHARGE_THRESH_SEL_BIT |
> + VBT_LT_CHG_RECHARGE_THRESH_SEL_BIT,
> + .val = VBT_LT_CHG_RECHARGE_THRESH_SEL_BIT },
> + /* Enable automatic input current limit */
> + { .addr = USBIN_AICL_OPTIONS_CFG_REG,
> + .mask = USBIN_AICL_EN_BIT,
> + .val = 1 },
> + { .addr = USBIN_OPTIONS_1_CFG_REG, .mask = HVDCP_EN_BIT, .val = 0 },
> + { .addr = CHARGING_ENABLE_CMD_REG,
> + .mask = CHARGING_ENABLE_CMD_BIT,
> + .val = CHARGING_ENABLE_CMD_BIT },
> + { .addr = USBIN_LOAD_CFG_REG,
> + .mask = ICL_OVERRIDE_AFTER_APSD_BIT,
> + .val = ICL_OVERRIDE_AFTER_APSD_BIT },
> + { .addr = CHGR_CFG2_REG,
> + .mask = CHG_EN_POLARITY_BIT | CHG_EN_SRC_BIT,
> + .val = 0 },
> + { .addr = TYPE_C_INTRPT_ENB_SOFTWARE_CTRL_REG,
> + .mask = UFP_EN_CMD_BIT,
> + .val = UFP_EN_CMD_BIT },
> + /* Set the default SDP charger type to a 500ma USB 2.0 port
> + * and apply ICL override? (OnePlus 6 hack??)
> + */
> + { .addr = USBIN_ICL_OPTIONS_REG,
> + .mask = USB51_MODE_BIT | USBIN_MODE_CHG_BIT,
> + .val = USB51_MODE_BIT }, //| USBIN_MODE_CHG_BIT },
> +};
> +
> +static int smb2_init_hw(struct smb2_chip *chip)
> +{
> + int rc, i;
> +
> + for (i = 0; i < ARRAY_SIZE(smb2_init_seq); i++) {
> + dev_info(chip->dev, "%d: Writing 0x%02x to 0x%02x\n", i,
> + smb2_init_seq[i].val, smb2_init_seq[i].addr);
> + rc = regmap_update_bits(chip->regmap,
> + chip->base + smb2_init_seq[i].addr,
> + smb2_init_seq[i].mask,
> + smb2_init_seq[i].val);
> + if (rc < 0) {
> + dev_err(chip->dev,
> + "%s: Failed to write 0x%02x to 0x%02x: %d\n",
> + __func__, smb2_init_seq[i].val,
> + smb2_init_seq[i].addr, rc);
> + return rc;
> + }
> + }
> +
> + smb2_set_current_limit(chip, 1950 * 1000);
> + return rc;
rc is 0, so return 0;
> +}
> +
> +static int smb2_probe(struct platform_device *pdev)
> +{
> + struct power_supply_config supply_config = {};
> + struct smb2_chip *chip;
> + int rc = 0, irq;
First use of rc is assignment, no need to initialize it here.
> +
> + chip = devm_kzalloc(&pdev->dev, sizeof(*chip), GFP_KERNEL);
> + if (!chip)
> + return -ENOMEM;
> +
> + chip->dev = &pdev->dev;
> + chip->name = pdev->name;
> + mutex_init(&chip->reg_lock);
> +
> + chip->regmap = dev_get_regmap(pdev->dev.parent, NULL);
> + if (!chip->regmap) {
> + dev_err(chip->dev, "failed to locate the regmap\n");
> + return -ENODEV;
> + }
> +
> + rc = device_property_read_u32(chip->dev, "reg", &chip->base);
> + if (rc < 0) {
> + dev_err(chip->dev, "Couldn't read base address from dt: %d\n",
> + rc);
> + return rc;
> + }
> +
> + irq = of_irq_get_byname(pdev->dev.of_node, "usb-plugin");
> + if (irq < 0) {
> + dev_err(&pdev->dev, "Couldn't get irq usb-plugin byname\n");
Using dev_err_probe() instead is quite useful in that it leaves the
message in /sys/kernel/debug/devices_deferred, so please use that
whenever applicable.
> + return irq;
> + }
> +
> + rc = devm_request_threaded_irq(chip->dev, irq, NULL,
> + smb2_handle_usb_plugin, IRQF_ONESHOT,
> + "usb-plugin", chip);
> + if (rc < 0) {
> + dev_err(chip->dev, "Couldn't request irq %d\n", irq);
> + return rc;
> + }
> +
> + chip->usbin_v_chan = iio_channel_get(chip->dev, "usbin_v");
> + chip->usbin_i_chan = iio_channel_get(chip->dev, "usbin_i");
> +
> + /* RRADC should probe before us, but just in case it doesn't */
> + if (PTR_ERR(chip->usbin_v_chan) == -EPROBE_DEFER ||
> + PTR_ERR(chip->usbin_i_chan) == -EPROBE_DEFER) {
> + return -EPROBE_DEFER;
Don't you need to iio_channel_release(usbin_v_chan), in the case where
usbin_i_chan was the one deferring?
> + }
> +
> + rc = smb2_init_hw(chip);
> + if (rc < 0) {
> + dev_err(chip->dev, "Couldn't init hw %d\n", rc);
You already printed a more specific error in smb2_init_hw(), no need for
another.
> + return rc;
> + }
> +
> + supply_config.drv_data = chip;
> + supply_config.of_node = pdev->dev.of_node;
> +
> + chip->chg_psy = devm_power_supply_register(chip->dev, &smb2_psy_desc,
> + &supply_config);
> + if (IS_ERR(chip->chg_psy)) {
> + dev_err(&pdev->dev, "failed to register power supply\n");
> + return PTR_ERR(chip->chg_psy);
> + }
> +
> + rc = power_supply_get_battery_info(chip->chg_psy, &chip->batt_info);
> + if (rc) {
> + dev_err(&pdev->dev, "Failed to get battery info: %d\n", rc);
> + return rc;
> + }
> +
> + INIT_DELAYED_WORK(&chip->status_change_work, smb2_status_change_work);
> +
> + rc = chip->batt_info->voltage_max_design_uv;
> + rc = regmap_update_bits(chip->regmap,
> + chip->base + FLOAT_VOLTAGE_CFG_REG,
> + FLOAT_VOLTAGE_SETTING_MASK, rc / 1000);
> + if (rc < 0)
> + dev_err(chip->dev, "Couldn't set vbat max rc = %d\n", rc);
> +
> + platform_set_drvdata(pdev, chip);
> +
> + /* trigger the IRQ to set up initial state */
> + smb2_handle_usb_plugin(irq, chip);
> +
> + return 0;
> +}
> +
> +static int smb2_remove(struct platform_device *pdev)
> +{
> + struct smb2_chip *chip = platform_get_drvdata(pdev);
> +
> + power_supply_put_battery_info(chip->chg_psy, chip->batt_info);
power_supply_put_battery_info() only consists of devm_kfree() calls,
which in practice means that this shouldn't be needed. But neither the
name "power_supply_get_battery_info" or the (absent) kernel-doc
describes that.
So I would prefer that power_supply_get_battery_info() was improved and
this call to be dropped.
> + return 0;
> +}
> +
> +static const struct of_device_id fg_match_id_table[] = {
Why is this the "fuel gauge" match table?
Regards,
Bjorn
> + { .compatible = "qcom,pmi8998-smb2" },
> + { /* sentinal */ }
> +};
> +MODULE_DEVICE_TABLE(of, fg_match_id_table);
> +
> +static struct platform_driver qcom_spmi_smb2 = {
> + .probe = smb2_probe,
> + .remove = smb2_remove,
> + .driver = {
> + .name = "qcom-spmi-smb2",
> + .of_match_table = fg_match_id_table,
> + },
> +};
> +
> +module_platform_driver(qcom_spmi_smb2);
> +
> +MODULE_AUTHOR("Caleb Connolly <caleb.connolly@xxxxxxxxxx>");
> +MODULE_DESCRIPTION("Qualcomm SMB2 Charger Driver");
> +MODULE_LICENSE("GPL");
> --
> 2.35.1
>
