Modularize code

[hello-binit]

I've recently created a tool called stretch_configure_tool.py that has a lot overlap with stretch_urdf_ros_update.py, however, I had to duplicate much of the code because it's not provided as a library here. To avoid duplication of code for generating URDF, I suggest we modularize the code and make it import-able as import stretch_urdf.