Merge pull request #5 from AlexReimann/raytracing_update

Raytracing update
Merge branch 'indigo-devel' of https://github.com/yujinrobot/navigation into indigo-devel