add 2dof test rig urdf