Satisfying point cloud accumulation
Working controller and obstacle avoidance. Todo: add ros parameters to
clean-up...