Changed PID to P controller. Added resetEncoder method. Added content to AutoDriveDistanceCmd.