Feature/normal matrix

Adding in normal matrix