A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-11 07:03:09 -04:00
Code Issues Projects Releases Packages Wiki Activity

power: smb5-lib: Add support for microusb

Browse source 
Add support for typec class registration for
micro usb platform for switching USB composition from UI.

Change-Id: I13e87b4ab099dd5efa56b121da6be227c81f961d
Signed-off-by: Kavya Nunna <knunna@codeaurora.org>
Signed-off-by: Anirudh Ghayal <aghayal@codeaurora.org>
This commit is contained in:
Kavya Nunna 2020-08-31 11:52:35 +05:30 • committed by Gerrit - the friendly Code Review server
commit b1ab97d70d
1 changed files with 103 additions and 91 deletions
Download patch file Download diff file Expand all files Collapse all files

194
drivers/power/supply/qcom/smb5-lib.c
View file

@ -5400,12 +5400,115 @@ irqreturn_t icl_change_irq_handler(int irq, void *data)
return IRQ_HANDLED;
}
static int smblib_role_switch_failure(struct smb_charger *chg)
{
int rc = 0;
union power_supply_propval pval = {0, };
if (!chg->use_extcon)
return 0;
rc = smblib_get_prop_usb_present(chg, &pval);
if (rc < 0) {
smblib_err(chg, "Couldn't get usb presence status rc=%d\n",
rc);
return rc;
}
/*
* When role switch fails notify the
* current charger state to usb driver.
*/
if (pval.intval) {
smblib_dbg(chg, PR_MISC, " Role reversal failed, notifying device mode to usb driver.\n");
smblib_notify_device_mode(chg, true);
}
return rc;
}
static int typec_partner_register(struct smb_charger *chg)
{
int typec_mode, rc = 0;
mutex_lock(&chg->typec_lock);
if (!chg->typec_port || chg->pr_swap_in_progress)
goto unlock;
if (!chg->typec_partner) {
if (chg->sink_src_mode == AUDIO_ACCESS_MODE)
chg->typec_partner_desc.accessory =
TYPEC_ACCESSORY_AUDIO;
else
chg->typec_partner_desc.accessory =
TYPEC_ACCESSORY_NONE;
chg->typec_partner = typec_register_partner(chg->typec_port,
&chg->typec_partner_desc);
if (IS_ERR(chg->typec_partner)) {
rc = PTR_ERR(chg->typec_partner);
pr_err("failed to register typec_partner rc=%d\n", rc);
goto unlock;
}
}
typec_mode = smblib_get_prop_typec_mode(chg);
if (typec_mode >= QTI_POWER_SUPPLY_TYPEC_SOURCE_DEFAULT
|| typec_mode == QTI_POWER_SUPPLY_TYPEC_NONE) {
if (chg->typec_role_swap_failed) {
rc = smblib_role_switch_failure(chg);
if (rc < 0)
smblib_err(chg, "Failed to role switch rc=%d\n",
rc);
chg->typec_role_swap_failed = false;
}
typec_set_data_role(chg->typec_port, TYPEC_DEVICE);
typec_set_pwr_role(chg->typec_port, TYPEC_SINK);
} else {
typec_set_data_role(chg->typec_port, TYPEC_HOST);
typec_set_pwr_role(chg->typec_port, TYPEC_SOURCE);
}
unlock:
mutex_unlock(&chg->typec_lock);
return rc;
}
static void typec_partner_unregister(struct smb_charger *chg)
{
mutex_lock(&chg->typec_lock);
if (!chg->typec_port)
goto unlock;
if (chg->typec_partner && !chg->pr_swap_in_progress) {
smblib_dbg(chg, PR_MISC, "Un-registering typeC partner\n");
typec_unregister_partner(chg->typec_partner);
chg->typec_partner = NULL;
}
unlock:
mutex_unlock(&chg->typec_lock);
}
static void smblib_micro_usb_plugin(struct smb_charger *chg, bool vbus_rising)
{
int rc = 0;
if (!vbus_rising) {
smblib_update_usb_type(chg);
smblib_notify_device_mode(chg, false);
smblib_uusb_removal(chg);
typec_partner_unregister(chg);
} else {
rc = typec_partner_register(chg);
if (rc < 0)
smblib_err(chg, "Couldn't register partner rc =%d\n",
rc);
}
}
@ -5988,97 +6091,6 @@ static void typec_ra_ra_insertion(struct smb_charger *chg)
smblib_hvdcp_detect_enable(chg, true);
}
static int smblib_role_switch_failure(struct smb_charger *chg)
{
int rc = 0;
union power_supply_propval pval = {0, };
if (!chg->use_extcon)
return 0;
rc = smblib_get_prop_usb_present(chg, &pval);
if (rc < 0) {
smblib_err(chg, "Couldn't get usb presence status rc=%d\n",
rc);
return rc;
}
/*
* When role switch fails notify the
* current charger state to usb driver.
*/
if (pval.intval) {
smblib_dbg(chg, PR_MISC, " Role reversal failed, notifying device mode to usb driver.\n");
smblib_notify_device_mode(chg, true);
}
return rc;
}
static int typec_partner_register(struct smb_charger *chg)
{
int typec_mode, rc = 0;
mutex_lock(&chg->typec_lock);
if (!chg->typec_port || chg->pr_swap_in_progress)
goto unlock;
if (!chg->typec_partner) {
if (chg->sink_src_mode == AUDIO_ACCESS_MODE)
chg->typec_partner_desc.accessory =
TYPEC_ACCESSORY_AUDIO;
else
chg->typec_partner_desc.accessory =
TYPEC_ACCESSORY_NONE;
chg->typec_partner = typec_register_partner(chg->typec_port,
&chg->typec_partner_desc);
if (IS_ERR(chg->typec_partner)) {
rc = PTR_ERR(chg->typec_partner);
pr_err("failed to register typec_partner rc=%d\n", rc);
goto unlock;
}
}
typec_mode = smblib_get_prop_typec_mode(chg);
if (typec_mode >= QTI_POWER_SUPPLY_TYPEC_SOURCE_DEFAULT
|| typec_mode == QTI_POWER_SUPPLY_TYPEC_NONE) {
if (chg->typec_role_swap_failed) {
rc = smblib_role_switch_failure(chg);
if (rc < 0)
smblib_err(chg, "Failed to role switch rc=%d\n",
rc);
chg->typec_role_swap_failed = false;
}
typec_set_data_role(chg->typec_port, TYPEC_DEVICE);
typec_set_pwr_role(chg->typec_port, TYPEC_SINK);
} else {
typec_set_data_role(chg->typec_port, TYPEC_HOST);
typec_set_pwr_role(chg->typec_port, TYPEC_SOURCE);
}
unlock:
mutex_unlock(&chg->typec_lock);
return rc;
}
static void typec_partner_unregister(struct smb_charger *chg)
{
mutex_lock(&chg->typec_lock);
if (chg->typec_partner && !chg->pr_swap_in_progress) {
smblib_dbg(chg, PR_MISC, "Un-registering typeC partner\n");
typec_unregister_partner(chg->typec_partner);
chg->typec_partner = NULL;
}
mutex_unlock(&chg->typec_lock);
}
static const char * const dr_mode_text[] = {
"ufp", "dfp", "none"
};