Make the pedestrian.y modulo Y_MAX, also change the PotentialPlanner so that it can handle maxSpeed 25m/s