Added robot collision plotting to aid in adjusting the robot model