#define SDA_1 21
#define SCL_1 22

#define SDA_2 4
#define SCL_2 17

TwoWire Wire = TwoWire(0);
TwoWire Wire1 = TwoWire(1);

void setup()
{
  Wire.begin(SDA_1, SCL_1, 100000);
  Wire1.begin(SDA_2, SCL_2, 100000);


  //HMD.begin();
  Serial.begin(9600);
  HMD.Mode(0); // Internal trigger input mode -- Must use the GO() function to trigger playback.
  HMD.MotorSelect(0x36); // ERM motor, 4x Braking, Medium loop gain, 1.365x back EMF gain
  HMD.Library(2); //1-5 & 7 for ERM motors, 6 for LRA motors

}