WIP: normalize matrix after orth