Diff: main.cpp

Revision:

62:bdcc3328b13e

Parent:

61:6bf3935b9e74

Child:

63:90cc947c3d77

--- a/main.cpp	Mon Nov 03 21:05:53 2014 +0000
+++ b/main.cpp	Tue Nov 04 07:43:10 2014 +0000
@@ -155,7 +155,7 @@
             pc.printf("calibratie tricep aan\n");
             wait(2);
 
-            Calibratie_Triceps();
+            /*Calibratie_Triceps();
             drempelwaardeT=MOVAVG_T-1;
             pc.printf("drempelwaarde triceps is %f\r\n", drempelwaardeT);
 
@@ -171,7 +171,7 @@
             myled2=1;
             myled3=1;
             rood=0;
-            wit=0;
+            wit=0;*/
         }
         if (key==2) {
             //green
@@ -183,7 +183,7 @@
             pc.printf("calibratie bicep snelheid 1 aan\n");
             wait(2);
 
-            Calibratie_Biceps();
+            /*Calibratie_Biceps();
             drempelwaardeB1=MOVAVG_B-1;
             pc.printf("drempelwaarde snelheid 1 is %f\r\n", drempelwaardeB1);
             myled1 = 0;
@@ -232,7 +232,7 @@
             groen=0;
             myled1=1;
             myled2=1;
-            myled3=1;
+            myled3=1;*/
         }
         if (key==3) {
             //blue
@@ -277,7 +277,7 @@
                 pc.printf("eerst positie dan snelheid aangeven /n");
 
                 //bepaling van positie met triceps 1
-                Ticker log_timerT1;
+                /*Ticker log_timerT1;
 
                 arm_biquad_cascade_df1_init_f32(&notchT,1,notch_const,notch_states);
                 arm_biquad_cascade_df1_init_f32(&lowpassT,1,lowpass_const,lowpass_states);
@@ -337,7 +337,7 @@
                 rood=0;
 
                 // *** INPUT MOTOR 2 ***
-                positie=yT1+yT2;
+                positie=yT1+yT2; */
 
                 //controle positie op scherm
                 if (positie==0) {
@@ -361,7 +361,7 @@
                 //   eind aansturing motor 2
 
                 wait(2);
-                Ticker log_timerB;
+                /*Ticker log_timerB;
 
                 arm_biquad_cascade_df1_init_f32(&notchB,1,notch_const,notch_states);
                 arm_biquad_cascade_df1_init_f32(&lowpassB,1,lowpass_const,lowpass_states);
@@ -401,7 +401,7 @@
                 groen=0;
 
                 // *** INPUT MOTOR 1 ***
-                snelheidsstand=yB1+yB2+yB3;
+                snelheidsstand=yB1+yB2+yB3; */
 
                 //controle snelheidsstand op scherm
                 if (snelheidsstand==0) {
@@ -697,7 +697,7 @@
         case SLAAN:
             pc.printf("SLAAN\n");
             new_pwm = pid(setspeed, omega);
-            pwm_motor1.write(new_pwm);
+            pwm_motor1.write(1);
             motordir1 = 1;
             if (motor1.getPosition() <= ANGLEMAX) {
                 toestand = TERUGKEREN;