/* * Interrupt service routine * * Attends to TWL 4030 power module interruptions events, * specifically USB_PRES (USB charger presence) CHG_PRES (AC charger presence) events * */ static irqreturn_t twl4030charger_interrupt(int irq, void *dev_id) { u8 int_src, clear = 0; int ret; /* Reading interruption source*/ ret = twl4030_i2c_read_u8(TWL4030_MODULE_INT, &int_src, REG_PWR_ISR1); if (ret) return IRQ_NONE; /* Addition to enable shared interrupt */ if(!(int_src & (USB_PRES | CHG_PRES))) return IRQ_NONE; /* Cleaning interruption flags */ clear = (int_src & USB_PRES)? (clear | USB_PRES): clear; clear = (int_src & CHG_PRES)? (clear | CHG_PRES): clear; ret = twl4030_i2c_write_u8(TWL4030_MODULE_INT, clear, REG_PWR_ISR1); if (ret) return IRQ_NONE; /* fuction to handle charger presence events */ ret = twl4030charger_presence_evt(); if(ret == -ENXIO) twl4030charger_hw_presence_en(EVT_DISABLE); if(ret) return IRQ_NONE; return IRQ_HANDLED; }
/* * API function * * Registers the event handler structure * * Return 0 on success * <0 on failure */ int twl4030battery_event_register(struct twl4030battery_events events) { twl4030battery_event.battery_level = events.battery_level; twl4030battery_event.battery_presence = events.battery_presence; twl4030battery_event.charger_presence = events.charger_presence; twl4030battery_event.bci_status = events.bci_status; twl4030battery_event.battery_sw_level_event_cfg = ( events.battery_sw_level_event_cfg & (EVT_LVL_4_EN | EVT_LVL_3_EN | EVT_LVL_2_EN | EVT_LVL_1_EN)) ; if(events.battery_level == NULL) { twl4030battery_hw_level_en(EVT_DISABLE); } else { twl4030battery_hw_level_en(EVT_ENABLE); twl4030battery_level_evt(); } if(events.battery_presence == NULL) { twl4030battery_hw_presence_en(EVT_DISABLE); } else { twl4030battery_hw_presence_en(EVT_ENABLE); twl4030battery_presence_evt(); } if(events.charger_presence == NULL) { twl4030charger_hw_presence_en(EVT_DISABLE); } else { twl4030charger_hw_presence_en(EVT_ENABLE); twl4030charger_presence_evt(); } if(events.bci_status == NULL) { twl4030bci_sw_status_en(EVT_DISABLE); flush_scheduled_work(); } else { twl4030bci_status_tmr.expires = jiffies + CHG_STS_DLY; add_timer(&twl4030bci_status_tmr); twl4030battery_event.temp_std = -1; twl4030bci_status_evt(); } return 0; }
/* * Interrupt service routine * * Attends to TWL 4030 power module interruptions events, specifically * USB_PRES (USB charger presence) CHG_PRES (AC charger presence) events * */ static irqreturn_t twl4030charger_interrupt(int irq, void *_di) { #ifdef CONFIG_LOCKDEP /* WORKAROUND for lockdep forcing IRQF_DISABLED on us, which * we don't want and can't tolerate. Although it might be * friendlier not to borrow this thread context... */ local_irq_enable(); #endif twl4030charger_presence_evt(); return IRQ_HANDLED; }