V0.2 Minor changes.

Added some more stuff to matrix class, will probably refactor later, and
move some of it into Clock pathfinder function.