Refactor the from_urdf function from RobotLibrary to Robot #437
Draft
Refactor the from_urdf function from RobotLibrary to Robot #437
from_urdf function from RobotLibrary to Robot #437