Matlab Controller V2 Completed

- Contest function structure adopted.
- Added LS solution using QR decomposition method.
LU decomposition method proved not accurate enough
PINV method proved to expensive computationally
- LS method used only for control since G matrix is square.
- PINV still used for initial conditions guess since C matrix is not
square.