//#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);
}