![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
control for robotic arm that can play chess using a granular gripper
Dependencies: Encoder mbed HIDScope Servo MODSERIAL
Fork of chessRobot by
debug.cpp@103:4a37d19e8fcc, 2015-10-22 (annotated)
- Committer:
- MartijnGJ
- Date:
- Thu Oct 22 14:26:08 2015 +0000
- Revision:
- 103:4a37d19e8fcc
- Parent:
- 101:b821e89fc108
- Child:
- 104:750d7e13137d
Changed speeds
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
annesteenbeek | 14:0c0d1bfd94ea | 1 | #include "mbed.h" |
annesteenbeek | 14:0c0d1bfd94ea | 2 | #include "debug.h" |
annesteenbeek | 25:874675516927 | 3 | #include "HIDScope.h" |
annesteenbeek | 25:874675516927 | 4 | #include "buttons.h" |
annesteenbeek | 25:874675516927 | 5 | #include "actuators.h" |
annesteenbeek | 25:874675516927 | 6 | #include "config.h" |
annesteenbeek | 1:80f098c05d4b | 7 | // all the debugging functions |
annesteenbeek | 25:874675516927 | 8 | |
annesteenbeek | 98:25528494287d | 9 | // #define TUNEPID // set to switch between normal opperation or tuning PID |
annesteenbeek | 100:222c27f55b85 | 10 | #define TUNEEMG // set hdiscope for EMG |
annesteenbeek | 100:222c27f55b85 | 11 | //#define TUNEPWM // set hidscope for rest |
annesteenbeek | 57:43f707648f2b | 12 | |
annesteenbeek | 57:43f707648f2b | 13 | #ifdef TUNEPID |
annesteenbeek | 57:43f707648f2b | 14 | HIDScope scope(5); |
annesteenbeek | 57:43f707648f2b | 15 | |
annesteenbeek | 57:43f707648f2b | 16 | void debugProcess(){ |
annesteenbeek | 60:20945383ad1b | 17 | scope.set(0, motor2PID.getKp()); |
annesteenbeek | 60:20945383ad1b | 18 | scope.set(1, motor2PID.getKi()); |
annesteenbeek | 60:20945383ad1b | 19 | scope.set(2, motor2PID.getKd()); |
annesteenbeek | 57:43f707648f2b | 20 | scope.set(3, motor2SetSpeed); |
annesteenbeek | 57:43f707648f2b | 21 | scope.set(4, motor2Speed); |
annesteenbeek | 62:6c566e6f9664 | 22 | scope.set(5, motor2PWM); |
annesteenbeek | 57:43f707648f2b | 23 | scope.send(); |
annesteenbeek | 57:43f707648f2b | 24 | } |
annesteenbeek | 57:43f707648f2b | 25 | |
annesteenbeek | 78:0cc7c64ba94c | 26 | #endif |
annesteenbeek | 78:0cc7c64ba94c | 27 | #ifdef TUNEPWM |
annesteenbeek | 50:b0cf07ca53cf | 28 | HIDScope scope(4); |
annesteenbeek | 1:80f098c05d4b | 29 | |
annesteenbeek | 1:80f098c05d4b | 30 | void debugProcess(){ |
annesteenbeek | 60:20945383ad1b | 31 | scope.set(0, motor2Pos); |
annesteenbeek | 52:2ac9dee099ce | 32 | scope.set(1, motor2SetSpeed); |
annesteenbeek | 56:f730962fbb53 | 33 | scope.set(2, motor2Speed); |
annesteenbeek | 52:2ac9dee099ce | 34 | scope.set(3, motor2PWM); |
annesteenbeek | 25:874675516927 | 35 | scope.send(); |
annesteenbeek | 57:43f707648f2b | 36 | } |
annesteenbeek | 57:43f707648f2b | 37 | |
annesteenbeek | 78:0cc7c64ba94c | 38 | #endif |
annesteenbeek | 78:0cc7c64ba94c | 39 | |
annesteenbeek | 78:0cc7c64ba94c | 40 | #ifdef TUNEEMG |
annesteenbeek | 101:b821e89fc108 | 41 | HIDScope scope(6); // Number of scopes |
annesteenbeek | 78:0cc7c64ba94c | 42 | |
annesteenbeek | 78:0cc7c64ba94c | 43 | void debugProcess(){ |
annesteenbeek | 101:b821e89fc108 | 44 | scope.set(0,x_velocity); |
annesteenbeek | 101:b821e89fc108 | 45 | scope.set(1,motor1SetSpeed); |
annesteenbeek | 101:b821e89fc108 | 46 | scope.set(2,motor1Speed); |
MartijnGJ | 103:4a37d19e8fcc | 47 | scope.set(3,servoPulsewidth*100); |
MartijnGJ | 103:4a37d19e8fcc | 48 | scope.set(4,servoSpeed); |
annesteenbeek | 101:b821e89fc108 | 49 | scope.set(5,DOF); |
annesteenbeek | 78:0cc7c64ba94c | 50 | scope.send(); |
annesteenbeek | 78:0cc7c64ba94c | 51 | } |
annesteenbeek | 57:43f707648f2b | 52 | #endif |