/**************************************************************************************                                                                                  
*   Easy calibration for Otto DIY                                                 
*   Javier Isabel, 02/06/2015                                                         
*   VERY IMPORTANT only calibrate one time per board!to avoid damage EEPROM memory
**************************************************************************************/
#include <Otto.h>
#include <Servo.h>
#include <Oscillator.h>
#include <EEPROM.h>
Otto Otto;

void setup()
{
  Otto.init(2, 3, 4, 5, false);
  Otto.setTrims(-7,-4,-4,7); //change Trim "offset values" gradually until Otto is completely straight (90º)
 // Otto.saveTrimsOnEEPROM(); //use only after completely straight(90º), delete this line after for further programming
}
int posiciones[] = {90, 90, 90, 90};

void loop()  //test comparing before & after function
{
  Otto.home();
 // delay(4000);
 // Otto.updown(6, 500, BIG);   
 // delay(2000);
 //   
 // Otto.walk(4,1800);
 //delay(2000);
}
