Disabling unnecessary parameters
Fix parameters of the obstacle avoidance
Add visualization data