44 lines
667 B
C++
44 lines
667 B
C++
#include <MeMCore.h>
|
|
|
|
|
|
|
|
MeDCMotor motorL(M1); //positive go backward
|
|
|
|
MeDCMotor motorR(M2); //positive go forward
|
|
|
|
MeUltrasonicSensor ultraSensor(PORT_3);
|
|
|
|
uint8_t motorSpeed = 100;
|
|
|
|
void setup()
|
|
{
|
|
Serial.begin(9600);
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
|
|
Serial.print("Distance : ");
|
|
Serial.print(ultraSensor.distanceCm() );
|
|
Serial.println(" cm");
|
|
delay(100);
|
|
|
|
/*motorL.run(motorSpeed); // value: between -255 and 255.
|
|
/motorR.run(motorSpeed); // value: between -255 and 255.
|
|
|
|
delay(2000);
|
|
motorL.stop();
|
|
motorR.stop();
|
|
|
|
delay(100);
|
|
motorL.run(-motorSpeed);
|
|
motorR.run(-motorSpeed);
|
|
|
|
delay(2000);
|
|
motorL.stop();
|
|
motorR.stop();
|
|
|
|
delay(2000);
|
|
*/
|
|
}
|