Ortho normalization added. Almost done with the whole local calculation of the offset matrix thing.