 
 // the setup function runs once when you press reset or power the board
 void setup() {      
+  
+  // Motor pins as outputs
+  pinMode(PIN_LEFT_REV,   OUTPUT);
+  pinMode(PIN_LEFT_FOR,   OUTPUT);
+  pinMode(PIN_LEFT_SPEED, OUTPUT);
+  pinMode(PIN_RIGHT_REV,  OUTPUT);
+  pinMode(PIN_RIGHT_FOR,  OUTPUT);
+  pinMode(PIN_RIGHT_SPEED,OUTPUT);
+
+  leftMotorSpeed(0);
+  rightMotorSpeed(0);
 
   // Wait 10 seconds before starting to give the ISP programmer a chance to kick in
   //  Will remove once the prog command is tested

int PIN_SPI_MISO = 12;
int PIN_SPI_SCK  = 13;

// Command Strings
// // Incoming
String CMD_IN_DRIVE_MOTOR_CTRL = "DMC";

/*
  Motor Control - Simon Lees simon@simotek.net
 */

// Pins In USE
// Motor PWM
int PIN_LEFT_REV = A3;
int PIN_LEFT_FOR = A2;

int PIN_LEFT_SPEED = 3;


int PIN_RIGHT_REV = A1;
int PIN_RIGHT_FOR = A0;

int PIN_RIGHT_SPEED = 5;


// Serial Pins are only used by the Serial Driver
int PIN_SERIAL_RX = 0;
