TESTS: Updated lqcontrol so it can take scalars as an argument and started writing tests.
TESTS: Finished writing some tests for quadsum and lss.