EMG check. met knopjes en toetsenboard emg signalen simuleren om de code te testen. groepje 12
Dependencies: MODSERIAL QEI mbed
Fork of EMG_check by
Diff: main.cpp
- Revision:
- 15:706e18b43dd6
- Parent:
- 14:4b934ac37656
- Child:
- 16:135908f85971
diff -r 4b934ac37656 -r 706e18b43dd6 main.cpp --- a/main.cpp Mon Oct 10 14:31:10 2016 +0000 +++ b/main.cpp Mon Oct 10 14:36:40 2016 +0000 @@ -34,7 +34,7 @@ int main() { pc.baud(115200); // zorgt voor de link voor putty, 115200 is snelheid - QEI Encoder(D12,D13, NC, rev_rond); // maakt een encoder aan! D12/D13 ingangen, rev_rond zijn aantal pulsen per revolutie! Bovenaan in te stellen. + QEI Encoder1(D12,D13, NC, rev_rond); // maakt een encoder aan! D12/D13 ingangen, rev_rond zijn aantal pulsen per revolutie! Bovenaan in te stellen. QEI Encoder2(D15,D14, NC, rev_rond); float counts_encoder1; //variabele counts aanmaken float rev_counts_motor1; //variabele motor rondjes aanmaken in radialen!! @@ -59,7 +59,7 @@ richting_motor1 = 1; pwm_motor1 = a; ledcw=1; ledccw=0; - counts_encoder1 = Encoder.getPulses(); //tellen van de pulsen in + counts_encoder1 = Encoder1.getPulses(); //tellen van de pulsen in rev_counts_motor1=counts_encoder1/(gearboxratio*rev_rond); //berekenen van het aantal rondjes van motor. Gedeeld door gearboxratio en rev rond, om naar motorrondjes te gaan in plaats van pulsen van encoder! pc.printf("motor rondjes omhoog: %f \r\n", rev_counts_motor1); //weergeven @@ -73,7 +73,7 @@ pwm_motor2 = b; ledcw=1; ledccw=1; - counts_encoder2 = Encoder.getPulses(); //tellen van de pulsen in + counts_encoder2 = Encoder2.getPulses(); //tellen van de pulsen in rev_counts_motor2=counts_encoder2/(gearboxratio*rev_rond); //weergeven van het aantal rondjes pc.printf("motor rondjes omhoog: %f \r\n", rev_counts_motor2); } @@ -88,7 +88,7 @@ richting_motor1 = 0; pwm_motor1 = a; ledccw=1; ledcw=0; - counts_encoder1 = Encoder.getPulses(); //tellen van de pulsen in + counts_encoder1 = Encoder1.getPulses(); //tellen van de pulsen in rev_counts_motor1=counts_encoder1/(gearboxratio*rev_rond); //weergeven van het aantal rondjes pc.printf("motor rondjes omhoog: %f \r\n", rev_counts_motor1); @@ -101,14 +101,14 @@ richting_motor2 = 0; pwm_motor2 = b; ledccw=1; ledcw=0; - counts_encoder2 = Encoder.getPulses(); //tellen van de pulsen in + counts_encoder2 = Encoder2.getPulses(); //tellen van de pulsen in rev_counts_motor2=counts_encoder2/(gearboxratio*rev_rond); //weergeven van het aantal rondjes pc.printf("motor rondjes naar rechts: %f \r\n", rev_counts_motor2); } } else{ - pc.printf("motor staat stil \n\r"); + // pc.printf("motor staat stil \n\r"); pwm_motor2=0; pwm_motor1=0; ledccw=0; ;ledcw=0;