Added DrivetrainDriveDistanceCommand

Added a few methods to drivetrain, utilized the brake PID controllers to
drive for a distance, modified several command's end(), interrupted(),
and isFinished() methods.