Cleaned up URDF files and added some startup scripts