Grove motor driver example

robot_car_test.ino

#include "Grove_Motor_Driver_TB6612FNG.h"
#include <Wire.h>

MotorDriver motor;

#define FWD 128
#define BCK -FWD

double radians;

void setup()
{
    // join I2C bus (I2Cdev library doesn't do this automatically)
    Wire.begin();
    Serial.begin(9600);
    Serial.println("Initializing motor");
    motor.init();
    Serial.println("Done");
    radians=0;
}

void loop() {
  int speed = sin(radians) * 80;
  radians += 0.4;
  Serial.print("Angle: ");
  Serial.print(radians);
  Serial.print("; Speed: ");
  Serial.println(speed);
  motor.dcMotorRun(MOTOR_CHA, speed);
  motor.dcMotorRun(MOTOR_CHB, -speed);
  delay(500);
}

// void loop()
// {
//     // drive 2 dc motors at speed=255, clockwise
//     Serial.println("Turn direction 1");
//     delay(1000);
    
//     // brake
//     Serial.println("brake");
//     motor.dcMotorBrake(MOTOR_CHA);
//     motor.dcMotorBrake(MOTOR_CHB);
//     delay(1000);

//     // drive 2 dc motors at speed=200, anticlockwise
//     Serial.println("Turn direction 2");
//     motor.dcMotorRun(MOTOR_CHA, BCK);
//     motor.dcMotorRun(MOTOR_CHB, FWD);
//     delay(1000);

//     // stop 2 motors
//     Serial.println("stop");
//     motor.dcMotorStop(MOTOR_CHA);
//     motor.dcMotorStop(MOTOR_CHB);
//     delay(1000);
// }