led lib now supports 2 leds

git-svn-id: https://svn.spreadspace.org/avr/trunk@57 aa12f405-d877-488e-9caf-2d797e2a1cc7

2 files changed, 52 insertions, 7 deletions

diff --git a/lib/led.c b/lib/led.c
index 8f8f12c..d567cef 100644
--- a/lib/led.c
+++ b/lib/led.c
@@ -24,10 +24,14 @@
 
 #include "led.h"
 
-#if defined(__BOARD_arduinoUno__) || defined(__BOARD_AvrNetIo__)
-#define HAS_LED 0
+#if defined(__BOARD_minimus__) || defined(__BOARD_minimus32__)
+#define NUM_LEDS 2
+#elif defined(__BOARD_teensy1__) || defined(__BOARD_teensy1pp__) || defined(__BOARD_teensy2__) || defined(__BOARD_teensy2pp__) \
+  || defined(__BOARD_arduinoNG__) ||  defined(__BOARD_arduino2009v2__) || defined(__BOARD_arduino2009__) || defined(__BOARD_arduino10000__) \
+  || defined(__BOARD_hhd70dongle__)
+#define NUM_LEDS 1
 #else
-#define HAS_LED 1
+#define NUM_LEDS 0
 #endif
 
 #if defined(__BOARD_teensy1__) || defined(__BOARD_teensy1pp__) || defined(__BOARD_minimus__) || defined(__BOARD_minimus32__)
@@ -46,6 +50,10 @@
 #define LED_PORT PORTD
 #define LED_DDR DDRD
 #define LED_PINNUM 5
+
+#define LED2_PORT PORTD
+#define LED2_DDR DDRD
+#define LED2_PINNUM 6
 #endif
 
 #if defined(__BOARD_hhd70dongle__)
@@ -62,15 +70,18 @@
 
 void led_init(void)
 {
-#if HAS_LED == 1
+#if NUM_LEDS >= 1
   led_off();
   LED_DDR = 1<<LED_PINNUM;
+#if NUM_LEDS >= 2
+  LED2_DDR |= 1<<LED2_PINNUM;
+#endif
 #endif
 }
 
 void led_on(void)
 {
-#if HAS_LED == 1
+#if NUM_LEDS >= 1
 #if LED_DIR == 1
   LED_PORT |= 1<<LED_PINNUM;
 #else
@@ -81,7 +92,7 @@ void led_on(void)
 
 void led_off(void)
 {
-#if HAS_LED == 1
+#if NUM_LEDS >= 1
 #if LED_DIR == 1
   LED_PORT &= ~(1<<LED_PINNUM);
 #else
@@ -92,7 +103,37 @@ void led_off(void)
 
 void led_toggle(void)
 {
-#if HAS_LED == 1
+#if NUM_LEDS >= 1
   LED_PORT ^= 1<<LED_PINNUM;
 #endif
 }
+
+
+void led2_on(void)
+{
+#if NUM_LEDS >= 2
+#if LED_DIR == 1
+  LED2_PORT |= 1<<LED2_PINNUM;
+#else
+  LED2_PORT &= ~(1<<LED2_PINNUM);
+#endif
+#endif
+}
+
+void led2_off(void)
+{
+#if NUM_LEDS >= 2
+#if LED_DIR == 1
+  LED2_PORT &= ~(1<<LED2_PINNUM);
+#else
+  LED2_PORT |= 1<<LED2_PINNUM;
+#endif
+#endif
+}
+
+void led2_toggle(void)
+{
+#if NUM_LEDS >= 2
+  LED2_PORT ^= 1<<LED2_PINNUM;
+#endif
+}
diff --git a/lib/led.h b/lib/led.h
index 12f00a8..d7a8e3b 100644
--- a/lib/led.h
+++ b/lib/led.h
@@ -28,4 +28,8 @@ void led_on(void);
 void led_off(void);
 void led_toggle(void);
 
+void led2_on(void);
+void led2_off(void);
+void led2_toggle(void);
+
 #endif