append_cfp_elem append_tdist_elem cfp_make cfp_make_zero compute_angle compute_dist2 compute_dist_tpoly_point compute_dist_tpoly_poly compute_s compute_turnpoints_tpoly_point dist2d_trgeoinst_geo dist2d_trgeoseq_geo dist2d_trgeoseq_point dist2d_trgeoseq_poly dist2d_trgeoseqset_geo distance_trgeo_geo distance_trgeo_tpoint distance_trgeo_trgeo edge_vertex_tpoly_point edge_vertex_tpoly_poly f_parallel_edges_tpoly_poly f_poly_tpoly f_tpoint_poly f_tpoly_poly f_turnpoints_v_e_tpoint_poly f_turnpoints_v_v_tpoint_poly free_cfp_array free_tdist_array init_cfp_array init_tdist_array nad_trgeo_geo nad_trgeo_stbox nad_trgeo_tpoint nad_trgeo_trgeo nai_trgeo_geo nai_trgeo_tpoint nai_trgeo_trgeo pose_diff_2d pose_interpolate_2d shortestline_trgeo_geo shortestline_trgeo_tpoint shortestline_trgeo_trgeo solve_angle_0_poly_tpoly solve_angle_0_tpoly_point solve_parallel_edges_tpoly_poly solve_s_poly_tpoly solve_s_tpoly_point solve_s_tpoly_poly tdist_make uint_mod_add uint_mod_sub vertex_edge_tpoly_poly vertex_vertex_tpoly_point vertex_vertex_tpoly_poly

pose_diff_2d() static void pose_diff_2d ( Pose *  pose1, Pose *  pose2, double *  x, double *  y, double *  theta  ) static