Gripper and Color sensor basic functionality testing.
Dependencies: mbed
Diff: driver.cpp
- 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