Boost extensions

Created orthogonalization methods (Gram-Schmidt) and made some little cleanups.