Apply floor for nearestDistance
Apply floor for nearestDistance

2 changes
-  Apply floor for nearestDistance
- Change step of FORWARD from 15 to 5

RobotTeam2/Stereo3dcam,RobotTeam2/Stereo3dcam,RobotTeam2/Stereo3dcam