Fix for plot_data.py script.

Do not show empty plots. Refactor some code in plot_data.py and
sampleplotter.py.
Merged plot_fixes from oliverlee/plot_fixes
Bugfix in YawRateController.  Added plots of debug vars.

Steer torque at previous time step was not being used when performing state
update.