Commit c3297950 authored by Paul Fertser's avatar Paul Fertser Committed by Anton Vorontsov

pcf50633: Query charger status directly

Current scheme is fragile and is likely to go off sync, especially on
batfull->adapter charging automatic MBC transition.

Query the status bit every time we need it instead.

We need to export another function to query for USB presence because
we can't read anything from PCF50633 (via I2C) inside irq context and
that is needed by usb gadgets.
Signed-off-by: default avatarPaul Fertser <fercerpav@gmail.com>
Signed-off-by: default avatarAnton Vorontsov <cbouatmailru@gmail.com>
parent 1282b35a
...@@ -29,9 +29,7 @@ ...@@ -29,9 +29,7 @@
struct pcf50633_mbc { struct pcf50633_mbc {
struct pcf50633 *pcf; struct pcf50633 *pcf;
int adapter_active;
int adapter_online; int adapter_online;
int usb_active;
int usb_online; int usb_online;
struct power_supply usb; struct power_supply usb;
...@@ -88,7 +86,7 @@ int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma) ...@@ -88,7 +86,7 @@ int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma)
pcf50633_reg_write(mbc->pcf, PCF50633_REG_MBCC5, mbcc5); pcf50633_reg_write(mbc->pcf, PCF50633_REG_MBCC5, mbcc5);
} }
mbcs2 = pcf50633_reg_read(pcf, PCF50633_REG_MBCS2); mbcs2 = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCS2);
chgmod = (mbcs2 & PCF50633_MBCS2_MBC_MASK); chgmod = (mbcs2 & PCF50633_MBCS2_MBC_MASK);
/* If chgmod == BATFULL, setting chgena has no effect. /* If chgmod == BATFULL, setting chgena has no effect.
...@@ -105,8 +103,6 @@ int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma) ...@@ -105,8 +103,6 @@ int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma)
PCF50633_MBCC1_CHGENA, PCF50633_MBCC1_CHGENA); PCF50633_MBCC1_CHGENA, PCF50633_MBCC1_CHGENA);
} }
mbc->usb_active = charging_start;
power_supply_changed(&mbc->usb); power_supply_changed(&mbc->usb);
return ret; return ret;
...@@ -117,20 +113,44 @@ int pcf50633_mbc_get_status(struct pcf50633 *pcf) ...@@ -117,20 +113,44 @@ int pcf50633_mbc_get_status(struct pcf50633 *pcf)
{ {
struct pcf50633_mbc *mbc = platform_get_drvdata(pcf->mbc_pdev); struct pcf50633_mbc *mbc = platform_get_drvdata(pcf->mbc_pdev);
int status = 0; int status = 0;
u8 chgmod;
if (!mbc)
return 0;
chgmod = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCS2)
& PCF50633_MBCS2_MBC_MASK;
if (mbc->usb_online) if (mbc->usb_online)
status |= PCF50633_MBC_USB_ONLINE; status |= PCF50633_MBC_USB_ONLINE;
if (mbc->usb_active) if (chgmod == PCF50633_MBCS2_MBC_USB_PRE ||
chgmod == PCF50633_MBCS2_MBC_USB_PRE_WAIT ||
chgmod == PCF50633_MBCS2_MBC_USB_FAST ||
chgmod == PCF50633_MBCS2_MBC_USB_FAST_WAIT)
status |= PCF50633_MBC_USB_ACTIVE; status |= PCF50633_MBC_USB_ACTIVE;
if (mbc->adapter_online) if (mbc->adapter_online)
status |= PCF50633_MBC_ADAPTER_ONLINE; status |= PCF50633_MBC_ADAPTER_ONLINE;
if (mbc->adapter_active) if (chgmod == PCF50633_MBCS2_MBC_ADP_PRE ||
chgmod == PCF50633_MBCS2_MBC_ADP_PRE_WAIT ||
chgmod == PCF50633_MBCS2_MBC_ADP_FAST ||
chgmod == PCF50633_MBCS2_MBC_ADP_FAST_WAIT)
status |= PCF50633_MBC_ADAPTER_ACTIVE; status |= PCF50633_MBC_ADAPTER_ACTIVE;
return status; return status;
} }
EXPORT_SYMBOL_GPL(pcf50633_mbc_get_status); EXPORT_SYMBOL_GPL(pcf50633_mbc_get_status);
int pcf50633_mbc_get_usb_online_status(struct pcf50633 *pcf)
{
struct pcf50633_mbc *mbc = platform_get_drvdata(pcf->mbc_pdev);
if (!mbc)
return 0;
return mbc->usb_online;
}
EXPORT_SYMBOL_GPL(pcf50633_mbc_get_usb_online_status);
static ssize_t static ssize_t
show_chgmode(struct device *dev, struct device_attribute *attr, char *buf) show_chgmode(struct device *dev, struct device_attribute *attr, char *buf)
{ {
...@@ -248,26 +268,14 @@ pcf50633_mbc_irq_handler(int irq, void *data) ...@@ -248,26 +268,14 @@ pcf50633_mbc_irq_handler(int irq, void *data)
mbc->usb_online = 1; mbc->usb_online = 1;
} else if (irq == PCF50633_IRQ_USBREM) { } else if (irq == PCF50633_IRQ_USBREM) {
mbc->usb_online = 0; mbc->usb_online = 0;
mbc->usb_active = 0;
pcf50633_mbc_usb_curlim_set(mbc->pcf, 0); pcf50633_mbc_usb_curlim_set(mbc->pcf, 0);
} }
/* Adapter */ /* Adapter */
if (irq == PCF50633_IRQ_ADPINS) { if (irq == PCF50633_IRQ_ADPINS)
mbc->adapter_online = 1; mbc->adapter_online = 1;
mbc->adapter_active = 1; else if (irq == PCF50633_IRQ_ADPREM)
} else if (irq == PCF50633_IRQ_ADPREM) {
mbc->adapter_online = 0; mbc->adapter_online = 0;
mbc->adapter_active = 0;
}
if (irq == PCF50633_IRQ_BATFULL) {
mbc->usb_active = 0;
mbc->adapter_active = 0;
} else if (irq == PCF50633_IRQ_USBLIMON)
mbc->usb_active = 0;
else if (irq == PCF50633_IRQ_USBLIMOFF)
mbc->usb_active = 1;
power_supply_changed(&mbc->ac); power_supply_changed(&mbc->ac);
power_supply_changed(&mbc->usb); power_supply_changed(&mbc->usb);
......
...@@ -128,6 +128,7 @@ enum pcf50633_reg_mbcs3 { ...@@ -128,6 +128,7 @@ enum pcf50633_reg_mbcs3 {
int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma); int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma);
int pcf50633_mbc_get_status(struct pcf50633 *); int pcf50633_mbc_get_status(struct pcf50633 *);
int pcf50633_mbc_get_usb_online_status(struct pcf50633 *);
#endif #endif
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment