Added swing simulation in Gazebo and model status