Correct normal matrix calculation