PRM implemented

Steps 1-5 of the lab implemented and mostly debugged.

One outstanding issue: every now and then, a node manages to get a
collision free path to the goal where it shouldn't.  It does not go
through walls otherwise (checked with an impossible goal, and the nodes
did not cross the walls).