Implemented first part of Udate Algorithm.

* Testing and plotting the A matrix.
* Finished gameSetup class.