Implemented own matrices. Buggy.

- The major bug is that rotation from input is
  abt. 80x what it should be. I am trying to fix
  this.