Added ability to set a random <collision free> start/goal position
Clean up debug output
Changed per PR review
Switched from isStateColliding to isStateValid
Merge pull request #412 from davetcoleman/hydro-devel

Added ability to set a random <collision free> start/goal position