calculate_normal function

Calculate Normal