Fixed something stupid.
Adding new error metrics for statistics accumulation.
Bug fixes.
Render goal vectors.
Plot deltas.
Plot MPC for synthetic deta.
Better looking plots
Generate global sample point images.
Render saved data for open loop stuff.
Merge branch 'SQP'