Debug stage CheckReadiness
Merge branch 'master' of https://github.com/cedricpradalier/ros_kf_stack

Conflicts:
	radial_plan/CMakeLists.txt
Merge branch 'master' of https://github.com/cedricpradalier/ros_kf_stack
cosmetics
Merge branch 'master' of https://github.com/cedricpradalier/ros_kf_stack
Rewritten buffer intersections as rectangle operations.
Seem to work, and reasonable computing load, not tested on real operation yet