Arm navigation with obstacle avoidance

Arm navigation with obstacle avoidance simulation.

https://github.com/AtsushiSakai/PythonRoboticsGifs/raw/master/ArmNavigation/arm_obstacle_navigation/animation.gif