update links and robot geometry