This is a repository which can draw the model's trajectory in Gazebo.
The launch file and urdf are just examples for better understanding, please add the code to your own files according to the notes in my files.
Remenber to add the corresponding configuration in you CmakeLists.txt to ensure that the plugin can be generated.