Initial Orthogonal Matrix

Create method orthogonal and class Vector. othrogonal still needs a lot
of work but checking it in to prevent myself for completely breaking the
method while I work on it.