fixed bug for quadric error matrix computation

used position instead of normal as p_x, p_y, p_z