new sergio urdf model working