Major refactoring of URDF

Major cleanup/refectoring/JSDocing/other random stuff for URDF parsing and visualization.