Added the ability to integrate kinect generated constraints into the raven planning
Merge branch 'master' of https://github.com/rll/raven_2
Added ransac, better data reading, better simulation, and finished the particle filter