Merge branch 'develop'

This commit is contained in:
Julian LECLERC 2022-04-01 10:23:19 +02:00
commit aec9018419
1 changed files with 31 additions and 0 deletions

31
roomba/roomba.ino Normal file
View File

@ -0,0 +1,31 @@
//#include "MeOrion.h"
#include <MeMCore.h>
MeDCMotor motor3(M1);
MeDCMotor motor4(M2);
uint8_t motorSpeed = 200;
MeUltrasonicSensor ultraSensor(PORT_3);
void setup()
{
Serial.begin(9600);
}
void loop()
{
if(ultraSensor.distanceCm()>20) {
motor3.run(-motorSpeed);
motor4.run(motorSpeed);
}else if((ultraSensor.distanceCm()<15)) {
motor3.stop();
motor4.stop();
motor3.run(motorSpeed);
motor4.run(-motorSpeed);
} else {
motor3.run(motorSpeed);
motor4.run(motorSpeed);
}
delay(100);
}