Merge pull request #65 from Jailander/hydro-devel

Adding 3D obstacle avoidance
bug fix
adding with mux argument