uyvug

Dependencies:   Adafruit-16-Ch-PWM-Servo-Driver HCSR04 PID PololuQik2 QEI Sharp mbed-rtos

Fork of theRobot by Thomas Ashworth

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
 
 };