Diff: app_board_io.cpp

Revision:

15:7443df31ff5b

Parent:

11:bdf601a405fc

Child:

19:ca595d80895b

--- a/app_board_io.cpp	Sat Nov 09 10:15:50 2013 +0000
+++ b/app_board_io.cpp	Mon Nov 11 17:33:56 2013 +0000
@@ -1,4 +1,6 @@
+#include "mbed.h"
 #include "app_board_io.h"
+
 #include "C12832_lcd.h"
 
 extern C12832_LCD lcd;
@@ -16,4 +18,102 @@
     lcd.locate( 0, 3 );
     lcd.printf( buffer );
     //wait( 1.0 );
+}
+
+/**
+  * Demo for the RGB Led on the mbed Lab Board
+  * Pot 2 changes the color 
+  * Pot 1 changes the value
+  * the saturation is set to maximum
+  * 
+  * Based on:
+  * https://mbed.org/users/dreschpe/code/app-board-RGB2/
+  *
+  * Copyright (c) 2012 Peter Drescher - DC2PD
+  */
+
+/* the led's are connected to vcc, so a PwmOut of 100% will shut off the led and 0% will let it shine ! */
+PwmOut r (p23);
+PwmOut g (p24);
+PwmOut b (p25);
+
+AnalogIn pot1(p19);
+AnalogIn pot2(p20);
+
+// function to convert hue , saturation and  value to RGB
+// see http://en.wikipedia.org/wiki/HSL_and_HSV
+void hsv2rgb(float H,float S, float V)
+{
+    float f,h,p,q,t;
+    int i;
+    if( S == 0.0) {
+        r = 1.0 - V;  // invert pwm !
+        g = 1.0 - V;
+        b = 1.0 - V;
+        return;
+    }
+    if(H > 360.0) H = 0.0;   // check values
+    if(S > 1.0) S = 1.0; 
+    if(S < 0.0) S = 0.0;
+    if(V > 1.0) V = 1.0;
+    if(V < 0.0) V = 0.0;
+    h = H / 60.0;
+    i = (int) h;
+    f = h - i;
+    p = V * (1.0 - S);
+    q = V * (1.0 - (S * f));
+    t = V * (1.0 - (S * (1.0 - f)));
+
+    switch(i) {
+        case 0:
+            r = 1.0 - V;  // invert pwm !
+            g = 1.0 - t;
+            b = 1.0 - p;
+            break;
+        case 1:
+            r = 1.0 - q;
+            g = 1.0 - V;
+            b = 1.0 - p;
+            break;
+        case 2:
+            r = 1.0 - p;
+            g = 1.0 - V;
+            b = 1.0 - t;
+            break;
+        case 3:
+            r = 1.0 - p;
+            g = 1.0 - q;
+            b = 1.0 - V;
+            break;
+        case 4:
+            r = 1.0 - t;
+            g = 1.0 - p;
+            b = 1.0 - V;
+            break;
+        case 5:
+        default:
+            r = 1.0 - V;
+            g = 1.0 - p;
+            b = 1.0 - q;
+            break;
+    }
+}
+
+void rgbpwm_thread(void const *args)
+{
+    float h, s, v;
+    
+    r.period(0.001);  // set pwm period
+    s = 1.0;
+    while(true){
+
+        h = (pot1.read_u16() >> 6) * 0.3515625;  // truncate to 10 bits and scale to 0 - 360;
+
+
+        v = (pot2.read_u16() >> 6) * 0.0009765624; // truncate and scale to 0 - 1;
+
+        hsv2rgb(h,s,v);
+        
+        wait_ms(500);
+    }
 }
\ No newline at end of file