diff --git a/ultrasonicSensor/ultrasonicSensor.ino b/ultrasonicSensor/ultrasonicSensor.ino new file mode 100644 index 0000000..1822301 --- /dev/null +++ b/ultrasonicSensor/ultrasonicSensor.ino @@ -0,0 +1,43 @@ +#include + + + +MeDCMotor motorL(M1); //positive go backward + +MeDCMotor motorR(M2); //positive go forward + +MeUltrasonicSensor ultraSensor(PORT_3); + +uint8_t motorSpeed = 100; + +void setup() +{ + Serial.begin(9600); +} + +void loop() +{ + + Serial.print("Distance : "); + Serial.print(ultraSensor.distanceCm() ); + Serial.println(" cm"); + delay(100); + + /*motorL.run(motorSpeed); // value: between -255 and 255. + /motorR.run(motorSpeed); // value: between -255 and 255. + + delay(2000); + motorL.stop(); + motorR.stop(); + + delay(100); + motorL.run(-motorSpeed); + motorR.run(-motorSpeed); + + delay(2000); + motorL.stop(); + motorR.stop(); + + delay(2000); + */ +}