RoboticsLab2/motion/motion.ino

40 lines
699 B
C++

#include "MeOrion.h"
#include "MeDCMotor.h"
MeDCMotor motor1(PORT_1);
MeDCMotor motor2(PORT_2);
MeDCMotor motor3(M1);
MeDCMotor motor4(M2);
uint8_t motorSpeed = 100;
void setup()
{
}
void loop()
{
//motor1.run(motorSpeed); /* value: between -255 and 255. */
//motor2.run(motorSpeed); /* value: between -255 and 255. */
motor3.run(motorSpeed);
motor4.run(-motorSpeed);
delay(2000);
//motor1.stop();
//motor2.stop();
motor3.stop();
motor4.stop();
delay(100);
//motor1.run(-motorSpeed);
//motor2.run(-motorSpeed);
motor3.run(-motorSpeed);
motor4.run(-motorSpeed);
delay(2000);
//motor1.stop();
//motor2.stop();
motor3.stop();
motor4.stop();
delay(2000);
}