Gripper and Color sensor basic functionality testing.

Dependencies:   mbed

Revision:
0:b30091b30223
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/driver.cpp	Sat Mar 26 23:30:29 2016 +0000
@@ -0,0 +1,37 @@
+#include "mbed.h"
+#include "gripper.h"
+#include "ColorSensor.h"
+
+Serial vcom(USBTX, USBRX);
+
+float frequency = 50.0f;
+float duty_cycle = 0.50f;
+float period = ( 1.0f / frequency );
+
+int main()
+{
+    vcom.baud(115200);
+    
+    vcom.printf("Hello World!");
+    
+    Gripper gripper(PTB0, PTB1);
+    ColorSensor colorSensor(PTC2, PTC1);
+    
+    /*
+    gripper.grip();
+    wait(1.0);
+    gripper.lift();
+    wait(1.0);
+    gripper.lower();
+    wait(1.0);
+    gripper.release();
+    wait(1.0);
+    */
+    
+    
+    
+    colorSensor.getR();
+    vcom.printf("%i", colorSensor.getR());
+    wait(0.5);
+    
+}
\ No newline at end of file