{ "metadata": { "started_wall_time": 1784712669.9784446, "duration_sec": 30.06533822099999, "output_path": "/home/sunrise/yiliao_ws/test_results/goal_reach_debug_20260722_173109.json" }, "topics": { "odom": "/odom", "goal_pose": "/goal_pose", "plan": "/plan", "cmd_vel": "/planner_cmd_vel", "ackermann_cmd": "/ackermann_cmd", "planner_status": "/hybrid_astar_status", "tracker_status": "/pure_pursuit_status" }, "topic_endpoints": { "/odom": { "publisher_count": 1, "subscriber_count": 4, "publishers": [ { "node_name": "origincar_base", "node_namespace": "/", "topic_type": "nav_msgs/msg/Odometry" } ], "subscribers": [ { "node_name": "planner_odom_map_tf", "node_namespace": "/", "topic_type": "nav_msgs/msg/Odometry" }, { "node_name": "grid_astar_theta_planner", "node_namespace": "/", "topic_type": "nav_msgs/msg/Odometry" }, { "node_name": "topology_pure_pursuit", "node_namespace": "/", "topic_type": "nav_msgs/msg/Odometry" }, { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "nav_msgs/msg/Odometry" } ] }, "/goal_pose": { "publisher_count": 1, "subscriber_count": 2, "publishers": [ { "node_name": "foxglove_bridge", "node_namespace": "/", "topic_type": "geometry_msgs/msg/PoseStamped" } ], "subscribers": [ { "node_name": "grid_astar_theta_planner", "node_namespace": "/", "topic_type": "geometry_msgs/msg/PoseStamped" }, { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "geometry_msgs/msg/PoseStamped" } ] }, "/plan": { "publisher_count": 2, "subscriber_count": 2, "publishers": [ { "node_name": "grid_astar_theta_planner", "node_namespace": "/", "topic_type": "nav_msgs/msg/Path" }, { "node_name": "topology_pure_pursuit", "node_namespace": "/", "topic_type": "nav_msgs/msg/Path" } ], "subscribers": [ { "node_name": "topology_pure_pursuit", "node_namespace": "/", "topic_type": "nav_msgs/msg/Path" }, { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "nav_msgs/msg/Path" } ] }, "/planner_cmd_vel": { "publisher_count": 1, "subscriber_count": 2, "publishers": [ { "node_name": "topology_pure_pursuit", "node_namespace": "/", "topic_type": "geometry_msgs/msg/Twist" } ], "subscribers": [ { "node_name": "planner_ackermann_cmd_bridge", "node_namespace": "/", "topic_type": "geometry_msgs/msg/Twist" }, { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "geometry_msgs/msg/Twist" } ] }, "/ackermann_cmd": { "publisher_count": 1, "subscriber_count": 2, "publishers": [ { "node_name": "planner_ackermann_cmd_bridge", "node_namespace": "/", "topic_type": "ackermann_msgs/msg/AckermannDriveStamped" } ], "subscribers": [ { "node_name": "origincar_base", "node_namespace": "/", "topic_type": "ackermann_msgs/msg/AckermannDriveStamped" }, { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "ackermann_msgs/msg/AckermannDriveStamped" } ] }, "/hybrid_astar_status": { "publisher_count": 1, "subscriber_count": 1, "publishers": [ { "node_name": "grid_astar_theta_planner", "node_namespace": "/", "topic_type": "std_msgs/msg/String" } ], "subscribers": [ { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "std_msgs/msg/String" } ] }, "/pure_pursuit_status": { "publisher_count": 1, "subscriber_count": 1, "publishers": [ { "node_name": "topology_pure_pursuit", "node_namespace": "/", "topic_type": "std_msgs/msg/String" } ], "subscribers": [ { "node_name": "goal_reach_debug_collector", "node_namespace": "/", "topic_type": "std_msgs/msg/String" } ] } }, "remote_parameters": { "planner": { "node": "/grid_astar_theta_planner", "service": "/grid_astar_theta_planner/get_parameters", "values": { "goal_xy_tolerance": 0.15, "goal_yaw_tolerance": 0.174533, "require_goal_yaw": false, "resolution": 0.1, "yaw_bins": 36, "primitive_length": 0.12, "min_turning_radius": 0.25, "heuristic_weight": 1.35, "goal_yaw_heuristic_weight": 0.0, "planning_timeout_ms": 1500.0, "max_iterations": 200000 } }, "tracker": { "node": "/topology_pure_pursuit", "service": "/topology_pure_pursuit/get_parameters", "values": { "goal_tolerance": 0.15, "goal_yaw_tolerance": 0.174533, "align_goal_yaw": false, "publish_cmd_vel": true, "cmd_vel_topic": "/planner_cmd_vel", "lookahead_distance": 0.4, "linear_speed": 0.6, "min_linear_speed": 0.08, "reverse_speed": 0.25, "slowdown_distance": 0.35, "curvature_slowdown_gain": 0.1, "min_turning_radius": 0.25, "max_angular_speed": 2.8 } } }, "latest": { "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan": { "frame_id": "map", "points": 121, "length": 3.5995680777533363, "start": { "x": 0.0, "y": 0.0, "yaw": 0.0 }, "end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "reverse_segment_fraction": 0.0 }, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.018684561000000002, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714", "last_plan_ok": { "points": 121, "iterations": 45, "planning_ms": 64.58, "goal_error": 0.065, "yaw_error": 0.96 }, "plan_points": [ { "x": 0.0, "y": 0.0, "yaw": 0.0 }, { "x": 0.02992805182222984, "y": 0.0017978410365334374, "yaw": 0.12 }, { "x": 0.05942565660678364, "y": 0.0071655062869925845, "yaw": 0.23999999999999994 }, { "x": 0.08806855831877249, "y": 0.016025794080516298, "yaw": 0.36000000000000004 }, { "x": 0.11544479388537073, "y": 0.02825126930517896, "yaw": 0.48000000000000004 }, { "x": 0.14116061834875887, "y": 0.043666096272580446, "yaw": 0.6000000000000002 }, { "x": 0.16484616799286828, "y": 0.06204856771477624, "yaw": 0.7199999999999999 }, { "x": 0.18616077999271485, "y": 0.083134293539673, "yaw": 0.8400000000000002 }, { "x": 0.20479789207524957, "y": 0.10662000348188583, "yaw": 0.96 }, { "x": 0.22200349165742328, "y": 0.13119575053091578, "yaw": 0.96 }, { "x": 0.23920909123959697, "y": 0.1557714975799457, "yaw": 0.96 }, { "x": 0.25641469082177065, "y": 0.18034724462897567, "yaw": 0.96 }, { "x": 0.27362029040394437, "y": 0.2049229916780056, "yaw": 0.96 }, { "x": 0.2908258899861181, "y": 0.22949873872703555, "yaw": 0.96 }, { "x": 0.30803148956829174, "y": 0.2540744857760655, "yaw": 0.96 }, { "x": 0.32523708915046545, "y": 0.27865023282509543, "yaw": 0.96 }, { "x": 0.34244268873263917, "y": 0.30322597987412536, "yaw": 0.96 }, { "x": 0.3596482883148129, "y": 0.3278017269231553, "yaw": 0.96 }, { "x": 0.3768538878969866, "y": 0.3523774739721853, "yaw": 0.96 }, { "x": 0.39405948747916025, "y": 0.3769532210212152, "yaw": 0.96 }, { "x": 0.41126508706133397, "y": 0.40152896807024513, "yaw": 0.96 }, { "x": 0.42990219914386874, "y": 0.42501467801245796, "yaw": 0.8399999999999999 }, { "x": 0.45121681114371526, "y": 0.4461004038373547, "yaw": 0.7199999999999999 }, { "x": 0.47490236078782466, "y": 0.46448287527955057, "yaw": 0.5999999999999999 }, { "x": 0.5006181852512128, "y": 0.479897702246952, "yaw": 0.48000000000000004 }, { "x": 0.5272280329345913, "y": 0.49375107751319647, "yaw": 0.48000000000000004 }, { "x": 0.5538378806179699, "y": 0.507604452779441, "yaw": 0.48000000000000004 }, { "x": 0.5804477283013484, "y": 0.5214578280456854, "yaw": 0.48000000000000004 }, { "x": 0.6070575759847269, "y": 0.5353112033119299, "yaw": 0.48000000000000004 }, { "x": 0.632773400448115, "y": 0.5507260302793314, "yaw": 0.6000000000000002 }, { "x": 0.6564589500922244, "y": 0.5691085017215272, "yaw": 0.7199999999999999 }, { "x": 0.677773562092071, "y": 0.590194227546424, "yaw": 0.8400000000000002 }, { "x": 0.6964106741746057, "y": 0.6136799374886368, "yaw": 0.96 }, { "x": 0.7136162737567794, "y": 0.6382556845376668, "yaw": 0.96 }, { "x": 0.7308218733389531, "y": 0.6628314315866967, "yaw": 0.96 }, { "x": 0.7480274729211268, "y": 0.6874071786357266, "yaw": 0.96 }, { "x": 0.7652330725033005, "y": 0.7119829256847566, "yaw": 0.96 }, { "x": 0.7824386720854742, "y": 0.7365586727337866, "yaw": 0.96 }, { "x": 0.799644271667648, "y": 0.7611344197828165, "yaw": 0.96 }, { "x": 0.8168498712498217, "y": 0.7857101668318465, "yaw": 0.96 }, { "x": 0.8340554708319954, "y": 0.8102859138808765, "yaw": 0.96 }, { "x": 0.8512610704141691, "y": 0.8348616609299064, "yaw": 0.96 }, { "x": 0.8684666699963428, "y": 0.8594374079789363, "yaw": 0.96 }, { "x": 0.8856722695785165, "y": 0.8840131550279663, "yaw": 0.96 }, { "x": 0.9028778691606902, "y": 0.9085889020769963, "yaw": 0.96 }, { "x": 0.920083468742864, "y": 0.9331646491260263, "yaw": 0.96 }, { "x": 0.9372890683250377, "y": 0.9577403961750561, "yaw": 0.96 }, { "x": 0.9544946679072114, "y": 0.9823161432240861, "yaw": 0.96 }, { "x": 0.9717002674893851, "y": 1.006891890273116, "yaw": 0.96 }, { "x": 0.9889058670715588, "y": 1.031467637322146, "yaw": 0.96 }, { "x": 1.0061114666537325, "y": 1.056043384371176, "yaw": 0.96 }, { "x": 1.0233170662359061, "y": 1.0806191314202058, "yaw": 0.96 }, { "x": 1.04052266581808, "y": 1.1051948784692358, "yaw": 0.96 }, { "x": 1.0577282654002536, "y": 1.1297706255182658, "yaw": 0.96 }, { "x": 1.0749338649824274, "y": 1.1543463725672958, "yaw": 0.96 }, { "x": 1.092139464564601, "y": 1.1789221196163258, "yaw": 0.96 }, { "x": 1.1093450641467748, "y": 1.2034978666653555, "yaw": 0.96 }, { "x": 1.1265506637289484, "y": 1.2280736137143855, "yaw": 0.96 }, { "x": 1.1437562633111222, "y": 1.2526493607634155, "yaw": 0.96 }, { "x": 1.1609618628932958, "y": 1.2772251078124452, "yaw": 0.96 }, { "x": 1.1781674624754697, "y": 1.3018008548614752, "yaw": 0.96 }, { "x": 1.1953730620576433, "y": 1.3263766019105052, "yaw": 0.96 }, { "x": 1.212578661639817, "y": 1.3509523489595352, "yaw": 0.96 }, { "x": 1.2297842612219907, "y": 1.3755280960085652, "yaw": 0.96 }, { "x": 1.2469898608041645, "y": 1.400103843057595, "yaw": 0.96 }, { "x": 1.2641954603863381, "y": 1.424679590106625, "yaw": 0.96 }, { "x": 1.281401059968512, "y": 1.449255337155655, "yaw": 0.96 }, { "x": 1.2986066595506855, "y": 1.4738310842046847, "yaw": 0.96 }, { "x": 1.3158122591328594, "y": 1.4984068312537147, "yaw": 0.96 }, { "x": 1.3344493712153942, "y": 1.5218925411959274, "yaw": 0.8399999999999999 }, { "x": 1.3557639832152406, "y": 1.5429782670208243, "yaw": 0.7199999999999999 }, { "x": 1.3794495328593501, "y": 1.5613607384630201, "yaw": 0.5999999999999999 }, { "x": 1.4051653573227383, "y": 1.5767755654304216, "yaw": 0.48000000000000004 }, { "x": 1.4317752050061168, "y": 1.590628940696666, "yaw": 0.48000000000000004 }, { "x": 1.4583850526894953, "y": 1.6044823159629107, "yaw": 0.48000000000000004 }, { "x": 1.484994900372874, "y": 1.618335691229155, "yaw": 0.48000000000000004 }, { "x": 1.5116047480562524, "y": 1.6321890664953995, "yaw": 0.48000000000000004 }, { "x": 1.538214595739631, "y": 1.646042441761644, "yaw": 0.48000000000000004 }, { "x": 1.5648244434230094, "y": 1.6598958170278886, "yaw": 0.48000000000000004 }, { "x": 1.591434291106388, "y": 1.673749192294133, "yaw": 0.48000000000000004 }, { "x": 1.6180441387897666, "y": 1.6876025675603774, "yaw": 0.48000000000000004 }, { "x": 1.644653986473145, "y": 1.7014559428266218, "yaw": 0.48000000000000004 }, { "x": 1.6712638341565236, "y": 1.7153093180928665, "yaw": 0.48000000000000004 }, { "x": 1.6978736818399023, "y": 1.7291626933591109, "yaw": 0.48000000000000004 }, { "x": 1.7244835295232808, "y": 1.7430160686253553, "yaw": 0.48000000000000004 }, { "x": 1.7510933772066593, "y": 1.7568694438915997, "yaw": 0.48000000000000004 }, { "x": 1.7777032248900377, "y": 1.7707228191578444, "yaw": 0.48000000000000004 }, { "x": 1.8043130725734162, "y": 1.7845761944240888, "yaw": 0.48000000000000004 }, { "x": 1.830922920256795, "y": 1.7984295696903332, "yaw": 0.48000000000000004 }, { "x": 1.8575327679401734, "y": 1.8122829449565776, "yaw": 0.48000000000000004 }, { "x": 1.884142615623552, "y": 1.8261363202228222, "yaw": 0.48000000000000004 }, { "x": 1.9107524633069306, "y": 1.8399896954890667, "yaw": 0.48000000000000004 }, { "x": 1.937362310990309, "y": 1.853843070755311, "yaw": 0.48000000000000004 }, { "x": 1.9639721586736876, "y": 1.8676964460215555, "yaw": 0.48000000000000004 }, { "x": 1.990582006357066, "y": 1.8815498212878001, "yaw": 0.48000000000000004 }, { "x": 2.0171918540404445, "y": 1.8954031965540445, "yaw": 0.48000000000000004 }, { "x": 2.0438017017238232, "y": 1.909256571820289, "yaw": 0.48000000000000004 }, { "x": 2.070411549407202, "y": 1.9231099470865334, "yaw": 0.48000000000000004 }, { "x": 2.09702139709058, "y": 1.936963322352778, "yaw": 0.48000000000000004 }, { "x": 2.123631244773959, "y": 1.9508166976190224, "yaw": 0.48000000000000004 }, { "x": 2.150241092457337, "y": 1.9646700728852668, "yaw": 0.48000000000000004 }, { "x": 2.1759569169207253, "y": 1.9800848998526683, "yaw": 0.6000000000000002 }, { "x": 2.1996424665648346, "y": 1.9984673712948642, "yaw": 0.7199999999999999 }, { "x": 2.2209570785646813, "y": 2.019553097119761, "yaw": 0.8400000000000002 }, { "x": 2.239594190647216, "y": 2.043038807061974, "yaw": 0.96 }, { "x": 2.25679979022939, "y": 2.0676145541110036, "yaw": 0.96 }, { "x": 2.2740053898115633, "y": 2.092190301160034, "yaw": 0.96 }, { "x": 2.291210989393737, "y": 2.1167660482090636, "yaw": 0.96 }, { "x": 2.308416588975911, "y": 2.1413417952580938, "yaw": 0.96 }, { "x": 2.325622188558085, "y": 2.1659175423071235, "yaw": 0.96 }, { "x": 2.342827788140258, "y": 2.1904932893561537, "yaw": 0.96 }, { "x": 2.360033387722432, "y": 2.2150690364051835, "yaw": 0.96 }, { "x": 2.377238987304606, "y": 2.2396447834542137, "yaw": 0.96 }, { "x": 2.3944445868867796, "y": 2.2642205305032435, "yaw": 0.96 }, { "x": 2.411650186468953, "y": 2.2887962775522737, "yaw": 0.96 }, { "x": 2.428855786051127, "y": 2.3133720246013034, "yaw": 0.96 }, { "x": 2.4460613856333007, "y": 2.3379477716503336, "yaw": 0.96 }, { "x": 2.4632669852154745, "y": 2.3625235186993634, "yaw": 0.96 }, { "x": 2.480472584797648, "y": 2.3870992657483936, "yaw": 0.96 }, { "x": 2.4976781843798217, "y": 2.4116750127974234, "yaw": 0.96 }, { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 } ] }, "metrics": { "sample_count": 300, "goal_count": 2, "plan_count": 1, "planner_status_count": 3, "tracker_status_count": 7, "min_distance_to_goal": 0.01522123471265495, "min_distance_to_plan_end": 0.053217908913740765, "final_distance_to_goal": 0.0743196454165638, "final_distance_to_plan_end": 0.0828998414584936, "final_plan_end_to_goal": 0.06546367424138286, "final_plan_end_yaw_to_goal": 0.96, "max_abs_cmd_linear": 0.5982287432963077, "max_abs_cmd_angular": 1.44, "max_abs_ackermann_speed": 0.5982287526130676, "max_abs_steering_angle": 0.5195767879486084, "tf_failures": 0, "saw_plan_ok": true, "saw_plan_failed": false, "saw_goal_reached": true, "saw_align_goal_yaw": false, "saw_no_recent_odom": true }, "diagnostic_hints": [ "未发现明显配置矛盾;请把 JSON 报告发给我继续分析。" ], "events": { "goals": [ { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 } ], "plans": [ { "frame_id": "map", "points": 121, "length": 3.5995680777533363, "start": { "x": 0.0, "y": 0.0, "yaw": 0.0 }, "end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "reverse_segment_fraction": 0.0, "elapsed_sec": 13.258848952999983 } ], "planner_status": [ { "elapsed_sec": 13.152058692999958, "data": "goal_received map=(2.500,2.500,0.000)" }, { "elapsed_sec": 13.154557076999993, "data": "plan_start start=(0.000,0.000,0.000) goal=(2.500,2.500,0.000) obstacles=0 resolution=0.100 yaw_bins=36 timeout_ms=1500.000 grid_heuristic=true heuristic_weight=1.350 yaw_heuristic_weight=0.000 goal_yaw_tolerance=0.175" }, { "elapsed_sec": 13.260113290999982, "data": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "parsed_plan_ok": { "points": 121, "iterations": 45, "planning_ms": 64.58, "goal_error": 0.065, "yaw_error": 0.96 } } ], "tracker_status": [ { "elapsed_sec": 0.21198749499995984, "data": "stop no_recent_odom" }, { "elapsed_sec": 0.2307953179999913, "data": "stop no_recent_odom" }, { "elapsed_sec": 0.3380575279999789, "data": "stop no_recent_odom" }, { "elapsed_sec": 0.45431052300000374, "data": "stop no_recent_odom" }, { "elapsed_sec": 0.5689263449999657, "data": "stop no_recent_odom" }, { "elapsed_sec": 13.26937769899996, "data": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.920997634999992, "data": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" } ] }, "samples": [ { "elapsed_sec": 0.20754043599998795, "pose_map": null, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": null, "ackermann_cmd": null, "planner_status": "", "tracker_status": "" }, { "elapsed_sec": 0.2613436039999897, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051747411, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.3655291349999743, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006434316000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.46061683899995387, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051451951, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.5637750329999562, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05461713000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.6613507049999612, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052174036, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.7606858839999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051622784000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.8662860459999706, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.007149903000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 0.9632132570000067, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054163003, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.0669383700000026, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.007691155000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.1606391489999623, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051584450000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.2631660049999596, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054121668000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.360854508999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051759575, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.4606871880000085, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051576158000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.565866428999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05560409, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.6607052960000033, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051605909000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.7605874749999657, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051563533, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.8652947979999794, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006262816, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 1.9633861369999863, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054336169000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.060568678999971, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051599574, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.1648917480000023, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.005918731, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.265338052000004, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006253774, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.3606337109999913, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051538157, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.460646096000005, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051465782, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.5605908979999867, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051046988, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.6609462010000016, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051627240000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.7609601699999757, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051610866000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.860507469999959, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051449573000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 2.960506022000004, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.050888821, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.06192962099999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05278187, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.1654006009999875, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006349024, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.267408617000001, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.008265198000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.3610819749999905, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051883907, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.4649182480000036, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.005938189, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.560624405999988, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051629365, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.661903128000006, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052831244000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.7606811309999557, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051452406000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.8605827220000037, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05159099, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 3.963973034999981, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054721585, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.060585904999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051433196, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.160838660999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051328446, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.261503002999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052366366000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.366870613000003, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.007748738000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.460589177999964, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051554697000000003, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.560704850999969, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051640572, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.6607153150000045, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051577488000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.76191240899999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052237365, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.86061807599998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051423987000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 4.960672373999955, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051700614000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.060563129000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.030974367000000003, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.163462559999971, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054448998000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.265051235999977, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006040106, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.360770181999953, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.050698942000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.465401577999955, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006325107000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.5646747039999696, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.055575127, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.661978696999995, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051307486000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.760708070999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051630446, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.861991495999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05306078400000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 5.9606896610000035, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051663821000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.060593538999967, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051580112000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.1631922999999915, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054283246, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.260666332999961, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051351401000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.360772042999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051677153, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": null, "plan_end": null, "distance_to_goal": null, "yaw_error_to_goal": null, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.460626626999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05171282000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.560615711999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051616486, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.660806463999961, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051629236, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.7617944689999945, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052766115, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.860813632999964, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051753861000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 6.960687383999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051568444000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.0614801369999896, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052383155, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.161147343999971, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051932902, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.261152050999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052149028, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.36567464999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006567983, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.460813922999989, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051726819, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.560640003999993, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051521734000000007, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.660861545999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051757777000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.761228087999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052218737, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.864901642000007, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.005983231, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 7.960705875999963, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051673735000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.065095681999992, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.00616019, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.160853746999976, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05177215, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.267668393999998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.008289947, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.360602572999994, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051639442, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.460578443999964, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051600234, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.563140825999994, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054124743, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.661034022999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052012943000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.765021825999952, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006102814000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.860565430999998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051635817, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 8.964826652, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.005807647, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.060589215999983, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051634566, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.16313017799996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054204783000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.260634996999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051671650000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.360632782999971, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051672275000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.460746194999956, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05183140000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.561094023999999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.050990939000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.660694224999986, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051735232000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.760611219999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051644774000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.860591088999968, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051636107, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 9.960793459000001, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051735358, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.063299045999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054299284, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.160475235999968, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051531147000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.26069597899999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051692481000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.360731596999983, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051771482, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.460712838999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051693399, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.560986498999966, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051989941000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.661960077999993, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052987528000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.760655815999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051684565, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.865142282999955, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.0062028560000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 10.960589591999963, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051661731, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.06237725699998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05330257, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.165248673999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006232064000000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.260721647999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05162573, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.36594940699996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.055518119000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.46062204399999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.05160427200000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.561176703000001, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.052201024000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.662399698000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.053446903000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.763150523999968, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054180823, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.865533105999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.006446399, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 11.960579827999993, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051588355, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.063438494999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054350739, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.163878566999983, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054793115, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.260595084999977, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051571313, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.361048949999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051751521, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.460585726999966, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.050980227, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.563770809999994, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054727490000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.662896627999999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.053891488, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.760656732999962, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051594062, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.860822096999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051727312000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 12.96084104299996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.051357353, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 13.065945798999962, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.007015234, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 6.415299747999995, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 13.160427889000005, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.10149461600000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": null, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": null, "yaw_error_to_plan_end": null, "plan_end_to_goal": null, "plan_end_yaw_to_goal": null, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_start start=(0.000,0.000,0.000) goal=(2.500,2.500,0.000) obstacles=0 resolution=0.100 yaw_bins=36 timeout_ms=1500.000 grid_heuristic=true heuristic_weight=1.350 yaw_heuristic_weight=0.000 goal_yaw_tolerance=0.175", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 13.263934845999984, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.053816444000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": 3.5014223126734407, "yaw_error_to_plan_end": 0.96, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "stop no_recent_odom" }, { "elapsed_sec": 13.364156415999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0, "y": 0.0, "yaw": 0.0, "odom_age_sec": 0.054615156000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.5355339059327378, "yaw_error_to_goal": 0.0, "distance_to_plan_end": 3.5014223126734407, "yaw_error_to_plan_end": 0.96, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.41770202144070145, "angular_z": 1.269103902479544 }, "ackermann_cmd": { "speed": 0.4177020192146301, "steering_angle": 0.4098701477050781 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 13.465645239999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.0029021501541137695, "y": 5.960464477539063e-08, "yaw": -0.0005224664346314967, "odom_age_sec": 0.006535024, "odom_linear_x": 0.03200000151991844, "odom_angular_z": -0.00809332262724638 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.5334823296122098, "yaw_error_to_goal": 0.0005224664346314967, "distance_to_plan_end": 3.4993383950422428, "yaw_error_to_plan_end": 0.9605224664346315, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4172097167121666, "angular_z": 1.2710313718042276 }, "ackermann_cmd": { "speed": 0.4172097146511078, "steering_angle": 0.4108567535877228 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 13.56575589299996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.008826375007629395, "y": -4.649162292480469e-06, "yaw": -0.0013437306042760608, "odom_age_sec": 0.006608315, "odom_linear_x": 0.07800000160932541, "odom_angular_z": -0.007917552255094051 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.5293015280209064, "yaw_error_to_goal": 0.0013437306042760606, "distance_to_plan_end": 3.495091437273057, "yaw_error_to_plan_end": 0.961343730604276, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4140949564208463, "angular_z": 1.2830390153220865 }, "ackermann_cmd": { "speed": 0.4140949547290802, "steering_angle": 0.4170790910720825 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 13.660666235000008, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.014835834503173828, "y": -1.2561678886413574e-05, "yaw": -0.0014409568393602963, "odom_age_sec": 0.051617353000000005, "odom_linear_x": 0.11699999868869781, "odom_angular_z": -0.0019497144967317581 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.525067905448314, "yaw_error_to_goal": 0.001440956839360296, "distance_to_plan_end": 3.4907905582264513, "yaw_error_to_plan_end": 0.9614409568393603, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4086057926921842, "angular_z": 1.3034130298950384 }, "ackermann_cmd": { "speed": 0.40860578417778015, "steering_angle": 0.4279616177082062 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 13.760934722000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.034465491771698, "y": -2.3573637008666992e-05, "yaw": 0.0027346394490450625, "odom_age_sec": 0.051876604, "odom_linear_x": 0.20200000703334808, "odom_angular_z": 0.0528469979763031 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.511264484484946, "yaw_error_to_goal": 0.0027346394490450625, "distance_to_plan_end": 3.476766821663846, "yaw_error_to_plan_end": 0.9572653605509549, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.39333369088498965, "angular_z": 1.3548137024297529 }, "ackermann_cmd": { "speed": 0.39333370327949524, "steering_angle": 0.4576736390590668 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 13.86565322499996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.07126492261886597, "y": 0.00021491944789886475, "yaw": 0.01584420166909695, "odom_age_sec": 0.006510732, "odom_linear_x": 0.27399998903274536, "odom_angular_z": 0.11564509570598602 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.4853521378839782, "yaw_error_to_goal": 0.015844201669096954, "distance_to_plan_end": 3.450441095746772, "yaw_error_to_plan_end": 0.944155798330903, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.38802416954403635, "angular_z": 1.3708624262680458 }, "ackermann_cmd": { "speed": 0.3880241811275482, "steering_angle": 0.4678061604499817 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 13.96064202599996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.08643090724945068, "y": 0.0004505664110183716, "yaw": 0.022780412808060643, "odom_age_sec": 0.051654187000000004, "odom_linear_x": 0.2939999997615814, "odom_angular_z": 0.13847815990447998 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.474631366984951, "yaw_error_to_goal": 0.022780412808060643, "distance_to_plan_end": 3.439550255012062, "yaw_error_to_plan_end": 0.9372195871919393, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.388020191187421, "angular_z": 1.3708740990554977 }, "ackermann_cmd": { "speed": 0.38802018761634827, "steering_angle": 0.46781373023986816 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.06062355299997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.1244196891784668, "y": 0.001472964882850647, "yaw": 0.04130995273590088, "odom_age_sec": 0.051607602, "odom_linear_x": 0.3140000104904175, "odom_angular_z": 0.15656115114688873 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.44761064483422, "yaw_error_to_goal": 0.04130995273590088, "distance_to_plan_end": 3.4121051418877846, "yaw_error_to_plan_end": 0.9186900472640991, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.3666400169378977, "angular_z": 1.4259851357086115 }, "ackermann_cmd": { "speed": 0.36664003133773804, "steering_angle": 0.5075714588165283 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.161587789999999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.15578609704971313, "y": 0.0028547942638397217, "yaw": 0.057532060891389854, "odom_age_sec": 0.052658022000000006, "odom_linear_x": 0.3199999928474426, "odom_angular_z": 0.17494359612464905 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.4250654010276222, "yaw_error_to_goal": 0.057532060891389854, "distance_to_plan_end": 3.3892119765084954, "yaw_error_to_plan_end": 0.9024679391086101, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.3631043352762434, "angular_z": 1.4336307144890572 }, "ackermann_cmd": { "speed": 0.36310434341430664, "steering_angle": 0.5139842629432678 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.26470711799999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.20115947723388672, "y": 0.005826845765113831, "yaw": 0.08654529601335526, "odom_age_sec": 0.005713604000000001, "odom_linear_x": 0.3400000035762787, "odom_angular_z": 0.2327653169631958 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.3919857712581254, "yaw_error_to_goal": 0.08654529601335526, "distance_to_plan_end": 3.355634153134535, "yaw_error_to_plan_end": 0.8734547039866446, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.3648010759801176, "angular_z": 1.4300136758636501 }, "ackermann_cmd": { "speed": 0.3648010790348053, "steering_angle": 0.5109125971794128 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.360558835999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.21895569562911987, "y": 0.007340908050537109, "yaw": 0.09876080602407457, "odom_age_sec": 0.051525893, "odom_linear_x": 0.34599998593330383, "odom_angular_z": 0.24370720982551575 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.378833003742735, "yaw_error_to_goal": 0.09876080602407458, "distance_to_plan_end": 3.3422879670888794, "yaw_error_to_plan_end": 0.8612391939759254, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.463308495999968, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.2580069899559021, "y": 0.011370956897735596, "yaw": 0.12616874277591705, "odom_age_sec": 0.054272486, "odom_linear_x": 0.34599998593330383, "odom_angular_z": 0.2547230124473572 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.349598061149828, "yaw_error_to_goal": 0.12616874277591705, "distance_to_plan_end": 3.312632627091606, "yaw_error_to_plan_end": 0.8338312572240829, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.56028196899996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.2911885976791382, "y": 0.015680670738220215, "yaw": 0.149609699845314, "odom_age_sec": 0.051257475000000004, "odom_linear_x": 0.3529999852180481, "odom_angular_z": 0.25800660252571106 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.3242578631577833, "yaw_error_to_goal": 0.149609699845314, "distance_to_plan_end": 3.2869408022936755, "yaw_error_to_plan_end": 0.8103903001546859, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.660555994999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.3337675929069519, "y": 0.02229355275630951, "yaw": 0.17989850044250488, "odom_age_sec": 0.051424601, "odom_linear_x": 0.3529999852180481, "odom_angular_z": 0.25343358516693115 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.291138417060743, "yaw_error_to_goal": 0.17989850044250488, "distance_to_plan_end": 3.253376282655437, "yaw_error_to_plan_end": 0.7801014995574951, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.760701520999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.3661131262779236, "y": 0.028230085968971252, "yaw": 0.20267651975154877, "odom_age_sec": 0.051461684, "odom_linear_x": 0.3529999852180481, "odom_angular_z": 0.2576916217803955 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.2654432620629525, "yaw_error_to_goal": 0.20267651975154877, "distance_to_plan_end": 3.2273485874856163, "yaw_error_to_plan_end": 0.7573234802484512, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.860493836999979, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.39925384521484375, "y": 0.03511232137680054, "yaw": 0.227814719080925, "odom_age_sec": 0.051419059, "odom_linear_x": 0.34599998593330383, "odom_angular_z": 0.267153799533844 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.2386425667358054, "yaw_error_to_goal": 0.227814719080925, "distance_to_plan_end": 3.2002118427410022, "yaw_error_to_plan_end": 0.732185280919075, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 14.967484719999959, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.4561794400215149, "y": 0.04884582757949829, "yaw": 0.2707236707210541, "odom_age_sec": 0.007993946, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.2697732448577881 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.1914509644306306, "yaw_error_to_goal": 0.2707236707210541, "distance_to_plan_end": 3.1524539467487847, "yaw_error_to_plan_end": 0.6892763292789459, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.060571304000007, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.4697405695915222, "y": 0.05253647267818451, "yaw": 0.28110006451606756, "odom_age_sec": 0.051547017, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.27262625098228455 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.1799419919761274, "yaw_error_to_goal": 0.28110006451606756, "distance_to_plan_end": 3.1408127244609347, "yaw_error_to_plan_end": 0.6788999354839325, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.16317408599997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.5084423422813416, "y": 0.06379665434360504, "yaw": 0.3100312650203705, "odom_age_sec": 0.054148609, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.2611905336380005 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.1466472070134017, "yaw_error_to_goal": 0.3100312650203705, "distance_to_plan_end": 3.1071443065314592, "yaw_error_to_plan_end": 0.6499687349796296, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.260623640999995, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.5401666760444641, "y": 0.07395817339420319, "yaw": 0.3330110311508178, "odom_age_sec": 0.051492934000000004, "odom_linear_x": 0.34599998593330383, "odom_angular_z": 0.24658659100532532 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.118753854046099, "yaw_error_to_goal": 0.3330110311508178, "distance_to_plan_end": 3.078950132806545, "yaw_error_to_plan_end": 0.6269889688491821, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.361335624999981, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.5757319331169128, "y": 0.08626027405261993, "yaw": 0.3579910695552826, "odom_age_sec": 0.052362312, "odom_linear_x": 0.3529999852180481, "odom_angular_z": 0.24591195583343506 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.0868992626651273, "yaw_error_to_goal": 0.3579910695552826, "distance_to_plan_end": 3.046763066593372, "yaw_error_to_plan_end": 0.6020089304447174, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.460738395999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.6134784817695618, "y": 0.10039742290973663, "yaw": 0.3866892158985138, "odom_age_sec": 0.051653017, "odom_linear_x": 0.34599998593330383, "odom_angular_z": 0.26137837767601013 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.0523852913295055, "yaw_error_to_goal": 0.3866892158985138, "distance_to_plan_end": 3.011901880022637, "yaw_error_to_plan_end": 0.5733107841014862, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.560756835999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.645988404750824, "y": 0.11361159384250641, "yaw": 0.4136415421962738, "odom_age_sec": 0.051720559000000006, "odom_linear_x": 0.3659999966621399, "odom_angular_z": 0.2887091040611267 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.021954437174938, "yaw_error_to_goal": 0.4136415421962738, "distance_to_plan_end": 2.981178061420079, "yaw_error_to_plan_end": 0.5463584578037262, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.660842608999985, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.6563196778297424, "y": 0.11805863678455353, "yaw": 0.42281466722488403, "odom_age_sec": 0.051756684000000004, "odom_linear_x": 0.3529999852180481, "odom_angular_z": 0.29560455679893494 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 3.012109192601504, "yaw_error_to_goal": 0.42281466722488403, "distance_to_plan_end": 2.971241366168259, "yaw_error_to_plan_end": 0.5371853327751159, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.760621839999999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.6914047598838806, "y": 0.13382329046726227, "yaw": 0.45169538259506226, "odom_age_sec": 0.051575267, "odom_linear_x": 0.37299999594688416, "odom_angular_z": 0.2723615765571594 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.978222450272286, "yaw_error_to_goal": 0.45169538259506226, "distance_to_plan_end": 2.9370474975738374, "yaw_error_to_plan_end": 0.5083046174049377, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.860610946000008, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.7268155217170715, "y": 0.15095730125904083, "yaw": 0.47825828194618225, "odom_age_sec": 0.051615518000000006, "odom_linear_x": 0.37299999594688416, "odom_angular_z": 0.2549777925014496 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.943158982204616, "yaw_error_to_goal": 0.47825828194618225, "distance_to_plan_end": 2.9016812888927, "yaw_error_to_plan_end": 0.4817417180538177, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 15.961072887, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.7664962410926819, "y": 0.17150001227855682, "yaw": 0.5096983313560485, "odom_age_sec": 0.05169018500000001, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.26396000385284424 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.9029205078617917, "yaw_error_to_goal": 0.5096983313560485, "distance_to_plan_end": 2.861110789303683, "yaw_error_to_plan_end": 0.4503016686439515, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.060539407999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.7940623164176941, "y": 0.18679411709308624, "yaw": 0.5335943102836609, "odom_age_sec": 0.05151489200000001, "odom_linear_x": 0.3659999966621399, "odom_angular_z": 0.2881251573562622 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.874220735604925, "yaw_error_to_goal": 0.5335943102836609, "distance_to_plan_end": 2.8321867365674485, "yaw_error_to_plan_end": 0.426405689716339, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.16064030399997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.8267915844917297, "y": 0.20607541501522064, "yaw": 0.5639374852180481, "odom_age_sec": 0.051572849000000004, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.29111212491989136 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.8393161858668168, "yaw_error_to_goal": 0.5639374852180481, "distance_to_plan_end": 2.797022942809992, "yaw_error_to_plan_end": 0.39606251478195187, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.264895172999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.8552424311637878, "y": 0.22396133840084076, "yaw": 0.5887507796287537, "odom_age_sec": 0.055330904, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.2682291269302368 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.8081273919354333, "yaw_error_to_goal": 0.5887507796287537, "distance_to_plan_end": 2.765616369664822, "yaw_error_to_plan_end": 0.37124922037124636, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.360758137999994, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.8911387324333191, "y": 0.2477484494447708, "yaw": 0.6198727488517762, "odom_age_sec": 0.051676975, "odom_linear_x": 0.3400000035762787, "odom_angular_z": 0.26732367277145386 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.7678640908207, "yaw_error_to_goal": 0.6198727488517762, "distance_to_plan_end": 2.7250853849003276, "yaw_error_to_plan_end": 0.3401272511482238, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.465200048999975, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.9357171654701233, "y": 0.27980731427669525, "yaw": 0.6604108810424805, "odom_age_sec": 0.0061701460000000005, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.27386409044265747 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.7159227434049162, "yaw_error_to_goal": 0.6604108810424805, "distance_to_plan_end": 2.672829127142217, "yaw_error_to_plan_end": 0.2995891189575195, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.560652887000003, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.9446379542350769, "y": 0.28660209476947784, "yaw": 0.6688271760940551, "odom_age_sec": 0.051655767000000005, "odom_linear_x": 0.35899999737739563, "odom_angular_z": 0.2755070626735687 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.7052322229865795, "yaw_error_to_goal": 0.6688271760940551, "distance_to_plan_end": 2.662078388973924, "yaw_error_to_plan_end": 0.2911728239059449, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.660784408999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.9756497740745544, "y": 0.3110114187002182, "yaw": 0.6999471187591553, "odom_age_sec": 0.051676433, "odom_linear_x": 0.3330000042915344, "odom_angular_z": 0.2765727639198303 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.6674547082077678, "yaw_error_to_goal": 0.6999471187591553, "distance_to_plan_end": 2.6240967197018206, "yaw_error_to_plan_end": 0.2600528812408447, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.760840804999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 0.9980354905128479, "y": 0.32969139516353607, "yaw": 0.7254195809364319, "odom_age_sec": 0.051751725000000005, "odom_linear_x": 0.3070000112056732, "odom_angular_z": 0.30626481771469116 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.6393440147101286, "yaw_error_to_goal": 0.7254195809364319, "distance_to_plan_end": 2.5958468949984104, "yaw_error_to_plan_end": 0.23458041906356808, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.863540417999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.0240543484687805, "y": 0.3527119606733322, "yaw": 0.759259045124054, "odom_age_sec": 0.05433952500000001, "odom_linear_x": 0.3140000104904175, "odom_angular_z": 0.29755711555480957 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.6056211332634835, "yaw_error_to_goal": 0.759259045124054, "distance_to_plan_end": 2.5619731328397632, "yaw_error_to_plan_end": 0.200740954875946, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 16.960601636999968, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.0355046391487122, "y": 0.3633677214384079, "yaw": 0.7750175595283508, "odom_age_sec": 0.101576568, "odom_linear_x": 0.27399998903274536, "odom_angular_z": 0.28172969818115234 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.5903559901577706, "yaw_error_to_goal": 0.7750175595283508, "distance_to_plan_end": 2.5466461758611567, "yaw_error_to_plan_end": 0.18498244047164913, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.060627073999967, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.0531230568885803, "y": 0.38055382668972015, "yaw": 0.8078083992004395, "odom_age_sec": 0.051659141000000006, "odom_linear_x": 0.22200000286102295, "odom_angular_z": 0.31581610441207886 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.5662238737232252, "yaw_error_to_goal": 0.8078083992004395, "distance_to_plan_end": 2.5224262732940677, "yaw_error_to_plan_end": 0.1521916007995605, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.160724967999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.0689743161201477, "y": 0.39706872403621674, "yaw": 0.8379854559898376, "odom_age_sec": 0.051652848, "odom_linear_x": 0.20200000703334808, "odom_angular_z": 0.25977200269699097 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.543649830332482, "yaw_error_to_goal": 0.8379854559898376, "distance_to_plan_end": 2.4997835034990286, "yaw_error_to_plan_end": 0.12201454401016232, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.260688277999975, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.08051997423172, "y": 0.4097650498151779, "yaw": 0.8577760457992554, "odom_age_sec": 0.051684598000000005, "odom_linear_x": 0.1889999955892563, "odom_angular_z": 0.22299157083034515 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.5266589976744513, "yaw_error_to_goal": 0.8577760457992554, "distance_to_plan_end": 2.482749256696075, "yaw_error_to_plan_end": 0.1022239542007446, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.360961798000005, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.094429075717926, "y": 0.42572562396526337, "yaw": 0.8820515871047975, "odom_age_sec": 0.051776308, "odom_linear_x": 0.17599999904632568, "odom_angular_z": 0.2115623950958252 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.5056423947286373, "yaw_error_to_goal": 0.8820515871047975, "distance_to_plan_end": 2.4616870028870084, "yaw_error_to_plan_end": 0.07794841289520248, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.464875871999993, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1106906533241272, "y": 0.4454914778470993, "yaw": 0.912608802318573, "odom_age_sec": 0.0058418540000000005, "odom_linear_x": 0.16300000250339508, "odom_angular_z": 0.19711095094680786 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.4801584079166874, "yaw_error_to_goal": 0.912608802318573, "distance_to_plan_end": 2.436161092168817, "yaw_error_to_plan_end": 0.047391197681426966, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.560768209000003, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.11529141664505, "y": 0.4513261765241623, "yaw": 0.9206796884536742, "odom_age_sec": 0.051741516, "odom_linear_x": 0.17000000178813934, "odom_angular_z": 0.18789054453372955 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.472747924033499, "yaw_error_to_goal": 0.9206796884536742, "distance_to_plan_end": 2.4287413193111003, "yaw_error_to_plan_end": 0.03932031154632576, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.66058114399999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.125490963459015, "y": 0.4646044224500656, "yaw": 0.9397739171981812, "odom_age_sec": 0.051454598000000004, "odom_linear_x": 0.15000000596046448, "odom_angular_z": 0.17903894186019897 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.4560354738160153, "yaw_error_to_goal": 0.9397739171981812, "distance_to_plan_end": 2.4120119588082103, "yaw_error_to_plan_end": 0.020226082801818812, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.764900427999976, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1370546221733093, "y": 0.4804261177778244, "yaw": 0.9682815074920654, "odom_age_sec": 0.005886604, "odom_linear_x": 0.12999999523162842, "odom_angular_z": 0.19108769297599792 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.43645208627075, "yaw_error_to_goal": 0.9682815074920654, "distance_to_plan_end": 2.392417862664922, "yaw_error_to_plan_end": 0.008281507492065465, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.860635597999988, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1397865414619446, "y": 0.4843207448720932, "yaw": 0.9755420684814454, "odom_age_sec": 0.051645098, "odom_linear_x": 0.11699999868869781, "odom_angular_z": 0.18150562047958374 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.4316956043758955, "yaw_error_to_goal": 0.9755420684814454, "distance_to_plan_end": 2.3876606144276558, "yaw_error_to_plan_end": 0.015542068481445459, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 17.960677033999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1474234461784363, "y": 0.4954885095357895, "yaw": 0.9934077858924866, "odom_age_sec": 0.051734015, "odom_linear_x": 0.12399999797344208, "odom_angular_z": 0.16292813420295715 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.4181665884200094, "yaw_error_to_goal": 0.9934077858924866, "distance_to_plan_end": 2.3741326600765253, "yaw_error_to_plan_end": 0.03340778589248661, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.06479481599996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1592532992362976, "y": 0.5135721415281296, "yaw": 1.0142772197723386, "odom_age_sec": 0.0058413960000000004, "odom_linear_x": 0.12399999797344208, "odom_angular_z": 0.12185035645961761 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.3965594823667313, "yaw_error_to_goal": 1.0142772197723386, "distance_to_plan_end": 2.3525363079995363, "yaw_error_to_plan_end": 0.054277219772338674, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.160960235999994, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1616509556770325, "y": 0.5173513740301132, "yaw": 1.0193573236465454, "odom_age_sec": 0.051990140000000004, "odom_linear_x": 0.12399999797344208, "odom_angular_z": 0.14294734597206116 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.3920856461465756, "yaw_error_to_goal": 1.0193573236465454, "distance_to_plan_end": 2.348066000016705, "yaw_error_to_plan_end": 0.059357323646545446, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.260699959999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1688780188560486, "y": 0.5289883464574814, "yaw": 1.0368400812149048, "odom_age_sec": 0.051669223, "odom_linear_x": 0.11699999868869781, "odom_angular_z": 0.1483863741159439 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.3783970793551297, "yaw_error_to_goal": 1.0368400812149048, "distance_to_plan_end": 2.3343910197789857, "yaw_error_to_plan_end": 0.07684008121490482, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.36066114299996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.17335706949234, "y": 0.5364622920751572, "yaw": 1.0492802858352661, "odom_age_sec": 0.051684223, "odom_linear_x": 0.09099999815225601, "odom_angular_z": 0.14326778054237366 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.3696965619059114, "yaw_error_to_goal": 1.0492802858352661, "distance_to_plan_end": 2.3257020763443794, "yaw_error_to_plan_end": 0.08928028583526615, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.46038619999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.180614411830902, "y": 0.5489778965711594, "yaw": 1.0656049251556394, "odom_age_sec": 0.051465722000000005, "odom_linear_x": 0.12999999523162842, "odom_angular_z": 0.13494525849819183 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.3552633777002976, "yaw_error_to_goal": 1.0656049251556394, "distance_to_plan_end": 2.3112926292147495, "yaw_error_to_plan_end": 0.10560492515563946, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.563176517999977, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.185926377773285, "y": 0.5584497898817062, "yaw": 1.0759743452072146, "odom_age_sec": 0.054221189, "odom_linear_x": 0.12399999797344208, "odom_angular_z": 0.12024711072444916 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.344441661258055, "yaw_error_to_goal": 1.0759743452072146, "distance_to_plan_end": 2.3004921800050466, "yaw_error_to_plan_end": 0.11597434520721461, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.660562983999966, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.1919189095497131, "y": 0.5694172829389572, "yaw": 1.0880343914031982, "odom_age_sec": 0.051639181000000006, "odom_linear_x": 0.13699999451637268, "odom_angular_z": 0.1279154270887375 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.332000378775357, "yaw_error_to_goal": 1.0880343914031982, "distance_to_plan_end": 2.2880785146998863, "yaw_error_to_plan_end": 0.12803439140319828, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.764541805999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.2041987776756287, "y": 0.5927972048521042, "yaw": 1.1084206104278567, "odom_age_sec": 0.005620894, "odom_linear_x": 0.15700000524520874, "odom_angular_z": 0.11319202184677124 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.305758727533582, "yaw_error_to_goal": 1.1084206104278567, "distance_to_plan_end": 2.2619054346115353, "yaw_error_to_plan_end": 0.1484206104278567, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.86047439099997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.206378996372223, "y": 0.5970865339040756, "yaw": 1.112039804458618, "odom_age_sec": 0.051493222000000005, "odom_linear_x": 0.16300000250339508, "odom_angular_z": 0.1243237555027008 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.3009856497762304, "yaw_error_to_goal": 1.112039804458618, "distance_to_plan_end": 2.2571463907180638, "yaw_error_to_plan_end": 0.15203980445861798, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 18.960596157999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.21530681848526, "y": 0.6149766892194748, "yaw": 1.1272013187408447, "odom_age_sec": 0.051610264, "odom_linear_x": 0.17000000178813934, "odom_angular_z": 0.135010227560997 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.2811728239693805, "yaw_error_to_goal": 1.1272013187408447, "distance_to_plan_end": 2.237395702493389, "yaw_error_to_plan_end": 0.16720131874084476, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.06064967399999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.2224363684654236, "y": 0.6298038810491562, "yaw": 1.140474557876587, "odom_age_sec": 0.051658555, "odom_linear_x": 0.18299999833106995, "odom_angular_z": 0.1552700698375702 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.264906699172973, "yaw_error_to_goal": 1.140474557876587, "distance_to_plan_end": 2.221186765614334, "yaw_error_to_plan_end": 0.18047455787658692, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.16086514699998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.232429563999176, "y": 0.6514379233121872, "yaw": 1.1597915887832642, "odom_age_sec": 0.051682721, "odom_linear_x": 0.20900000631809235, "odom_angular_z": 0.1652493178844452 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.24140950332412, "yaw_error_to_goal": 1.1597915887832642, "distance_to_plan_end": 2.1977819927731543, "yaw_error_to_plan_end": 0.1997915887832642, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": 0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.26087374499997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.240169107913971, "y": 0.6690224856138229, "yaw": 1.1739543676376343, "odom_age_sec": 0.051706680000000005, "odom_linear_x": 0.23499999940395355, "odom_angular_z": 0.1736164540052414 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.2225329097320614, "yaw_error_to_goal": 1.1739543676376343, "distance_to_plan_end": 2.1789890496694704, "yaw_error_to_plan_end": 0.2139543676376343, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.360676800999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.2496894001960754, "y": 0.6915913671255112, "yaw": 1.192771315574646, "odom_age_sec": 0.051630638000000006, "odom_linear_x": 0.23499999940395355, "odom_angular_z": 0.18315108120441437 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.1985491532911032, "yaw_error_to_goal": 1.192771315574646, "distance_to_plan_end": 2.155122554594572, "yaw_error_to_plan_end": 0.23277131557464603, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.461218400000007, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.260081708431244, "y": 0.7176601737737656, "yaw": 1.2147414684295652, "odom_age_sec": 0.052235057, "odom_linear_x": 0.24799999594688416, "odom_angular_z": 0.20001211762428284 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.1712053394183948, "yaw_error_to_goal": 1.2147414684295652, "distance_to_plan_end": 2.1279290052287805, "yaw_error_to_plan_end": 0.25474146842956524, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.565552387999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.2685701251029968, "y": 0.7403455823659897, "yaw": 1.2336254119873047, "odom_age_sec": 0.056043403000000006, "odom_linear_x": 0.24199999868869781, "odom_angular_z": 0.19158776104450226 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.1477437478171684, "yaw_error_to_goal": 1.2336254119873047, "distance_to_plan_end": 2.104612103752981, "yaw_error_to_plan_end": 0.2736254119873047, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.660820926999975, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.2753705382347107, "y": 0.7595994919538498, "yaw": 1.2504227161407473, "odom_age_sec": 0.051753805, "odom_linear_x": 0.24199999868869781, "odom_angular_z": 0.2165418565273285 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.128076889360636, "yaw_error_to_goal": 1.2504227161407473, "distance_to_plan_end": 2.08507855018924, "yaw_error_to_plan_end": 0.29042271614074733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": 1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.760611358000006, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.2847691178321838, "y": 0.7880252450704575, "yaw": 1.2759305238723755, "odom_age_sec": 0.051637471000000004, "odom_linear_x": 0.2680000066757202, "odom_angular_z": 0.2150382399559021 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.099438891344646, "yaw_error_to_goal": 1.2759305238723755, "distance_to_plan_end": 2.0566549149982007, "yaw_error_to_plan_end": 0.3159305238723755, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.37324406882365685, "angular_z": 1.4105884397025903 }, "ackermann_cmd": { "speed": 0.3732440769672394, "steering_angle": 0.49546995759010315 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.86087778999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.29208642244339, "y": 0.8120332211256027, "yaw": 1.2941217422485352, "odom_age_sec": 0.051807264000000006, "odom_linear_x": 0.28700000047683716, "odom_angular_z": 0.20473459362983704 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.075641360502632, "yaw_error_to_goal": 1.2941217422485352, "distance_to_plan_end": 2.0330558281624445, "yaw_error_to_plan_end": 0.33412174224853525, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.3798846350723126, "angular_z": 1.3936407513227238 }, "ackermann_cmd": { "speed": 0.37988463044166565, "steering_angle": 0.48313987255096436 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 19.962785601999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3003637194633484, "y": 0.8412106484174728, "yaw": 1.3154805898666382, "odom_age_sec": 0.053724061000000004, "odom_linear_x": 0.2939999997615814, "odom_angular_z": 0.20810192823410034 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.0471222040961288, "yaw_error_to_goal": 1.3154805898666382, "distance_to_plan_end": 2.0047972326739614, "yaw_error_to_plan_end": 0.3554805898666382, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.401522130767111, "angular_z": 1.3282209494084265 }, "ackermann_cmd": { "speed": 0.40152212977409363, "steering_angle": 0.4418470561504364 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.06066360799997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3091785311698914, "y": 0.8751523941755295, "yaw": 1.3389267921447754, "odom_age_sec": 0.051746887000000005, "odom_linear_x": 0.3199999928474426, "odom_angular_z": 0.21293774247169495 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 2.0144938601991846, "yaw_error_to_goal": 1.3389267921447754, "distance_to_plan_end": 1.9724992430697919, "yaw_error_to_plan_end": 0.3789267921447754, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4240057349314766, "angular_z": 1.2437096284017393 }, "ackermann_cmd": { "speed": 0.42400574684143066, "steering_angle": 0.39716291427612305 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.160549119999985, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.315703570842743, "y": 0.9027948826551437, "yaw": 1.3574061393737793, "odom_age_sec": 0.051640345000000004, "odom_linear_x": 0.3269999921321869, "odom_angular_z": 0.21062874794006348 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.9883717507013687, "yaw_error_to_goal": 1.3574061393737793, "distance_to_plan_end": 1.9466689782367483, "yaw_error_to_plan_end": 0.3974061393737794, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4320908613701107, "angular_z": 1.209200072375036 }, "ackermann_cmd": { "speed": 0.4320908486843109, "steering_angle": 0.38066449761390686 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.260631757999988, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3227105736732483, "y": 0.9351155012845993, "yaw": 1.3754521608352661, "odom_age_sec": 0.051645303000000004, "odom_linear_x": 0.3400000035762787, "odom_angular_z": 0.18262062966823578 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.9582834033051812, "yaw_error_to_goal": 1.3754521608352661, "distance_to_plan_end": 1.9169465375507326, "yaw_error_to_plan_end": 0.41545216083526615, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.45649260981720835, "angular_z": 1.091834384543316 }, "ackermann_cmd": { "speed": 0.4564926028251648, "steering_angle": 0.32955339550971985 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.360868896, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3313140273094177, "y": 0.9789699763059616, "yaw": 1.3970178365707397, "odom_age_sec": 0.051906930000000004, "odom_linear_x": 0.3659999966621399, "odom_angular_z": 0.1761186569929123 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.9181655913248, "yaw_error_to_goal": 1.3970178365707397, "distance_to_plan_end": 1.8773664136068464, "yaw_error_to_plan_end": 0.4370178365707398, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4780607823358679, "angular_z": 0.9715726298989779 }, "ackermann_cmd": { "speed": 0.478060781955719, "steering_angle": 0.2828308939933777 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.460723907999977, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3375579714775085, "y": 1.0145868510007858, "yaw": 1.4121330976486206, "odom_age_sec": 0.051594761, "odom_linear_x": 0.3919999897480011, "odom_angular_z": 0.16118067502975464 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.8861929097775887, "yaw_error_to_goal": 1.4121330976486206, "distance_to_plan_end": 1.845866825764145, "yaw_error_to_plan_end": 0.45213309764862064, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5063355608491974, "angular_z": 0.7904272721507857 }, "ackermann_cmd": { "speed": 0.5063355565071106, "steering_angle": 0.21963250637054443 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.560855629000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3452233672142029, "y": 1.06293885409832, "yaw": 1.430782437324524, "odom_age_sec": 0.051742262000000004, "odom_linear_x": 0.41200000047683716, "odom_angular_z": 0.15931999683380127 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.8435438179463903, "yaw_error_to_goal": 1.430782437324524, "distance_to_plan_end": 1.8039099425903142, "yaw_error_to_plan_end": 0.470782437324524, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5291081166815602, "angular_z": 0.6251578478438089 }, "ackermann_cmd": { "speed": 0.5291081070899963, "steering_angle": 0.16737821698188782 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.660839515999953, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3493607640266418, "y": 1.0923282355070114, "yaw": 1.4415191411972046, "odom_age_sec": 0.051679762000000004, "odom_linear_x": 0.4309999942779541, "odom_angular_z": 0.14914357662200928 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.8181062806976267, "yaw_error_to_goal": 1.4415191411972046, "distance_to_plan_end": 1.778924298958819, "yaw_error_to_plan_end": 0.4815191411972046, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5369915844130462, "angular_z": 0.5639164819565666 }, "ackermann_cmd": { "speed": 0.5369915962219238, "steering_angle": 0.14905625581741333 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.76061502699997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3560370802879333, "y": 1.1443185061216354, "yaw": 1.4565544128417969, "odom_age_sec": 0.051656345000000006, "odom_linear_x": 0.45100000500679016, "odom_angular_z": 0.12233174592256546 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.773844264449512, "yaw_error_to_goal": 1.4565544128417969, "distance_to_plan_end": 1.735515667123385, "yaw_error_to_plan_end": 0.4965544128417969, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5832931746800586, "angular_z": 0.16241628632823002 }, "ackermann_cmd": { "speed": 0.5832931995391846, "steering_angle": 0.03979691118001938 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.860685622999995, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3609874844551086, "y": 1.187401458621025, "yaw": 1.4642906188964844, "odom_age_sec": 0.051773304000000006, "odom_linear_x": 0.46399998664855957, "odom_angular_z": 0.0758041962981224 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.7378908024954025, "yaw_error_to_goal": 1.4642906188964844, "distance_to_plan_end": 1.7003238653818067, "yaw_error_to_plan_end": 0.5042906188964844, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5803784811970115, "angular_z": -0.18979845469428433 }, "ackermann_cmd": { "speed": 0.5803784728050232, "steering_angle": -0.04673057422041893 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 20.961141761999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.365581452846527, "y": 1.2300327271223068, "yaw": 1.469665288925171, "odom_age_sec": 0.052203222, "odom_linear_x": 0.49000000953674316, "odom_angular_z": 0.05545200780034065 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.7028571033137812, "yaw_error_to_goal": 1.469665288925171, "distance_to_plan_end": 1.6660905710003764, "yaw_error_to_plan_end": 0.5096652889251709, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5266090324295798, "angular_z": -0.6441391070221602 }, "ackermann_cmd": { "speed": 0.5266090035438538, "steering_angle": -0.17316332459449768 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.06061743800001, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.368302047252655, "y": 1.2563217133283615, "yaw": 1.4723708629608152, "odom_age_sec": 0.10163264200000001, "odom_linear_x": 0.49000000953674316, "odom_angular_z": 0.05067293345928192 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.6815100169166504, "yaw_error_to_goal": 1.4723708629608152, "distance_to_plan_end": 1.6452605367456248, "yaw_error_to_plan_end": 0.5123708629608152, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.49490238302495787, "angular_z": -0.8668843515198765 }, "ackermann_cmd": { "speed": 0.4949023723602295, "steering_angle": -0.24543286859989166 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.161190574999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3728660941123962, "y": 1.301939770579338, "yaw": 1.4732966423034668, "odom_age_sec": 0.052027054, "odom_linear_x": 0.5170000195503235, "odom_angular_z": -0.0018954910337924957 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.6449252734154627, "yaw_error_to_goal": 1.4732966423034668, "distance_to_plan_end": 1.6096166699874719, "yaw_error_to_plan_end": 0.5132966423034668, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.48586631372594646, "angular_z": -0.9242285570321335 }, "ackermann_cmd": { "speed": 0.4858663082122803, "steering_angle": -0.2655923366546631 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.263232133999963, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3789957165718079, "y": 1.362777754664421, "yaw": 1.467929005622864, "odom_age_sec": 0.054277353, "odom_linear_x": 0.5230000019073486, "odom_angular_z": -0.059336692094802856 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.596848470816956, "yaw_error_to_goal": 1.467929005622864, "distance_to_plan_end": 1.5628774726426764, "yaw_error_to_plan_end": 0.507929005622864, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.44859836408385717, "angular_z": -1.1319754365266903 }, "ackermann_cmd": { "speed": 0.44859835505485535, "steering_angle": -0.34629949927330017 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.360578800999974, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3834245800971985, "y": 1.404256984591484, "yaw": 1.4608438014984133, "odom_age_sec": 0.051704469, "odom_linear_x": 0.503000020980835, "odom_angular_z": -0.0972382053732872 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.5644147225552643, "yaw_error_to_goal": 1.4608438014984133, "distance_to_plan_end": 1.5314082023338405, "yaw_error_to_plan_end": 0.5008438014984133, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.42813456970159597, "angular_z": -1.2263588674564467 }, "ackermann_cmd": { "speed": 0.428134560585022, "steering_angle": -0.3887655436992645 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.460643061999974, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3895382285118103, "y": 1.4574177712202072, "yaw": 1.4479403495788574, "odom_age_sec": 0.051709969, "odom_linear_x": 0.5099999904632568, "odom_angular_z": -0.15811723470687866 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.5231884485197913, "yaw_error_to_goal": 1.4479403495788574, "distance_to_plan_end": 1.4914813571729535, "yaw_error_to_plan_end": 0.48794034957885746, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.39686186342808316, "angular_z": -1.343629656887323 }, "ackermann_cmd": { "speed": 0.39686185121536255, "steering_angle": -0.450884073972702 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.561563949999993, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.3973531126976013, "y": 1.516712710261345, "yaw": 1.4238325357437134, "odom_age_sec": 0.051934304, "odom_linear_x": 0.4970000088214874, "odom_angular_z": -0.21511849761009216 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.4773909612012857, "yaw_error_to_goal": 1.4238325357437134, "distance_to_plan_end": 1.4472128474593615, "yaw_error_to_plan_end": 0.46383253574371336, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.39185699705727867, "angular_z": -1.3593715348603184 }, "ackermann_cmd": { "speed": 0.39185699820518494, "steering_angle": -0.4605019986629486 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.661139916999957, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.4034313559532166, "y": 1.555783435702324, "yaw": 1.403544306755066, "odom_age_sec": 0.051809095000000006, "odom_linear_x": 0.48399999737739563, "odom_angular_z": -0.25763624906539917 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.4470686616054915, "yaw_error_to_goal": 1.403544306755066, "distance_to_plan_end": 1.4179383655900328, "yaw_error_to_plan_end": 0.44354430675506595, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.3686663211406968, "angular_z": -1.421415605683378 }, "ackermann_cmd": { "speed": 0.36866632103919983, "steering_angle": -0.5038754343986511 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.763329517999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.406432330608368, "y": 1.5732135027647018, "yaw": 1.3926727771759033, "odom_age_sec": 0.054350853000000005, "odom_linear_x": 0.47699999809265137, "odom_angular_z": -0.29629796743392944 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.4334655416145583, "yaw_error_to_goal": 1.3926727771759033, "distance_to_plan_end": 1.4048124186356565, "yaw_error_to_plan_end": 0.43267277717590336, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.860597601999984, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.4151628613471985, "y": 1.6189964264631271, "yaw": 1.3596552610397339, "odom_age_sec": 0.051597469, "odom_linear_x": 0.45100000500679016, "odom_angular_z": -0.3423656225204468 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.397511686529003, "yaw_error_to_goal": 1.3596552610397339, "distance_to_plan_end": 1.3701426031879185, "yaw_error_to_plan_end": 0.3996552610397339, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.361867596124576, "angular_z": -1.4362066758294392 }, "ackermann_cmd": { "speed": 0.36186760663986206, "steering_angle": -0.5162165760993958 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 21.965278210999998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.431914746761322, "y": 1.6889604777097702, "yaw": 1.298847675323486, "odom_age_sec": 0.0061936050000000005, "odom_linear_x": 0.4180000126361847, "odom_angular_z": -0.3788149356842041 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.341115660523989, "yaw_error_to_goal": 1.298847675323486, "distance_to_plan_end": 1.3157753232643017, "yaw_error_to_plan_end": 0.33884767532348614, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36177550246701956, "angular_z": -1.4363964549157875 }, "ackermann_cmd": { "speed": 0.3617754876613617, "steering_angle": -0.5163825750350952 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.061357998999995, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.4358118176460266, "y": 1.7026643007993698, "yaw": 1.2853057384490967, "odom_age_sec": 0.052259553, "odom_linear_x": 0.4050000011920929, "odom_angular_z": -0.3893612027168274 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.3297521215179962, "yaw_error_to_goal": 1.2853057384490967, "distance_to_plan_end": 1.3048162328030144, "yaw_error_to_plan_end": 0.3253057384490967, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.160564711999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.4502316117286682, "y": 1.7488749474287033, "yaw": 1.2387650012969968, "odom_age_sec": 0.051639593000000004, "odom_linear_x": 0.4050000011920929, "odom_angular_z": -0.39948561787605286 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.2908146705139445, "yaw_error_to_goal": 1.2387650012969968, "distance_to_plan_end": 1.2672686200400074, "yaw_error_to_plan_end": 0.2787650012969969, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.260760678999986, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.462099015712738, "y": 1.7817585915327072, "yaw": 1.2025196552276611, "odom_age_sec": 0.051729301000000005, "odom_linear_x": 0.3659999966621399, "odom_angular_z": -0.3957127332687378 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.2621842868700068, "yaw_error_to_goal": 1.2025196552276611, "distance_to_plan_end": 1.239643403016235, "yaw_error_to_plan_end": 0.24251965522766117, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.362169691999952, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.477371633052826, "y": 1.8194866627454758, "yaw": 1.1637163162231445, "odom_age_sec": 0.053173723000000006, "odom_linear_x": 0.37299999594688416, "odom_angular_z": -0.3617422580718994 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.2283595479607483, "yaw_error_to_goal": 1.1637163162231445, "distance_to_plan_end": 1.2069918867817446, "yaw_error_to_plan_end": 0.20371631622314457, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.460829986999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.4938411116600037, "y": 1.8559775799512863, "yaw": 1.1257383823394773, "odom_age_sec": 0.051654384000000005, "odom_linear_x": 0.37299999594688416, "odom_angular_z": -0.3546285629272461 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.1946215242121578, "yaw_error_to_goal": 1.1257383823394773, "distance_to_plan_end": 1.1744126625540283, "yaw_error_to_plan_end": 0.16573838233947735, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.564766799999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.5097946524620056, "y": 1.8880644291639328, "yaw": 1.091026782989502, "odom_age_sec": 0.005873353, "odom_linear_x": 0.35899999737739563, "odom_angular_z": -0.35611748695373535 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.1640325481477327, "yaw_error_to_goal": 1.091026782989502, "distance_to_plan_end": 1.1448634920402387, "yaw_error_to_plan_end": 0.131026782989502, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.661135462999994, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.5185031294822693, "y": 1.904476210474968, "yaw": 1.0730645656585693, "odom_age_sec": 0.052202053000000005, "odom_linear_x": 0.3659999966621399, "odom_angular_z": -0.35890376567840576 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.1480351435066585, "yaw_error_to_goal": 1.0730645656585693, "distance_to_plan_end": 1.1294062953519846, "yaw_error_to_plan_end": 0.11306456565856937, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.76080142799998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.5366303324699402, "y": 1.936522290110588, "yaw": 1.037030816078186, "odom_age_sec": 0.051814593000000006, "odom_linear_x": 0.3529999852180481, "odom_angular_z": -0.3544379472732544 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.1160592483641691, "yaw_error_to_goal": 1.037030816078186, "distance_to_plan_end": 1.0985027805247782, "yaw_error_to_plan_end": 0.07703081607818606, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.861535395999965, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.5576724410057068, "y": 1.970718190073967, "yaw": 0.9989111423492432, "odom_age_sec": 0.052640555000000006, "odom_linear_x": 0.35899999737739563, "odom_angular_z": -0.3489722013473511 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.0807962170357188, "yaw_error_to_goal": 0.9989111423492432, "distance_to_plan_end": 1.064412574429275, "yaw_error_to_plan_end": 0.0389111423492432, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 22.96085902699997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.5787140727043152, "y": 2.0021574944257736, "yaw": 0.9637851715087891, "odom_age_sec": 0.051914594, "odom_linear_x": 0.3659999966621399, "odom_angular_z": -0.3378816246986389 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.0471938312411382, "yaw_error_to_goal": 0.9637851715087891, "distance_to_plan_end": 1.0319160292193728, "yaw_error_to_plan_end": 0.0037851715087890985, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.062148455, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.599545419216156, "y": 2.031102702021599, "yaw": 0.9307003617286682, "odom_age_sec": 0.053230223, "odom_linear_x": 0.34599998593330383, "odom_angular_z": -0.3282617926597595 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 1.015225653786415, "yaw_error_to_goal": 0.9307003617286682, "distance_to_plan_end": 1.000994141209048, "yaw_error_to_plan_end": 0.029299638271331748, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.164408218999995, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.6345950961112976, "y": 2.075633093714714, "yaw": 0.8780158162117004, "odom_age_sec": 0.005537394, "odom_linear_x": 0.35899999737739563, "odom_angular_z": -0.34114837646484375 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.9638531624810694, "yaw_error_to_goal": 0.8780158162117004, "distance_to_plan_end": 0.9512903211345137, "yaw_error_to_plan_end": 0.08198418378829953, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.260630211999967, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.642087161540985, "y": 2.0844841450452805, "yaw": 0.8674592375755311, "odom_age_sec": 0.0516903, "odom_linear_x": 0.35899999737739563, "odom_angular_z": -0.33276355266571045 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.9532407167717687, "yaw_error_to_goal": 0.8674592375755311, "distance_to_plan_end": 0.9410173725273092, "yaw_error_to_plan_end": 0.09254076242446885, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.360587217999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.6695069670677185, "y": 2.1156003922224045, "yaw": 0.8306598663330078, "odom_age_sec": 0.051651259000000005, "odom_linear_x": 0.3529999852180481, "odom_angular_z": -0.3159748613834381 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.9151402822565669, "yaw_error_to_goal": 0.8306598663330078, "distance_to_plan_end": 0.9041452431991985, "yaw_error_to_plan_end": 0.12934013366699215, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.461146100000008, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.6909930109977722, "y": 2.1383450478315353, "yaw": 0.8018266558647155, "odom_age_sec": 0.051937968, "odom_linear_x": 0.34599998593330383, "odom_angular_z": -0.3218887448310852 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.8861639874664424, "yaw_error_to_goal": 0.8018266558647155, "distance_to_plan_end": 0.8760957818792993, "yaw_error_to_plan_end": 0.1581733441352845, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.560625395999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.7219552397727966, "y": 2.169103667140007, "yaw": 0.7613808512687683, "odom_age_sec": 0.051697758, "odom_linear_x": 0.35899999737739563, "odom_angular_z": -0.3454395532608032 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.8454856781857382, "yaw_error_to_goal": 0.7613808512687683, "distance_to_plan_end": 0.836721725146126, "yaw_error_to_plan_end": 0.19861914873123165, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.66313603499998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.74508398771286, "y": 2.1904180496931076, "yaw": 0.7315014004707335, "odom_age_sec": 0.054212225, "odom_linear_x": 0.3659999966621399, "odom_angular_z": -0.352127343416214 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.8159284095821988, "yaw_error_to_goal": 0.7315014004707335, "distance_to_plan_end": 0.8080998995709314, "yaw_error_to_plan_end": 0.22849859952926643, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.763158165999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.7718507647514343, "y": 2.213638588786125, "yaw": 0.6990471482276917, "odom_age_sec": 0.05425201700000001, "odom_linear_x": 0.37299999594688416, "odom_angular_z": -0.34304606914520264 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.7824347682877295, "yaw_error_to_goal": 0.6990471482276917, "distance_to_plan_end": 0.7756637456664809, "yaw_error_to_plan_end": 0.2609528517723083, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.864847344999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.8207337260246277, "y": 2.2523265331983566, "yaw": 0.6411789655685424, "odom_age_sec": 0.0057793950000000005, "odom_linear_x": 0.35899999737739563, "odom_angular_z": -0.3231629729270935 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.72301093844971, "yaw_error_to_goal": 0.6411789655685424, "distance_to_plan_end": 0.7181033519505056, "yaw_error_to_plan_end": 0.3188210344314576, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": -0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 23.960780669999963, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.8284520506858826, "y": 2.25797538459301, "yaw": 0.6325360536575317, "odom_age_sec": 0.051788801, "odom_linear_x": 0.3330000042915344, "odom_angular_z": -0.30779770016670227 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.7138295053378628, "yaw_error_to_goal": 0.6325360536575317, "distance_to_plan_end": 0.709204225784227, "yaw_error_to_plan_end": 0.3274639463424682, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": -0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.060756674999993, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.8577503561973572, "y": 2.2786720246076584, "yaw": 0.5930582284927368, "odom_age_sec": 0.051787634000000006, "odom_linear_x": 0.27399998903274536, "odom_angular_z": -0.36745837330818176 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.6793163310681516, "yaw_error_to_goal": 0.5930582284927368, "distance_to_plan_end": 0.6757628279841689, "yaw_error_to_plan_end": 0.36694177150726315, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": -0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.161236471999985, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.8577503561973572, "y": 2.2786720246076584, "yaw": 0.5930582284927368, "odom_age_sec": 0.15194993, "odom_linear_x": 0.27399998903274536, "odom_angular_z": -0.36745837330818176 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.6793163310681516, "yaw_error_to_goal": 0.5930582284927368, "distance_to_plan_end": 0.6757628279841689, "yaw_error_to_plan_end": 0.36694177150726315, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": -0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.260618432, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.8813742995262146, "y": 2.2938862293958664, "yaw": 0.5434083342552185, "odom_age_sec": 0.051753549, "odom_linear_x": 0.2290000021457672, "odom_angular_z": -0.4145784378051758 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.6520587732093903, "yaw_error_to_goal": 0.5434083342552185, "distance_to_plan_end": 0.649308806655589, "yaw_error_to_plan_end": 0.41659166574478146, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": -0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.360605185999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.9011349081993103, "y": 2.3053873032331467, "yaw": 0.5119560956954957, "odom_age_sec": 0.051740049, "odom_linear_x": 0.24199999868869781, "odom_angular_z": -0.3188055455684662 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.6296931791915137, "yaw_error_to_goal": 0.5119560956954957, "distance_to_plan_end": 0.6275451591533018, "yaw_error_to_plan_end": 0.44804390430450425, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.46166981799996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.9258520007133484, "y": 2.3187656849622726, "yaw": 0.4819891452789306, "odom_age_sec": 0.052849303, "odom_linear_x": 0.2680000066757202, "odom_angular_z": -0.2791050672531128 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.6020729208593084, "yaw_error_to_goal": 0.4819891452789306, "distance_to_plan_end": 0.600633985466709, "yaw_error_to_plan_end": 0.47801085472106936, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.36, "angular_z": -1.44 }, "ackermann_cmd": { "speed": 0.36000001430511475, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.560631109999974, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.9486071467399597, "y": 2.3302541226148605, "yaw": 0.4522743225097656, "odom_age_sec": 0.051757591000000006, "odom_linear_x": 0.22200000286102295, "odom_angular_z": -0.28284555673599243 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.5769295810716409, "yaw_error_to_goal": 0.4522743225097656, "distance_to_plan_end": 0.5761115490665876, "yaw_error_to_plan_end": 0.5077256774902343, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": -0.15, "angular_z": -0.6 }, "ackermann_cmd": { "speed": -0.15000000596046448, "steering_angle": 0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.660678779999955, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.958246648311615, "y": 2.334802195429802, "yaw": 0.42650270462036133, "odom_age_sec": 0.051758674000000005, "odom_linear_x": 0.09799999743700027, "odom_angular_z": -0.33078718185424805 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.5663806217557344, "yaw_error_to_goal": 0.42650270462036133, "distance_to_plan_end": 0.5658062495300487, "yaw_error_to_plan_end": 0.5334972953796386, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.37129011268889883, "angular_z": -1.4152953305467353 }, "ackermann_cmd": { "speed": 0.3712901175022125, "steering_angle": -0.49906718730926514 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.76065053399998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.9665047526359558, "y": 2.3383570164442062, "yaw": 0.3935161530971527, "odom_age_sec": 0.051736841000000006, "odom_linear_x": 0.11100000143051147, "odom_angular_z": -0.24752366542816162 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.5574456324098712, "yaw_error_to_goal": 0.3935161530971527, "distance_to_plan_end": 0.5570482447646619, "yaw_error_to_plan_end": 0.5664838469028473, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.39717051714272467, "angular_z": -1.3426315099702573 }, "ackermann_cmd": { "speed": 0.3971705138683319, "steering_angle": -0.45028796792030334 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.86058362099999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 1.9814438223838806, "y": 2.3443677872419357, "yaw": 0.37760382890701294, "odom_age_sec": 0.051487548, "odom_linear_x": 0.19599999487400055, "odom_angular_z": -0.16656284034252167 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.5414073281659676, "yaw_error_to_goal": 0.37760382890701294, "distance_to_plan_end": 0.5412953660092642, "yaw_error_to_plan_end": 0.582396171092987, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.42506910579647467, "angular_z": -1.2392953129211706 }, "ackermann_cmd": { "speed": 0.42506909370422363, "steering_angle": -0.3950057923793793 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 24.965106182, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.01772278547287, "y": 2.3581166714429855, "yaw": 0.3522259294986725, "odom_age_sec": 0.006145188, "odom_linear_x": 0.2809999883174896, "odom_angular_z": -0.17885881662368774 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.5027148203250678, "yaw_error_to_goal": 0.3522259294986725, "distance_to_plan_end": 0.5032633447702558, "yaw_error_to_plan_end": 0.6077740705013275, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4551905602008402, "angular_z": -1.0985981670758231 }, "ackermann_cmd": { "speed": 0.4551905691623688, "steering_angle": -0.3323289752006531 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.060861004000003, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.03254097700119, "y": 2.3634574860334396, "yaw": 0.3432326912879944, "odom_age_sec": 0.051843632, "odom_linear_x": 0.3140000104904175, "odom_angular_z": -0.18423332273960114 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.48699260395134353, "yaw_error_to_goal": 0.3432326912879944, "distance_to_plan_end": 0.4878047192670907, "yaw_error_to_plan_end": 0.6167673087120056, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.4862543874986806, "angular_z": -0.9218217189581884 }, "ackermann_cmd": { "speed": 0.48625439405441284, "steering_angle": -0.26473096013069153 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.16270109499999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.070274293422699, "y": 2.3764481991529465, "yaw": 0.3213166296482086, "odom_age_sec": 0.053782514000000003, "odom_linear_x": 0.34599998593330383, "odom_angular_z": -0.19092753529548645 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.44713446566543114, "yaw_error_to_goal": 0.3213166296482086, "distance_to_plan_end": 0.4486133584091243, "yaw_error_to_plan_end": 0.6386833703517913, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5153511012852235, "angular_z": -0.7270650529206899 }, "ackermann_cmd": { "speed": 0.5153511166572571, "steering_angle": -0.19907435774803162 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.26088492399998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.070274293422699, "y": 2.3764481991529465, "yaw": 0.3213166296482086, "odom_age_sec": 0.15186759300000002, "odom_linear_x": 0.34599998593330383, "odom_angular_z": -0.19092753529548645 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.44713446566543114, "yaw_error_to_goal": 0.3213166296482086, "distance_to_plan_end": 0.4486133584091243, "yaw_error_to_plan_end": 0.6386833703517913, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5470701059761809, "angular_z": -0.4826060455486455 }, "ackermann_cmd": { "speed": 0.5470700860023499, "steering_angle": -0.12548673152923584 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.360532881999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.112273156642914, "y": 2.389921709895134, "yaw": 0.3018630445003509, "odom_age_sec": 0.051603089000000005, "odom_linear_x": 0.38600000739097595, "odom_angular_z": -0.16567033529281616 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.4030500403325392, "yaw_error_to_goal": 0.30186304450035084, "distance_to_plan_end": 0.4052674402165271, "yaw_error_to_plan_end": 0.658136955499649, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5445644705318898, "angular_z": -0.5031369958909399 }, "ackermann_cmd": { "speed": 0.5445644855499268, "steering_angle": -0.13136053085327148 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.460297757999967, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.1554221510887146, "y": 2.402929589152336, "yaw": 0.2889988422393799, "odom_age_sec": 0.051445214, "odom_linear_x": 0.42500001192092896, "odom_angular_z": -0.11000403016805649 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.35798960686375086, "yaw_error_to_goal": 0.2889988422393799, "distance_to_plan_end": 0.3610027228766452, "yaw_error_to_plan_end": 0.6710011577606201, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.5342279221266115, "angular_z": -0.5856213416041669 }, "ackermann_cmd": { "speed": 0.5342279076576233, "steering_angle": -0.1554914116859436 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.560725552999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.2027425169944763, "y": 2.4166210144758224, "yaw": 0.2805655002593994, "odom_age_sec": 0.051820715, "odom_linear_x": 0.45100000500679016, "odom_angular_z": -0.07434011995792389 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.30872976278587105, "yaw_error_to_goal": 0.2805655002593994, "distance_to_plan_end": 0.31275788950465166, "yaw_error_to_plan_end": 0.6794344997406006, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.45604022751723383, "angular_z": -0.6415196436397318 }, "ackermann_cmd": { "speed": 0.45604023337364197, "steering_angle": -0.1985112428665161 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.66114076399998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.2420563101768494, "y": 2.4276774376630783, "yaw": 0.2752502858638764, "odom_age_sec": 0.052039091, "odom_linear_x": 0.47099998593330383, "odom_angular_z": -0.06143715977668762 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.267890836242227, "yaw_error_to_goal": 0.2752502858638764, "distance_to_plan_end": 0.2729621444545829, "yaw_error_to_plan_end": 0.6847497141361236, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.377979872725797, "angular_z": -0.6854443890039984 }, "ackermann_cmd": { "speed": 0.3779798746109009, "steering_angle": -0.2537330090999603 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.761309933000007, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.2882880568504333, "y": 2.440407559275627, "yaw": 0.2691154778003692, "odom_age_sec": 0.052412467000000004, "odom_linear_x": 0.47699999809265137, "odom_angular_z": -0.06337849050760269 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.2199390958053007, "yaw_error_to_goal": 0.2691154778003692, "distance_to_plan_end": 0.22663385123743524, "yaw_error_to_plan_end": 0.6908845221996307, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.2923380452344624, "angular_z": -0.7290122775439245 }, "ackermann_cmd": { "speed": 0.2923380434513092, "steering_angle": -0.3425454795360565 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.860650473999954, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.3326303362846375, "y": 2.4523263424634933, "yaw": 0.261819452047348, "odom_age_sec": 0.05179409, "odom_linear_x": 0.46399998664855957, "odom_angular_z": -0.08051139116287231 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.1740269575528506, "yaw_error_to_goal": 0.261819452047348, "distance_to_plan_end": 0.18296104379555986, "yaw_error_to_plan_end": 0.6981805479526518, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.17828343950258133, "angular_z": -0.7131337580103253 }, "ackermann_cmd": { "speed": 0.1782834380865097, "steering_angle": -0.5195767879486084 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "external_plan_ok points=121 length=3.600 goal=(2.515,2.436,0.960)" }, { "elapsed_sec": 25.96049068399998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.383823335170746, "y": 2.4656248539686203, "yaw": 0.24663737416267395, "odom_age_sec": 0.051586506000000004, "odom_linear_x": 0.4309999942779541, "odom_angular_z": -0.15932142734527588 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.12115555338294459, "yaw_error_to_goal": 0.24663737416267395, "distance_to_plan_end": 0.13431187081885834, "yaw_error_to_plan_end": 0.713362625837326, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.063343651999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.4192227721214294, "y": 2.4742126911878586, "yaw": 0.22144146263599393, "odom_age_sec": 0.054500557000000005, "odom_linear_x": 0.3919999897480011, "odom_angular_z": -0.3263484239578247 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.08479354833664683, "yaw_error_to_goal": 0.22144146263599393, "distance_to_plan_end": 0.1029181102504825, "yaw_error_to_plan_end": 0.738558537364006, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.165862118999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.47195166349411, "y": 2.484685704112053, "yaw": 0.14219142496585843, "odom_age_sec": 0.006858981, "odom_linear_x": 0.3140000104904175, "odom_angular_z": -0.5835791230201721 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.031956796449131575, "yaw_error_to_goal": 0.1421914249658584, "distance_to_plan_end": 0.06472334041040173, "yaw_error_to_plan_end": 0.8178085750341415, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.261612146000004, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.483257472515106, "y": 2.486272856593132, "yaw": 0.12236157059669495, "odom_age_sec": 0.05276042500000001, "odom_linear_x": 0.2809999883174896, "odom_angular_z": -0.5025213360786438 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.02165055871554227, "yaw_error_to_goal": 0.12236157059669495, "distance_to_plan_end": 0.05918136310249792, "yaw_error_to_plan_end": 0.8376384294033051, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.360654058999955, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.510840356349945, "y": 2.489314839243889, "yaw": 0.08684590458869934, "odom_age_sec": 0.051881631000000004, "odom_linear_x": 0.2150000035762787, "odom_angular_z": -0.2283075749874115 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.01522123471265495, "yaw_error_to_goal": 0.08684590458869934, "distance_to_plan_end": 0.053217908913740765, "yaw_error_to_plan_end": 0.8731540954113006, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.462790315000007, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5253323912620544, "y": 2.4905178993940353, "yaw": 0.07943077385425568, "odom_age_sec": 0.054024513, "odom_linear_x": 0.16300000250339508, "odom_angular_z": -0.06592211872339249 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.02704884986381949, "yaw_error_to_goal": 0.07943077385425568, "distance_to_plan_end": 0.055263874540132985, "yaw_error_to_plan_end": 0.8805692261457443, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.560730933000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5382091403007507, "y": 2.4915161579847336, "yaw": 0.07708805799484253, "odom_age_sec": 0.051873256000000006, "odom_linear_x": 0.11699999868869781, "odom_angular_z": -0.009616187773644924 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0391396726846617, "yaw_error_to_goal": 0.07708805799484253, "distance_to_plan_end": 0.05998613572912088, "yaw_error_to_plan_end": 0.8829119420051574, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.660453306999955, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5488101840019226, "y": 2.4923186749219894, "yaw": 0.07701574265956879, "odom_age_sec": 0.051696631, "odom_linear_x": 0.09099999815225601, "odom_angular_z": 0.0022131307050585747 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.04941089775804135, "yaw_error_to_goal": 0.07701574265956879, "distance_to_plan_end": 0.06553328711873584, "yaw_error_to_plan_end": 0.8829842573404312, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.760718723999958, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.557428538799286, "y": 2.492972180247307, "yaw": 0.07784375548362733, "odom_age_sec": 0.05187709, "odom_linear_x": 0.07100000232458115, "odom_angular_z": 0.008517945185303688 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0578569556673822, "yaw_error_to_goal": 0.07784375548362733, "distance_to_plan_end": 0.07090398928449283, "yaw_error_to_plan_end": 0.8821562445163726, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.860684472999992, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.562071740627289, "y": 2.4933279007673264, "yaw": 0.07863455265760422, "odom_age_sec": 0.051906631, "odom_linear_x": 0.04500000178813934, "odom_angular_z": 0.009423505514860153 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.06242930315702764, "yaw_error_to_goal": 0.07863455265760422, "distance_to_plan_end": 0.07405743223976084, "yaw_error_to_plan_end": 0.8813654473423957, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 26.96072043099997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5667876601219177, "y": 2.493693396449089, "yaw": 0.07982407510280608, "odom_age_sec": 0.051872339, "odom_linear_x": 0.03200000151991844, "odom_angular_z": 0.010090550407767296 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.06708475827570046, "yaw_error_to_goal": 0.07982407510280608, "distance_to_plan_end": 0.07741878880663904, "yaw_error_to_plan_end": 0.8801759248971938, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.06328864699998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5692493319511414, "y": 2.4938867539167404, "yaw": 0.08021456003189084, "odom_age_sec": 0.054458222, "odom_linear_x": 0.03200000151991844, "odom_angular_z": 0.003680344671010971 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.06951864320708406, "yaw_error_to_goal": 0.08021456003189083, "distance_to_plan_end": 0.07923080600770296, "yaw_error_to_plan_end": 0.8797854399681091, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.160633969000003, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5714094042778015, "y": 2.494056984782219, "yaw": 0.08013186603784561, "odom_age_sec": 0.051869338, "odom_linear_x": 0.01899999938905239, "odom_angular_z": -0.0012064689071848989 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.07165627990057309, "yaw_error_to_goal": 0.08013186603784561, "distance_to_plan_end": 0.08084989420779078, "yaw_error_to_plan_end": 0.8798681339621544, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.260636257999977, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5728673338890076, "y": 2.494171664118767, "yaw": 0.07984879612922667, "odom_age_sec": 0.051916713, "odom_linear_x": 0.006000000052154064, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.07310005367464911, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.08195683750524278, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.360645213999987, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.5734021067619324, "y": 2.4942136257886887, "yaw": 0.07984879612922667, "odom_age_sec": 0.051918921, "odom_linear_x": 0.006000000052154064, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.07362982686115353, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0823655749178935, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.460753502999978, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051889213000000003, "odom_linear_x": 0.006000000052154064, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.560673334, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051909088000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.663368006999974, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.054504389, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.76065678699996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.05186808800000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.86313633399999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.054305263000000006, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 27.960872948999963, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051987464000000004, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.06054048699997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051741212, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.160662774000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051927796000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.260648560999982, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.05193542, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.36072538999997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051772087, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.464359396999953, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.005561435, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.560705256000006, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.05192567100000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.660829251999985, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.052010713, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.761039705999963, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051973755, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.860655616999964, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051833587, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 28.960519861999956, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.05176692, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.060767607000002, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051918878, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.160635766999974, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051870253000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.260768219, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051930170000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.36053691999996, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051810544, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.460610287999998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051876795, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.56313983199999, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.054343386, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.66338132599998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.054526636, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.76061260199998, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051912419, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.86307743599997, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.05427263500000001, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 29.960430170999985, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.051750460000000005, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" }, { "elapsed_sec": 30.064793427999973, "pose_map": { "available": true, "frame_id": "map", "source_frame": "odom", "x": 2.574098289012909, "y": 2.494268223643303, "yaw": 0.07984879612922667, "odom_age_sec": 0.006132895, "odom_linear_x": 0.0, "odom_angular_z": 0.0 }, "goal": { "elapsed_sec": 13.149649433999969, "frame_id": "map", "x": 2.5, "y": 2.5, "yaw": 0.0 }, "plan_end": { "x": 2.5148837839619955, "y": 2.4362507598464536, "yaw": 0.96 }, "distance_to_goal": 0.0743196454165638, "yaw_error_to_goal": 0.07984879612922667, "distance_to_plan_end": 0.0828998414584936, "yaw_error_to_plan_end": 0.8801512038707733, "plan_end_to_goal": 0.06546367424138286, "plan_end_yaw_to_goal": 0.96, "cmd_vel": { "linear_x": 0.0, "angular_z": 0.0 }, "ackermann_cmd": { "speed": 0.0, "steering_angle": 0.0 }, "planner_status": "plan_ok hybrid_astar points=121 iterations=45 obstacles=0 planning_ms=64.580 goal_error=0.065 yaw_error=0.960", "tracker_status": "goal_reached external_plan goal_error=0.132 yaw_error=0.714" } ] }