Added status LED support

diff --git a/led.c b/led.c
new file mode 100644 (file)
index 0000000..70a5180
--- /dev/null
+++ b/led.c
@@ -0,0 +1,45 @@
+/*
+ * util.c
+ *
+ *  Created on: Aug 4, 2010
+ *      Author: volpol
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include "log.h"
+
+#include "led.h"
+#include "c_gpio.h"
+
+
+int led_init(void){
+       setup_gpio(LED_R, OUTPUT, PUD_OFF);
+       setup_gpio(LED_Y, OUTPUT, PUD_OFF);
+       setup_gpio(LED_B, OUTPUT, PUD_OFF);
+}
+
+int led_deinit(void){
+       setup_gpio(LED_R, INPUT, PUD_OFF);
+       setup_gpio(LED_Y, INPUT, PUD_OFF);
+       setup_gpio(LED_B, INPUT, PUD_OFF);
+}
+
+void status_ready(void){
+       output_gpio(LED_R, LOW);
+       output_gpio(LED_Y, LOW);
+       output_gpio(LED_B, HIGH);
+}
+
+void status_busy(void){
+       output_gpio(LED_R, LOW);
+       output_gpio(LED_Y, HIGH);
+       output_gpio(LED_B, LOW);
+}
+void status_error(void){
+       output_gpio(LED_R, HIGH);
+       output_gpio(LED_Y, LOW);
+       output_gpio(LED_B, LOW);
+}

diff --git a/led.h b/led.h
new file mode 100644 (file)
index 0000000..60a9a71
--- /dev/null
+++ b/led.h
@@ -0,0 +1,14 @@
+#ifndef LED_H
+#define LED_H 1
+
+#define LED_R 22
+#define LED_Y 23
+#define LED_B 24
+
+int led_init(void);
+int led_deinit(void);
+void status_ready(void);
+void status_busy(void);
+void status_error(void);
+
+#endif /* LED_H */