Almost compleated Hmat and Hmattest. Need to implement function inv in Hmat and its test. Cant Compile yet.