/* Reset the battery filter to a new voltage */
static void battery_voltage_sync(void)
{
int i;
unsigned int mv;
for (i = 0, mv = 0; i < 5; i++)
mv += battery_adc_voltage();
reset_battery_filter(mv / 5);
}
static void power_thread(void)
{
long next_power_hist;
/* Delay reading the first battery level */
#ifdef MROBE_100
while (battery_adc_voltage() > 4200) /* gives false readings initially */
#endif
{
sleep(HZ/100);
}
#if CONFIG_CHARGING
/* Initialize power input status before calling other routines. */
power_thread_inputs = power_input_status();
#endif
/* initialize the voltages for the exponential filter */
avgbat = battery_adc_voltage() + 15;
#ifdef HAVE_DISK_STORAGE /* this adjustment is only needed for HD based */
/* The battery voltage is usually a little lower directly after
turning on, because the disk was used heavily. Raise it by 5% */
#if CONFIG_CHARGING
if (!charger_inserted()) /* only if charger not connected */
#endif
{
avgbat += (percent_to_volt_discharge[battery_type][6] -
percent_to_volt_discharge[battery_type][5]) / 2;
}
#endif /* HAVE_DISK_STORAGE */
avgbat = avgbat * BATT_AVE_SAMPLES;
battery_millivolts = avgbat / BATT_AVE_SAMPLES;
power_history[0] = battery_millivolts;
#if CONFIG_CHARGING
if (charger_inserted()) {
battery_percent = voltage_to_percent(battery_millivolts,
percent_to_volt_charge);
}
else
#endif
{
battery_percent = voltage_to_percent(battery_millivolts,
percent_to_volt_discharge[battery_type]);
battery_percent += battery_percent < 100;
}
powermgmt_init_target();
next_power_hist = current_tick + HZ*60;
while (1)
{
#if CONFIG_CHARGING
unsigned int pwr = power_input_status();
#ifdef HAVE_BATTERY_SWITCH
if ((pwr ^ power_thread_inputs) & POWER_INPUT_BATTERY) {
sleep(HZ/10);
reset_battery_filter(battery_adc_voltage());
}
#endif
power_thread_inputs = pwr;
if (!detect_charger(pwr))
#endif /* CONFIG_CHARGING */
{
/* Steady state */
sleep(POWER_THREAD_STEP_TICKS);
/* Do common power tasks */
power_thread_step();
}
/* Perform target tasks */
charging_algorithm_step();
if (TIME_BEFORE(current_tick, next_power_hist))
continue;
/* increment to ensure there is a record for every minute
* rather than go forward from the current tick */
next_power_hist += HZ*60;
/* rotate the power history */
memmove(&power_history[1], &power_history[0],
sizeof(power_history) - sizeof(power_history[0]));
/* insert new value at the start, in millivolts 8-) */
power_history[0] = battery_millivolts;
handle_auto_poweroff();
}
} /* power_thread */
static void power_thread(void)
{
long next_power_hist;
/* Delay reading the first battery level */
#ifdef MROBE_100
while (_battery_voltage() > 4200) /* gives false readings initially */
#elif defined(DX50) || defined(DX90)
while (_battery_voltage() < 1) /* can give false readings initially */
#endif
{
sleep(HZ/100);
}
#if CONFIG_CHARGING
/* Initialize power input status before calling other routines. */
power_thread_inputs = power_input_status();
#endif
/* initialize voltage averaging (if available) */
average_init();
/* get initial battery level value (in %) */
init_battery_percent();
/* get some initial data for the power curve */
collect_power_history();
/* call target specific init now */
powermgmt_init_target();
next_power_hist = current_tick + HZ*60;
while (1)
{
#if CONFIG_CHARGING
unsigned int pwr = power_input_status();
#ifdef HAVE_BATTERY_SWITCH
if ((pwr ^ power_thread_inputs) & POWER_INPUT_BATTERY) {
sleep(HZ/10);
reset_battery_filter(_battery_voltage());
}
#endif
power_thread_inputs = pwr;
if (!detect_charger(pwr))
#endif /* CONFIG_CHARGING */
{
/* Steady state */
sleep(POWER_THREAD_STEP_TICKS);
/* Do common power tasks */
power_thread_step();
}
/* Perform target tasks */
charging_algorithm_step();
/* check if some idle or sleep timer wears off */
handle_auto_poweroff();
if (TIME_AFTER(current_tick, next_power_hist)) {
/* increment to ensure there is a record for every minute
* rather than go forward from the current tick */
next_power_hist += HZ*60;
collect_power_history();
}
}
} /* power_thread */
