move subtended_angle and distance_2_point to Rcpp