Added normvector calculation

the new function is not tested yet