fixed major path planning error that would pass a nan for motors whenever the robot tried to go forward
fixed major path planning error that would pass a nan for motors whenever the robot tried to go forward

RoboJackets/igvc-software,RoboJackets/igvc-software,jzheng84/igvc-software,monstorium/igvc-software,dpattison3/igvc-software,dpattison3/igvc-software,jzheng84/igvc-software,kscharm/igvc-software,rmkeezer/igvc-software,rmkeezer/igvc-software,kscharm/igvc-software,dpattison3/igvc-software,dpattison3/igvc-software,kscharm/igvc-software,RoboJackets/igvc-software,kscharm/igvc-software,rmkeezer/igvc-software,monstorium/igvc-software,monstorium/igvc-software,RoboJackets/igvc-software,monstorium/igvc-software,monstorium/igvc-software,jzheng84/igvc-software,jzheng84/igvc-software