Refactor the from_urdf
function from RobotLibrary to Robot #437
Draft
yck011522 wants to merge 3 commits intomainfrom refactor/robot_from_urdf
+55-37
from_urdf
function from RobotLibrary to Robot #437