SDDRE codes run end-to-end now

Can now compare LQ Optimal control and SDDRE programs