How do I add control Plots to this Robotics code?

I need help adding control plots for my mobile robot. Plots such as x and y velocities and theta against time.

Any help will be appreciated.

Thanks.