Updates, getting things running in gazebo
Fixing more stuff in urdf, making base link fixed to the world