updated to latest BH-Lib
Merge branch 'master' of https://github.com/jvisenti/compgeo into RV-App
planners now check validity of start/goal states before planning
mostly comment changes
can now plan to anywhere (few bugs)
planning with roll
the latest
added aggressive optimization flags in release build
now snap to goal states
fixed hash table bug
manhattan planning
storing invalid states
fixed 6D planning bug
hash functions now use const refs
environment no longer uses "radius" sizes
some environment3D cleanup using AABBs
environment in bounds check now works using AABBs
roll/pitch/yaw return 0 in gimbal lock case
world to planner translations done in environment
removed redundant method