Added node generation Code.

I wanted to add this issue to let you know the new code is up. I was thinking you could generate a new path every time the robot position or the target changes. Hopefully that works out great for you. See you sometime this week!