Finalize physics rework mark 1. Orthonormalization still missing.