/* 6 Wheel Calibration
*
* Use this sketch to calibrate the wheels in your robot.
* Your robot should drive as straight as possible when
* putting both motors at the same speed.
*
* Run the software and follow the on-screen instructions.
* Use the trimmer on the bottom board to make sure the
* robot is working at its best!
*
* (c) 2013 X. Yang
*/
#include "scripts_library.h"
#include <ArduinoRobot.h>
#include <Wire.h>
void setup() {
  Serial.begin(9600);
  Robot.begin();
  Robot.beginTFT();
  Robot.beginSD();
  Robot.setTextWrap(false);
  Robot.displayLogos();
  writeAllScripts();
}
void loop() {
  int val = map(Robot.knobRead(), 0, 1023, -255, 255);
  Serial.println(val);
  Robot.motorsWrite(val, val);
  int WC = map(Robot.trimRead(), 0, 1023, -20, 20);
  Robot.debugPrint(WC, 108, 149);
  delay(40);
}