Added normal vector function