boost extensions: Add orthonormalization functions and normalize function.