Code to drive Team 1's robot for the 2016 R5 robotics competition.

Dependencies:   mbed navigation R5_StepperDrive LongRangeSensor DistanceSensor scanner Gripper ColorSensor

Revision:
36:5b0bf9153c3d
Parent:
35:4e09da30bda2
Child:
38:ebf73b654553
--- a/r5driver.cpp	Sat Mar 26 22:59:55 2016 +0000
+++ b/r5driver.cpp	Sat Mar 26 23:21:21 2016 +0000
@@ -38,8 +38,9 @@
     ShortRangeSensor shortRangeR(PTC9, PTC8); // verify i2c pins
     LongRangeSensor longRangeL(pc, PTB2);
     LongRangeSensor longRangeR(pc, PTB3);
+    Gripper gripper(PTB2, PTB3); // grip pin, wrist pin
 
-    Scanner scanner(pc, drive, PTB0, PTB1, shortRangeL, shortRangeR, longRangeL, longRangeR, 0.075);
+    Scanner scanner(pc, drive, PTB0, PTB1, shortRangeL, shortRangeR, longRangeL, longRangeR, gripper, 0.075);
         // (Serial &, PinName servoL, PinName servoR, shortRangeL, shortRangeR, longRangeL, longRangeR, period)
 
     Navigation r5nav(scanner, 25);