uyvug
Dependencies: Adafruit-16-Ch-PWM-Servo-Driver HCSR04 PID PololuQik2 QEI Sharp mbed-rtos
Fork of theRobot by
Diff: main.cpp
- Revision:
- 29:22b243e288c8
- Parent:
- 28:2bb6b0fe39d0
- Child:
- 30:db07aea6d119
diff -r 2bb6b0fe39d0 -r 22b243e288c8 main.cpp --- a/main.cpp Wed Apr 16 20:45:30 2014 +0000 +++ b/main.cpp Wed Apr 16 20:51:52 2014 +0000 @@ -74,7 +74,10 @@ #define TOOL_3 7 #define DRIVE_POSITION_TOOL 8 #define ORIENT_TOOL 9 -#define INSERT_TOOL 10 +#define PU_TOOL_1 10 +#define PU_TOOL_2 11 +#define PU_TOOL_3 12 +#define INSERT_TOOL_1 13 //Rig definitions @@ -215,6 +218,9 @@ {TOOL_3, 62, 50, 80, 132, 60, 0}, // Look over third tool {DRIVE_POSITION_TOOL, 85, 10, 0, 165, 140, 120}, // Drive with tool loaded {ORIENT_TOOL, 135, 60, 75, 60, 90, 90}, // position tool to be inserted + {PU_TOOL_1, 99, 46, 78, 110, 170, 0}, // STATIC Pickup tool POSITION + {PU_TOOL_2, 76, 47, 80, 112, 170, 0}, // STATIC Pickup tool POSITION + {PU_TOOL_3, 59, 44, 76, 110, 170, 0}, // STATIC Pickup tool POSITION {INSERT_TOOL_1, 170, 50, 127, 52, 140, 120}, // InsertToolIntoRig };