Completed basic LQ minimization method.
Ready to start testing.