Added drive motors and RobotDrive class to DriveTrain subsystem. Need to determine how to implement 6 drive motors