The angle in the urdf model seems to be right the other way