DriveStraight

Change units to meters
Renamed SmartDashboard fields
worked on DriveStraight command.