Compare commits
2 Commits
8833dfcf39
...
aec9018419
| Author | SHA1 | Date |
|---|---|---|
|
|
aec9018419 | |
|
|
d7defd4168 |
|
|
@ -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);
|
||||||
|
}
|
||||||
Loading…
Reference in New Issue