Merge branch 'master' into dev

* adds battery checker module
This commit is contained in:
Felix Ruess
2012-04-10 18:08:02 +02:00
4 changed files with 132 additions and 0 deletions
+21
View File
@@ -0,0 +1,21 @@
<!DOCTYPE module SYSTEM "module.dtd">
<!--
Battery checker module
@define BAT_CHECKER_DELAY Number of seconds the battery voltage has to be
below LOW_BAT_LEVEL before the warning signal is
activated.
@define BAT_CHECKER_LED The LED to use for the warning signal.
-->
<module name="bat_checker">
<header>
<file name="bat_checker.h"/>
</header>
<init fun="init_bat_checker()"/>
<periodic fun="bat_checker_periodic()" freq="2" autorun="TRUE"/>
<makefile>
<define name="bat_checker_periodic_FREQ" value="2"/>
<file name="bat_checker.c"/>
</makefile>
</module>
+1
View File
@@ -24,6 +24,7 @@
#define LED_3_GPIO_PIN GPIO_Pin_2
#define LED_3_AFIO_REMAP ((void)0)
// GPIO pins
#define LED_4_BANK
#define LED_4_GPIO GPIOC
#define LED_4_GPIO_CLK RCC_APB2Periph_GPIOC
@@ -0,0 +1,79 @@
/*
* $Id$
*
* Copyright (C) 2012 Thomas Kolb
*
* This file is part of paparazzi.
*
* paparazzi is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* paparazzi is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with paparazzi; see the file COPYING. If not, write to
* the Free Software Foundation, 59 Temple Place - Suite 330,
* Boston, MA 02111-1307, USA.
*
*/
#include "bat_checker.h"
#include "generated/airframe.h"
#include "subsystems/electrical.h"
#include "led.h"
#ifndef CRITIC_BAT_LEVEL
#error You must define CRITIC_BAT_LEVEL to use this module!
#endif
#ifndef LOW_BAT_LEVEL
#error You must define LOW_BAT_LEVEL to use this module!
#endif
#ifndef BAT_CHECKER_LED
#error You must define BAT_CHECKER_LED in your airframe file.
#endif
#ifndef BAT_CHECKER_DELAY
#warning BAT_CHECKER_DELAY is undefined. Falling back to 5 seconds.
#define BAT_CHECKER_DELAY 5
#endif
// at this level, the buzzer will be activated periodically
#define WARN_BAT_LEVEL1 (LOW_BAT_LEVEL*10)
// at this level, the buzzer will be activated permanently
#define WARN_BAT_LEVEL2 (CRITIC_BAT_LEVEL*10)
#pragma message "Battery checker included!"
void init_bat_checker(void) {
LED_INIT(BAT_CHECKER_LED);
LED_OFF(BAT_CHECKER_LED);
}
void bat_checker_periodic(void) {
static uint8_t bat_low_counter = 0;
if(electrical.vsupply < WARN_BAT_LEVEL1) {
if(bat_low_counter)
bat_low_counter--;
} else {
bat_low_counter = BAT_CHECKER_DELAY * bat_checker_periodic_FREQ;
}
if(!bat_low_counter) {
if(electrical.vsupply < WARN_BAT_LEVEL2) {
LED_ON(BAT_CHECKER_LED);
} else if(electrical.vsupply < WARN_BAT_LEVEL1) {
LED_TOGGLE(BAT_CHECKER_LED);
}
} else {
LED_OFF(BAT_CHECKER_LED);
}
}
@@ -0,0 +1,31 @@
/*
* $Id$
*
* Copyright (C) 2012 Thomas Kolb
*
* This file is part of paparazzi.
*
* paparazzi is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* paparazzi is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with paparazzi; see the file COPYING. If not, write to
* the Free Software Foundation, 59 Temple Place - Suite 330,
* Boston, MA 02111-1307, USA.
*
*/
#ifndef BAT_CHECKER_H
#define BAT_CHECKER_H
void init_bat_checker(void);
void bat_checker_periodic(void);
#endif // BAT_CHECKER_H