Script 15-10-2019
Dependencies: Servoaansturing mbed QEI HIDScope biquadFilter MODSERIAL FastPWM
Diff: main.cpp
- Revision:
- 27:7305319c11e8
- Parent:
- 26:7ae60739b310
--- a/main.cpp Tue Oct 29 12:36:03 2019 +0000 +++ b/main.cpp Tue Oct 29 13:00:10 2019 +0000 @@ -175,12 +175,6 @@ filtered_EMG_biceps_left=bqcbl2.step(filtered_EMG_biceps_left_abs); filtered_EMG_calf=bqck2.step(filtered_EMG_calf_abs); - // De gefilterde EMG-signalen kunnen tevens visueel worden weergegeven in de HIDScope - scope.set(0, filtered_EMG_biceps_right); - scope.set(1, normalized_EMG_biceps_right); - scope.set(2, filtered_EMG_calf); - scope.send(); - // Tijdens de kalibratie moet vervolgens een maximale spierspanning worden bepaald, die // later kan worden gebruikt voor een normalisatie. De spieren worden hiertoe gedurende // 5 seconden maximaal aangespannen. De EMG waarden worden bij elkaar opgeteld, @@ -215,6 +209,12 @@ normalized_EMG_biceps_right=filtered_EMG_biceps_right/mean_EMG_biceps_right; normalized_EMG_biceps_left=filtered_EMG_biceps_left/mean_EMG_biceps_left; normalized_EMG_calf=filtered_EMG_calf/mean_EMG_calf; + + // De gefilterde EMG-signalen kunnen tevens visueel worden weergegeven in de HIDScope + scope.set(0, normalized_EMG_biceps_right); + scope.set(1, normalized_EMG_biceps_left); + scope.set(2, normalized_EMG_calf); + scope.send(); switch (currentState) { @@ -350,6 +350,7 @@ motor2_dir.write(1); motor1.write(0.9); motor1_dir.write(1); + pc.printf("Ik zit in normalized_EMG_biceps_right < 0.3"); if (normalized_EMG_calf >= 0.3) { // motor1_dir = !motor1_dir; @@ -364,6 +365,7 @@ motor2_dir.write(1); motor1.write(0.9); motor1_dir.write(1); + pc.printf("Ik zit in normalized_EMG_biceps_left >= 0.3"); if (normalized_EMG_calf >= 0.3) { // motor1_dir = !motor1_dir;