Separated urdf description and fixed some bugs in urdf