From ae28b16fc630cc8219676f1bfb9cee41f0b36a79 Mon Sep 17 00:00:00 2001
From: tmk <nobody@nowhere>
Date: Mon, 28 Jul 2014 11:56:02 +0900
Subject: [PATCH] Add battery monitor and LED control
---
keyboard/hhkb_rn42/rn42/rn42_task.c | 46 ++++++++++++++++++++++++++++-
1 file changed, 45 insertions(+), 1 deletion(-)
diff --git a/keyboard/hhkb_rn42/rn42/rn42_task.c b/keyboard/hhkb_rn42/rn42/rn42_task.c
index 437dd46f4..fd5a814b2 100644
--- a/keyboard/hhkb_rn42/rn42/rn42_task.c
+++ b/keyboard/hhkb_rn42/rn42/rn42_task.c
@@ -13,6 +13,17 @@
static bool config_mode = false;
static bool force_usb = false;
+static void status_led(bool on)
+{
+ if (on) {
+ DDRE |= (1<<6);
+ PORTE &= ~(1<<6);
+ } else {
+ DDRE |= (1<<6);
+ PORTE |= (1<<6);
+ }
+}
+
static void battery_adc_init(void)
{
ADMUX = (1<<REFS1) | (1<<REFS0); // Ref:2.56V band-gap, Input:ADC0(PF0)
@@ -43,10 +54,35 @@ static uint16_t battery_adc(void)
return bat;
}
+static void battery_led(bool on)
+{
+ if (on) {
+ DDRF |= (1<<5);
+ PORTF &= ~(1<<5);
+ } else {
+ DDRF &= ~(1<<5);
+ PORTF |= (1<<5);
+ }
+}
+
+static bool battery_charging(void)
+{
+ // MCP73831:STAT
+ // Hi-Z: Shutdown/No Battery
+ // Low: Charging
+ // Hi: Charged
+ DDRF &= ~(1<<5);
+ PORTF |= (1<<5);
+ return PINF&(1<<5) ? false : true;
+}
void rn42_task_init(void)
{
battery_adc_init();
+
+ // battery charging(input with pull-up)
+ DDRF &= ~(1<<5);
+ PORTF |= (1<<5);
}
void rn42_task(void)
@@ -108,6 +144,8 @@ void rn42_task(void)
******************************************************************************/
bool command_extra(uint8_t code)
{
+ uint32_t t;
+ uint16_t b;
static host_driver_t *prev_driver = &rn42_driver;
switch (code) {
case KC_H:
@@ -166,10 +204,16 @@ bool command_extra(uint8_t code)
xprintf("rn42_rts(): %X\n", rn42_rts());
xprintf("config_mode: %X\n", config_mode);
xprintf("VBUS: %X\n", USBSTA&(1<<VBUS));
+ xprintf("battery_charging: %X\n", battery_charging());
return true;
case KC_B:
// battery monitor
- xprintf("BAT: %04X(%08lX)\n", battery_adc(), timer_read32());
+ t = timer_read32()/1000;
+ b = battery_adc();
+ xprintf("BAT: %umV(%04X)\t", (b-16)*5, b);
+ xprintf("%02u:", t/3600);
+ xprintf("%02u:", t%3600/60);
+ xprintf("%02u\n", t%60);
return true;
default:
if (config_mode)