| /*************************************************************************** |
| * __________ __ ___. |
| * Open \______ \ ____ ____ | | _\_ |__ _______ ___ |
| * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / |
| * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < |
| * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ |
| * \/ \/ \/ \/ \/ |
| * $Id$ |
| * |
| * Copyright (C) 2002 by Heikki Hannikainen |
| * |
| * All files in this archive are subject to the GNU General Public License. |
| * See the file COPYING in the source tree root for full license agreement. |
| * |
| * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY |
| * KIND, either express or implied. |
| * |
| ****************************************************************************/ |
| #include "config.h" |
| #include "sh7034.h" |
| #include "kernel.h" |
| #include "thread.h" |
| #include "system.h" |
| #include "debug.h" |
| #include "panic.h" |
| #include "adc.h" |
| #include "string.h" |
| #include "sprintf.h" |
| #include "ata.h" |
| #include "power.h" |
| #include "powermgmt.h" |
| |
| #ifdef SIMULATOR |
| |
| int battery_level(void) |
| { |
| return 100; |
| } |
| |
| bool battery_level_safe(void) |
| { |
| return true; |
| } |
| |
| #else /* not SIMULATOR */ |
| |
| static char power_stack[DEFAULT_STACK_SIZE]; |
| static char power_thread_name[] = "power"; |
| |
| unsigned short power_history[POWER_HISTORY_LEN]; |
| #ifdef HAVE_CHARGE_CTRL |
| char power_message[POWER_MESSAGE_LEN] = ""; |
| char charge_restart_level = CHARGE_RESTART_HI; |
| #endif |
| |
| /* Returns battery level in percent */ |
| int battery_level(void) |
| { |
| int level = 0; |
| int c = 0; |
| int i; |
| |
| /* calculate average over last 3 minutes (skip empty samples) */ |
| for (i = 0; i < 3; i++) |
| if (power_history[POWER_HISTORY_LEN-1-i]) { |
| level += power_history[POWER_HISTORY_LEN-1-i]; |
| c++; |
| } |
| |
| if (c) |
| level = level / c; /* avg */ |
| else /* history was empty, get a fresh sample */ |
| level = (adc_read(ADC_UNREG_POWER) * BATTERY_SCALE_FACTOR) / 10000; |
| |
| if(level > BATTERY_LEVEL_FULL) |
| level = BATTERY_LEVEL_FULL; |
| |
| if(level < BATTERY_LEVEL_EMPTY) |
| level = BATTERY_LEVEL_EMPTY; |
| |
| return ((level-BATTERY_LEVEL_EMPTY) * 100) / BATTERY_RANGE; |
| } |
| |
| /* Tells if the battery level is safe for disk writes */ |
| bool battery_level_safe(void) |
| { |
| /* I'm pretty sure we don't want an average over a long time here */ |
| if (power_history[POWER_HISTORY_LEN-1]) |
| return power_history[POWER_HISTORY_LEN-1] > BATTERY_LEVEL_DANGEROUS; |
| else |
| return adc_read(ADC_UNREG_POWER) > (BATTERY_LEVEL_DANGEROUS * 10000) / BATTERY_SCALE_FACTOR; |
| } |
| |
| /* |
| * This power thread maintains a history of battery voltage |
| * and implements a charging algorithm. |
| * Battery 'fullness' can be determined by the voltage drop, see: |
| * |
| * http://www.nimhbattery.com/nimhbattery-faq.htm questions 3 & 4 |
| * http://www.powerpacks-uk.com/Charging%20NiMh%20Batteries.htm |
| * http://www.angelfire.com/electronic/hayles/charge1.html (soft start idea) |
| * http://www.powerstream.com/NiMH.htm (discouraging) |
| * http://www.panasonic.com/industrial/battery/oem/images/pdf/nimhchar.pdf |
| * http://www.duracell.com/oem/Pdf/others/nimh_5.pdf (discharging) |
| * http://www.duracell.com/oem/Pdf/others/nimh_6.pdf (charging) |
| * |
| * Charging logic which we're starting with (by Linus, Hes, Bagder): |
| * |
| * 1) max 16 hrs charge time (just in negative delta detection fails) |
| * 2) Stop at negative delta of 5 mins |
| * 3) Stop at 15 mins of zero-delta or below |
| * 4) minimum of 15 mins charge time before 2) is applied |
| * 5) after end of charging, wait for charge go down 80% |
| * before charging again if in 'no-use overnight charging mode' |
| * and down to 10% if in 'fixed-location mains-powered usage mode' |
| */ |
| |
| static void power_thread(void) |
| { |
| int i; |
| int avg, ok_samples, spin_samples; |
| #ifdef HAVE_CHARGE_CTRL |
| int delta; |
| int charged_time = 0; |
| #endif |
| |
| while (1) |
| { |
| /* Make POWER_AVG measurements and calculate an average of that to |
| * reduce the effect of backlights/disk spinning/other variation. |
| */ |
| ok_samples = spin_samples = avg = 0; |
| for (i = 0; i < POWER_AVG_N; i++) { |
| if (ata_disk_is_active()) { |
| if (!ok_samples) { |
| /* if we don't have any good non-disk-spinning samples, |
| * we take a sample anyway in case the disk is going |
| * to spin all the time. |
| */ |
| avg += adc_read(ADC_UNREG_POWER); |
| spin_samples++; |
| } |
| } else { |
| if (spin_samples) /* throw away disk-spinning samples */ |
| spin_samples = avg = 0; |
| avg += adc_read(ADC_UNREG_POWER); |
| ok_samples++; |
| } |
| sleep(HZ*POWER_AVG_SLEEP); |
| } |
| avg = avg / ((ok_samples) ? ok_samples : spin_samples); |
| |
| /* rotate the power history */ |
| for (i = 0; i < POWER_HISTORY_LEN-1; i++) |
| power_history[i] = power_history[i+1]; |
| |
| /* insert new value in the end, in centivolts 8-) */ |
| power_history[POWER_HISTORY_LEN-1] = (avg * BATTERY_SCALE_FACTOR) / 10000; |
| |
| #ifdef HAVE_CHARGE_CTRL |
| if (charger_inserted()) { |
| if (charger_enabled) { |
| /* charger inserted and enabled */ |
| charged_time++; |
| if (charged_time > CHARGE_MAX_TIME) { |
| DEBUGF("power: charged_time > CHARGE_MAX_TIME, enough!\n"); |
| /* have charged too long and deltaV detection did not work! */ |
| charger_enable(false); |
| snprintf(power_message, POWER_MESSAGE_LEN, "Chg tmout %d min", CHARGE_MAX_TIME); |
| /* Perhaps we should disable charging for several |
| hours from this point, just to be sure. */ |
| } else { |
| if (charged_time > CHARGE_MIN_TIME) { |
| /* have charged continuously over the minimum charging time, |
| * so we monitor for deltaV going negative. Multiply things |
| * by 100 to get more accuracy without floating point arithmetic. |
| * power_history[] contains centivolts so after multiplying by 100 |
| * the deltas are in tenths of millivolts (delta of 5 is |
| * 0.0005 V). |
| */ |
| delta = ( power_history[POWER_HISTORY_LEN-1] * 100 |
| + power_history[POWER_HISTORY_LEN-2] * 100 |
| - power_history[POWER_HISTORY_LEN-1-CHARGE_END_NEGD+1] * 100 |
| - power_history[POWER_HISTORY_LEN-1-CHARGE_END_NEGD] * 100 ) |
| / CHARGE_END_NEGD / 2; |
| |
| if (delta < -100) { /* delta < -10 mV */ |
| DEBUGF("power: short-term negative delta, enough!\n"); |
| charger_enable(false); |
| snprintf(power_message, POWER_MESSAGE_LEN, "end negd %d %dmin", delta, charged_time); |
| } else { |
| /* if we didn't disable the charger in the previous test, check for low positive delta */ |
| delta = ( power_history[POWER_HISTORY_LEN-1] * 100 |
| + power_history[POWER_HISTORY_LEN-2] * 100 |
| - power_history[POWER_HISTORY_LEN-1-CHARGE_END_ZEROD+1] * 100 |
| - power_history[POWER_HISTORY_LEN-1-CHARGE_END_ZEROD] * 100 ) |
| / CHARGE_END_ZEROD / 2; |
| |
| if (delta < 1) { /* delta < 0.1 mV */ |
| DEBUGF("power: long-term small positive delta, enough!\n"); |
| charger_enable(false); |
| snprintf(power_message, POWER_MESSAGE_LEN, "end lowd %d %dmin", delta, charged_time); |
| } |
| } |
| } |
| } |
| } else { |
| /* charged inserted but not enabled */ |
| /* if battery is not full, enable charging */ |
| if (battery_level() < charge_restart_level) { |
| DEBUGF("power: charger inserted and battery not full, enabling\n"); |
| charger_enable(true); |
| charged_time = 0; |
| /* clear the power history so that we don't use values before |
| * discharge for the long-term delta |
| */ |
| for (i = 0; i < POWER_HISTORY_LEN-1; i++) |
| power_history[i] = power_history[POWER_HISTORY_LEN-1]; |
| snprintf(power_message, POWER_MESSAGE_LEN, "Chg started at %d%%", battery_level()); |
| } |
| } |
| } else { |
| /* charger not inserted */ |
| if (charger_enabled) { |
| /* charger not inserted but was enabled */ |
| DEBUGF("power: charger disconnected, disabling\n"); |
| charger_enable(false); |
| snprintf(power_message, POWER_MESSAGE_LEN, "Charger disc"); |
| } |
| /* charger not inserted and disabled, so we're discharging */ |
| } |
| #endif /* HAVE_CHARGE_CTRL*/ |
| |
| /* sleep for roughly a minute */ |
| sleep(HZ*(60 - POWER_AVG_N * POWER_AVG_SLEEP)); |
| } |
| } |
| |
| void power_init(void) |
| { |
| /* init history to 0 */ |
| memset(power_history, 0x00, sizeof(power_history)); |
| /* initialize the history with a single sample to prevent level |
| flickering during the first minute of execution */ |
| power_history[POWER_HISTORY_LEN-1] = (adc_read(ADC_UNREG_POWER) * BATTERY_SCALE_FACTOR) / 10000; |
| |
| #ifdef HAVE_CHARGE_CTRL |
| snprintf(power_message, POWER_MESSAGE_LEN, "Powermgmt started"); |
| #endif |
| create_thread(power_thread, power_stack, sizeof(power_stack), power_thread_name); |
| } |
| |
| #endif /* SIMULATOR */ |
| |