Diff: main.cpp

Revision:

5:6caecff3094d

Parent:

4:a6130c61c228

Child:

6:17a42dc976bb

--- a/main.cpp	Wed Nov 26 22:51:15 2014 +0000
+++ b/main.cpp	Mon Dec 01 06:45:49 2014 +0000
@@ -6,9 +6,23 @@
 #include "hsi2rgbw_pwm.h"
 #include "FastAnalogIn.h"
 
+DigitalOut led1(PTC7);
+DigitalOut led2(PTC0);
+DigitalOut led3(PTC3);
+DigitalOut led4(PTC4);
+DigitalOut led5(PTC5);
+DigitalOut led6(PTC6);
+DigitalOut led7(PTC10);
+DigitalOut led8(PTC11);
+
+float pulso=100;
+
+int fmin=40;
+int fmax=120;
+float sum=(fmax-fmin)/8;
+
 Serial pc(USBTX, USBRX);
 
-float pulso=83;
 float pulsocalculado=0;
 
 float qrs2[512]= {0};
@@ -390,6 +404,97 @@
             pulsocalculado=fs/(FFT_SIZE-1)*inmax*60;
             pc.printf("%f\n",pulsocalculado);
             
+            if (pulsocalculado<fmin){
+            led1=0;
+            led2=0;
+            led3=0;
+            led4=0;
+            led5=0;
+            led6=0;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=fmin&&pulsocalculado<(fmin+sum)){
+            led1=1;
+            led2=0;
+            led3=0;
+            led4=0;
+            led5=0;
+            led6=0;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+sum)&&pulsocalculado<(fmin+2*sum)){
+            led1=1;
+            led2=1;
+            led3=0;
+            led4=0;
+            led5=0;
+            led6=0;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+2*sum)&&pulsocalculado<(fmin+3*sum)){
+            led1=1;
+            led2=1;
+            led3=1;
+            led4=0;
+            led5=0;
+            led6=0;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+3*sum)&&pulsocalculado<(fmin+4*sum)){
+            led1=1;
+            led2=1;
+            led3=1;
+            led4=1;
+            led5=0;
+            led6=0;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+4*sum)&&pulsocalculado<(fmin+5*sum)){
+            led1=1;
+            led2=1;
+            led3=1;
+            led4=1;
+            led5=1;
+            led6=0;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+5*sum)&&pulsocalculado<(fmin+6*sum)){
+            led1=1;
+            led2=1;
+            led3=1;
+            led4=1;
+            led5=1;
+            led6=1;
+            led7=0;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+6*sum)&&pulsocalculado<(fmin+7*sum)){
+            led1=1;
+            led2=1;
+            led3=1;
+            led4=1;
+            led5=1;
+            led6=1;
+            led7=1;
+            led8=0;        
+        }
+        if (pulsocalculado>=(fmin+8*sum)){
+            led1=1;
+            led2=1;
+            led3=1;
+            led4=1;
+            led5=1;
+            led6=1;
+            led7=1;
+            led8=1;        
+        }
+            
             inmax=0;
 
             if (LEDS_ENABLED == 1) {