Revision 23:1c51af8386c9, committed 2014-10-10

Comitter:

s1340735

Date:

Fri Oct 10 12:47:45 2014 +0000

Parent:

22:dc630dbb1dcd

Child:

24:553707c8ebf8

Commit message:

void antwoord() en drempelwaarde if toegevoegd;

Changed in this revision

--- a/EMGfilter.cpp	Fri Oct 10 09:54:49 2014 +0000
+++ b/EMGfilter.cpp	Fri Oct 10 12:47:45 2014 +0000
@@ -1,12 +1,16 @@
 #include "mbed.h"
 #include "HIDScope.h"
-
+#include "MODSERIAL.h"
 #include "arm_math.h"
 
 //Define objects
 AnalogIn    emgB(PTB0); //Analog input bicep
 AnalogIn    emgT(PTB1); //Analog input tricep
 
+float filtered_emgB;
+
+MODSERIAL pc(USBTX,USBRX);
+
 HIDScope scope(2);//WHAT IS THIS
 
 arm_biquad_casd_df1_inst_f32 lowpass;
@@ -39,9 +43,9 @@
 //BICEP EMG LEZEN
 void looperB()
 {
-    /*variable to store value in*/    
+    /*variable to store value in*/
     uint16_t emg_valueB;
-    float filtered_emgB;
+    
     float emg_value_f32B;
     /*put raw emg value both in red and in emg_value*/
     emg_valueB = emgB.read_u16(); // read direct ADC result, converted to 16 bit integer (0..2^16 = 0..65536 = 0..3.3V)
@@ -51,7 +55,7 @@
     arm_biquad_cascade_df1_f32(&highpass, &emg_value_f32B, &filtered_emgB, 1 );
     filtered_emgB = fabs(filtered_emgB);
     arm_biquad_cascade_df1_f32(&lowpass, &filtered_emgB, &filtered_emgB, 1 );
-    
+
     /*send value to PC. */
     scope.set(0,emg_valueB);     //uint value
     scope.set(1,filtered_emgB);  //processed float
@@ -61,7 +65,7 @@
 
 void looperT()
 {
-    /*variable to store value in*/    
+    /*variable to store value in*/
     uint16_t emg_valueT;
     float filtered_emgT;
     float emg_value_f32T;
@@ -73,7 +77,7 @@
     arm_biquad_cascade_df1_f32(&highpass, &emg_value_f32T, &filtered_emgT, 1 );
     filtered_emgT = fabs(filtered_emgT);
     arm_biquad_cascade_df1_f32(&lowpass, &filtered_emgT, &filtered_emgT, 1 );
-    
+
     /*send value to PC. */
     scope.set(0,emg_valueT);     //uint value
     scope.set(1,filtered_emgT);  //processed float
@@ -84,7 +88,7 @@
 int main()
 {
     Ticker log_timer;
-   //set up filters. Use external array for constants
+    //set up filters. Use external array for constants
     arm_biquad_cascade_df1_init_f32(&lowpass,1 , lowpass_const, lowpass_states);
     arm_biquad_cascade_df1_init_f32(&highpass,1 ,highpass_const, highpass_states);
 
@@ -94,14 +98,28 @@
     */
     log_timer.attach(looperB, 0.005);//??
     log_timer.attach(looperT, 0.005);//??
-    while(1) //Loop
-    {
-      /*Empty!*/
-      
-      
+    while(1) { //Loop
+        /*Empty!*/
+        /*Everything is handled by the interrupt routine now!*/
+    }
+}
+
 //filtered_emgB
 //filtered_emgT
 
-      /*Everything is handled by the interrupt routine now!*/
+void Antwoord()
+{
+    float drempelwaarde=4.99;
+
+    if (filtered_emgB > drempelwaarde) {
+        int y=1;
+    } else {
+        int y=0;
+    }
+
+    if (int y=1) {
+        pc.printf("Motor 1 beweegt");
+    } else {
+        pc.printf("Motor 1 beweegt niet");
     }
 }
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MODSERIAL.lib	Fri Oct 10 12:47:45 2014 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/Sissors/code/MODSERIAL/#180e968a751e