151 lines
3.7 KiB
C
151 lines
3.7 KiB
C
#include <board/gpio.h>
|
|
#include <board/smbus.h>
|
|
#include <common/debug.h>
|
|
|
|
|
|
// ChargeOption0 flags
|
|
// Low Power Mode Enable
|
|
#define SBC_EN_LWPWR ((uint16_t)(1 << 15))
|
|
// Watchdog Timer Adjust
|
|
#define SBC_WDTMR_ADJ_175S ((uint16_t)(0b11 << 13))
|
|
// Switching Frequency
|
|
#define SBC_PWM_FREQ_800KHZ ((uint16_t)(0b01 << 8))
|
|
// IDCHG Amplifier Gain
|
|
#define SBC_IDCHC_GAIN ((uint16_t)(1 << 3))
|
|
|
|
int battery_charger_disable(void) {
|
|
int res = 0;
|
|
|
|
// Set charge option 0 with 175s watchdog
|
|
res = smbus_write(
|
|
0x09,
|
|
0x12,
|
|
SBC_EN_LWPWR |
|
|
SBC_WDTMR_ADJ_175S |
|
|
SBC_PWM_FREQ_800KHZ |
|
|
SBC_IDCHC_GAIN
|
|
);
|
|
|
|
// Disable charge current
|
|
res = smbus_write(0x09, 0x14, 0);
|
|
if (res < 0) return res;
|
|
|
|
// Disable charge voltage
|
|
res = smbus_write(0x09, 0x15, 0);
|
|
if (res < 0) return res;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int battery_charger_enable(void) {
|
|
int res = 0;
|
|
|
|
res = battery_charger_disable();
|
|
if (res < 0) return res;
|
|
|
|
// Set charge current to ~1.5 A
|
|
res = smbus_write(0x09, 0x14, 0x0600);
|
|
if (res < 0) return res;
|
|
|
|
// Set charge voltage to ~13 V
|
|
res = smbus_write(0x09, 0x15, 0x3300);
|
|
if (res < 0) return res;
|
|
|
|
// Set charge option 0 with watchdog disabled
|
|
res = smbus_write(
|
|
0x09,
|
|
0x12,
|
|
SBC_EN_LWPWR |
|
|
SBC_PWM_FREQ_800KHZ |
|
|
SBC_IDCHC_GAIN
|
|
);
|
|
|
|
return 0;
|
|
}
|
|
|
|
uint16_t battery_temp = 0;
|
|
uint16_t battery_voltage = 0;
|
|
uint16_t battery_current = 0;
|
|
uint16_t battery_charge = 0;
|
|
uint16_t battery_remaining_capacity = 0;
|
|
uint16_t battery_full_capacity = 0;
|
|
uint16_t battery_status = 0;
|
|
uint16_t battery_design_capacity = 0;
|
|
uint16_t battery_design_voltage = 0;
|
|
|
|
void battery_event(void) {
|
|
int res = 0;
|
|
|
|
#define command(N, V) { \
|
|
res = smbus_read(0x0B, V, &N); \
|
|
if (res < 0) { \
|
|
N = 0; \
|
|
} \
|
|
}
|
|
|
|
command(battery_temp, 0x08);
|
|
command(battery_voltage, 0x09);
|
|
command(battery_current, 0x0A);
|
|
command(battery_charge, 0x0D);
|
|
command(battery_remaining_capacity, 0x0F);
|
|
command(battery_full_capacity, 0x10);
|
|
command(battery_status, 0x16);
|
|
command(battery_design_capacity, 0x18);
|
|
command(battery_design_voltage, 0x19);
|
|
|
|
#undef command
|
|
|
|
if (gpio_get(&ACIN_N)) {
|
|
// Discharging (no AC adapter)
|
|
gpio_set(&LED_BAT_CHG, false);
|
|
gpio_set(&LED_BAT_FULL, false);
|
|
} else if (battery_status & 0x0020) {
|
|
// Fully charged
|
|
// TODO: turn off charger
|
|
gpio_set(&LED_BAT_CHG, false);
|
|
gpio_set(&LED_BAT_FULL, true);
|
|
} else {
|
|
// Charging
|
|
// TODO: detect no battery connected
|
|
gpio_set(&LED_BAT_CHG, true);
|
|
gpio_set(&LED_BAT_FULL, false);
|
|
}
|
|
}
|
|
|
|
void battery_debug(void) {
|
|
uint16_t data = 0;
|
|
int res = 0;
|
|
|
|
#define command(N, A, V) { \
|
|
DEBUG(#N ": "); \
|
|
res = smbus_read(A, V, &data); \
|
|
if (res < 0) { \
|
|
DEBUG("ERROR %04X\n", -res); \
|
|
} else { \
|
|
DEBUG("%04X\n", data); \
|
|
} \
|
|
}
|
|
|
|
DEBUG("Battery:\n");
|
|
command(Temperature, 0x0B, 0x08);
|
|
command(Voltage, 0x0B, 0x09);
|
|
command(Current, 0x0B, 0x0A);
|
|
command(Charge, 0x0B, 0x0D);
|
|
command(Status, 0x0B, 0x16);
|
|
|
|
DEBUG("Charger:\n");
|
|
command(ChargeOption0, 0x09, 0x12);
|
|
command(ChargeOption1, 0x09, 0x3B);
|
|
command(ChargeOption2, 0x09, 0x38);
|
|
command(ChargeOption3, 0x09, 0x37);
|
|
command(ChargeCurrent, 0x09, 0x14);
|
|
command(ChargeVoltage, 0x09, 0x15);
|
|
command(DishargeCurrent, 0x09, 0x39);
|
|
command(InputCurrent, 0x09, 0x3F);
|
|
command(ProchotOption0, 0x09, 0x3C);
|
|
command(ProchotOption1, 0x09, 0x3D);
|
|
command(ProchotStatus, 0x09, 0x3A);
|
|
|
|
#undef command
|
|
}
|