Diff: main.cpp

Revision:

4:75a2c3550bdc

Parent:

3:c1f60bb03ac4

Child:

5:78bfbf11bb2f

--- a/main.cpp	Wed Jul 16 10:19:35 2014 +0000
+++ b/main.cpp	Thu Jul 17 01:43:50 2014 +0000
@@ -2,6 +2,7 @@
 #include    "PCA9955A.h"
 
 BusOut      leds( LED4, LED3, LED2, LED1 );
+DigitalOut  pin( p21 );
 AnalogIn    ain( p20 );
 //AnalogIn    ain( dp4 );
 
@@ -26,7 +27,7 @@
     int     shift;
 
     led_driver.set_all_intensity( 0xFF );
-    led_driver.set_all_intensity( 0x40, true );
+    led_driver.set_all_intensity( 0x20, true );
 
     set_color( 1 );
 
@@ -49,12 +50,11 @@
 
 void    led_cntl()
 {
-    static int      count       = 1;
+    static int      count       = 0;
     static float    intensity   = 1.0;
 
     if ( led_change ) {
-        count   = (count & 0x10) ? 0x1 : count << 1;
-        set_color( count );
+        set_color( count++ & 0x3 );
         led_change  = 0;
         intensity   = 1.0;
     }
@@ -66,6 +66,7 @@
 
 void set_color( int v )
 {
+    v   = 0x1 << v;
     led_driver  = (v << 12) | (v << 8) | (v << 4) | v;
 }