function p = rotatez(p1,angle)
%
p(1) = p1(1)*cos(angle) + p1(2)*sin(angle);
p(2) = -p1(1)*sin(angle) + p1(2)*cos(angle);
p(3) = p1(3);
end
