![](/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@100:222c27f55b85, 2015-10-22 (annotated)
- Committer:
- annesteenbeek
- Date:
- Thu Oct 22 08:51:50 2015 +0000
- Revision:
- 100:222c27f55b85
- Parent:
- 98:25528494287d
- Child:
- 101:b821e89fc108
- Child:
- 110:a6439e13be8b
working EMG and DC motors
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 | 100:222c27f55b85 | 41 | HIDScope scope(5); // Number of scopes |
annesteenbeek | 78:0cc7c64ba94c | 42 | |
annesteenbeek | 78:0cc7c64ba94c | 43 | void debugProcess(){ |
annesteenbeek | 100:222c27f55b85 | 44 | scope.set(0,y_velocity); |
annesteenbeek | 100:222c27f55b85 | 45 | scope.set(1,motor2SetSpeed); |
annesteenbeek | 100:222c27f55b85 | 46 | scope.set(2,z_velocity); |
annesteenbeek | 100:222c27f55b85 | 47 | scope.set(3,mode); |
annesteenbeek | 100:222c27f55b85 | 48 | scope.set(4,DOF); |
annesteenbeek | 100:222c27f55b85 | 49 | scope.set(5,motorsEnable); |
annesteenbeek | 78:0cc7c64ba94c | 50 | scope.send(); |
annesteenbeek | 78:0cc7c64ba94c | 51 | } |
annesteenbeek | 57:43f707648f2b | 52 | #endif |