diff --git a/Motion/motion.ino/motion.ino.ino b/Motion/motion.ino/motion.ino.ino new file mode 100644 index 0000000..d99aa59 --- /dev/null +++ b/Motion/motion.ino/motion.ino.ino @@ -0,0 +1,44 @@ + +#include + +// The two motor objects +MeDCMotor motor1(9); +MeDCMotor motor2(10); + +uint8_t Lspeed = 100; +uint8_t Rspeed = 100; +void setup() +{ +} + +void loop() +{ + + devant(); + delay(1000); + stop(); + delay(100); + turnleft(); + delay(1000); + +} +void turnright(){ + motor1.run(Lspeed); + motor2.run(Rspeed); +} +void turnleft(){ + motor1.run(-Lspeed); + motor2.run(-Rspeed); +} +void devant(){ + motor1.run(-Lspeed); + motor2.run(Rspeed); +} +void derriere(){ + motor1.run(Lspeed); + motor2.run(-Rspeed); +} +void stop(){ + motor1.run(0); + motor2.run(0); +} diff --git a/ultrasonicsensor/ultrasonicsensor.ino/ultrasonicsensor.ino.ino b/ultrasonicsensor/ultrasonicsensor.ino/ultrasonicsensor.ino.ino new file mode 100644 index 0000000..c8d10f7 --- /dev/null +++ b/ultrasonicsensor/ultrasonicsensor.ino/ultrasonicsensor.ino.ino @@ -0,0 +1,46 @@ + +#include +#include +// The two motor objects +MeDCMotor motor1(9); +MeDCMotor motor2(10); +MeUltrasonicSensor sensor1(3); +uint8_t Lspeed = 200; +uint8_t Rspeed = 200; +void setup() +{ + Serial.begin(9600); +} + +void loop() +{ + + devant(); + int distance = sensor1.distanceCm(); + Serial.println(distance); + if (distance < 20){ + turnright(); + delay(600); + } + +} +void turnright(){ + motor1.run(Lspeed); + motor2.run(Rspeed); +} +void turnleft(){ + motor1.run(-Lspeed); + motor2.run(-Rspeed); +} +void devant(){ + motor1.run(-Lspeed); + motor2.run(Rspeed); +} +void derriere(){ + motor1.run(Lspeed); + motor2.run(-Rspeed); +} +void stop(){ + motor1.run(0); + motor2.run(0); +}