#include

#include

#include "Microduino_MotorPlus.h"

#include

Motor MotorLeft(MOTOR0_PINA, MOTOR0_PINB);

Motor MotorRight(MOTOR1_PINA, MOTOR1_PINB);

void mCookieCar(int _left, int _right)

{

if (_left == 0)

{

MotorLeft.Brake();

}

else

{

MotorLeft.setSpeed(-1 * _left);

}

if (_right == 0)

{

MotorRight.Brake();

}

else

{

MotorRight.setSpeed(_right);

}

}

MotorPlus motor(MOTOR_ADDR4);

U8GLIB_SSD1306_128X64 u8g(U8G_I2C_OPT_NONE);

void setup()

{

MotorLeft.begin();

MotorRight.begin();

motor.begin();

}

void loop()

{

mCookieCar(50,50);

if(false)

{

motor.setSpeed1(BRAKE);

motor.setSpeed1(BRAKE);

tone(6,440);

delay(50);

noTone(6);

motor.setSpeed1(BRAKE);

motor.setSpeed1(BRAKE);

tone(2,440);

delay(50);

noTone(2);

}

else

{

mCookieCar(50,50);

}

while(1)

{

u8g.setFont(u8g_font_9x15);

u8g.firstPage();

do

{

u8g.setPrintPos(29, 15);

u8g.print("@@");

u8g.setPrintPos(25, 25);

u8g.print("@@");

u8g.setPrintPos(33, 35);

u8g.print("@@@");

u8g.setPrintPos(47, 47);

u8g.print("@@");

u8g.setPrintPos(67, 15);

u8g.print("@@");

u8g.setPrintPos(70, 25);

u8g.print("@@");

u8g.setPrintPos(60, 35);

u8g.print("@@");

u8g.setPrintPos(45, 25);

u8g.print("@@@");

u8g.setPrintPos(52, 54);

u8g.print("@");

}

while ( u8g.nextPage() );

}

}