build the matrix directly rather then calculating with axis/angle also remove unused function calc_poly_plane