gazebo_plugin to solve the issue that URDF not support Closed loop chains. - View it on GitHub