Files
yiliao2026/test_results/reach_fail_debug_20260722_163934.json

10717 lines
331 KiB
JSON
Raw Permalink Blame History

This file contains ambiguous Unicode characters
This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.
{
"metadata": {
"started_wall_time": 1784709574.4937177,
"duration_sec": 30.145608000999346,
"output_path": "/home/sunrise/yiliao_ws/test_results/reach_fail_debug_20260722_163934.json"
},
"topics": {
"odom": "/odom",
"goal_pose": "/goal_pose",
"plan": "/plan",
"cmd_vel": "/cmd_vel",
"ackermann_cmd": "/ackermann_cmd",
"planner_status": "/hybrid_astar_status",
"tracker_status": "/pure_pursuit_status"
},
"topic_endpoints": {
"/odom": {
"publisher_count": 3,
"subscriber_count": 8,
"publishers": [
{
"node_name": "origincar_base",
"node_namespace": "/",
"topic_type": "nav_msgs/msg/Odometry"
},
{
"node_name": "origincar_base",
"node_namespace": "/",
"topic_type": "nav_msgs/msg/Odometry"
},
{
"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"
},
{
"node_name": "ekf_filter_node",
"node_namespace": "/",
"topic_type": "nav_msgs/msg/Odometry"
},
{
"node_name": "ekf_filter_node",
"node_namespace": "/",
"topic_type": "nav_msgs/msg/Odometry"
},
{
"node_name": "ekf_filter_node",
"node_namespace": "/",
"topic_type": "nav_msgs/msg/Odometry"
},
{
"node_name": "ekf_filter_node",
"node_namespace": "/",
"topic_type": "nav_msgs/msg/Odometry"
}
]
},
"/goal_pose": {
"publisher_count": 0,
"subscriber_count": 2,
"publishers": [],
"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"
}
]
},
"/cmd_vel": {
"publisher_count": 1,
"subscriber_count": 3,
"publishers": [
{
"node_name": "topology_pure_pursuit",
"node_namespace": "/",
"topic_type": "geometry_msgs/msg/Twist"
}
],
"subscribers": [
{
"node_name": "goal_reach_debug_collector",
"node_namespace": "/",
"topic_type": "geometry_msgs/msg/Twist"
},
{
"node_name": "origincar_base",
"node_namespace": "/",
"topic_type": "geometry_msgs/msg/Twist"
},
{
"node_name": "origincar_base",
"node_namespace": "/",
"topic_type": "geometry_msgs/msg/Twist"
}
]
},
"/ackermann_cmd": {
"publisher_count": 0,
"subscriber_count": 2,
"publishers": [],
"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": true,
"resolution": 0.1,
"yaw_bins": 36,
"primitive_length": 0.12,
"min_turning_radius": 0.25,
"heuristic_weight": 1.35,
"goal_yaw_heuristic_weight": 1.0,
"planning_timeout_ms": 1500.0,
"max_iterations": 200000
}
},
"tracker": {
"node": "/topology_pure_pursuit",
"service": "/topology_pure_pursuit/get_parameters",
"values": {
"goal_tolerance": 0.08,
"goal_yaw_tolerance": 0.08,
"align_goal_yaw": true,
"lookahead_distance": 0.3,
"linear_speed": 0.5,
"min_linear_speed": 0.2,
"reverse_speed": 0.36,
"slowdown_distance": 0.7,
"curvature_slowdown_gain": 0.25,
"min_turning_radius": 0.25,
"max_angular_speed": 1.8
}
}
},
"latest": {
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan": {
"frame_id": "map",
"points": 77,
"length": 2.279568077753335,
"start": {
"x": 0.0,
"y": 0.0,
"yaw": 0.0
},
"end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"reverse_segment_fraction": 0.0
},
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.053080006000000006,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)",
"last_plan_ok": {
"points": 77,
"iterations": 131,
"planning_ms": 72.701,
"goal_error": 0.098,
"yaw_error": 0.0
},
"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.6336674236681054,
"y": 0.5491645785781745,
"yaw": 0.48000000000000004
},
{
"x": 0.660277271351484,
"y": 0.5630179538444189,
"yaw": 0.48000000000000004
},
{
"x": 0.6868871190348624,
"y": 0.5768713291106634,
"yaw": 0.48000000000000004
},
{
"x": 0.7134969667182409,
"y": 0.5907247043769079,
"yaw": 0.48000000000000004
},
{
"x": 0.7401068144016194,
"y": 0.6045780796431525,
"yaw": 0.48000000000000004
},
{
"x": 0.766716662084998,
"y": 0.6184314549093969,
"yaw": 0.48000000000000004
},
{
"x": 0.7933265097683765,
"y": 0.6322848301756414,
"yaw": 0.48000000000000004
},
{
"x": 0.819936357451755,
"y": 0.6461382054418858,
"yaw": 0.48000000000000004
},
{
"x": 0.8456521819151431,
"y": 0.6615530324092873,
"yaw": 0.6000000000000002
},
{
"x": 0.8693377315592525,
"y": 0.6799355038514832,
"yaw": 0.7199999999999999
},
{
"x": 0.8906523435590991,
"y": 0.7010212296763798,
"yaw": 0.8400000000000002
},
{
"x": 0.9092894556416338,
"y": 0.7245069396185927,
"yaw": 0.96
},
{
"x": 0.9264950552238075,
"y": 0.7490826866676227,
"yaw": 0.96
},
{
"x": 0.9437006548059812,
"y": 0.7736584337166525,
"yaw": 0.96
},
{
"x": 0.9609062543881549,
"y": 0.7982341807656825,
"yaw": 0.96
},
{
"x": 0.9781118539703286,
"y": 0.8228099278147125,
"yaw": 0.96
},
{
"x": 0.9953174535525023,
"y": 0.8473856748637425,
"yaw": 0.96
},
{
"x": 1.012523053134676,
"y": 0.8719614219127724,
"yaw": 0.96
},
{
"x": 1.0297286527168497,
"y": 0.8965371689618024,
"yaw": 0.96
},
{
"x": 1.0469342522990235,
"y": 0.9211129160108323,
"yaw": 0.96
},
{
"x": 1.064139851881197,
"y": 0.9456886630598623,
"yaw": 0.96
},
{
"x": 1.081345451463371,
"y": 0.9702644101088922,
"yaw": 0.96
},
{
"x": 1.0985510510455445,
"y": 0.9948401571579222,
"yaw": 0.96
},
{
"x": 1.1157566506277183,
"y": 1.0194159042069522,
"yaw": 0.96
},
{
"x": 1.132962250209892,
"y": 1.0439916512559821,
"yaw": 0.96
},
{
"x": 1.1501678497920658,
"y": 1.0685673983050121,
"yaw": 0.96
},
{
"x": 1.1673734493742394,
"y": 1.0931431453540421,
"yaw": 0.96
},
{
"x": 1.1845790489564132,
"y": 1.1177188924030719,
"yaw": 0.96
},
{
"x": 1.2017846485385868,
"y": 1.1422946394521019,
"yaw": 0.96
},
{
"x": 1.2189902481207606,
"y": 1.1668703865011318,
"yaw": 0.96
},
{
"x": 1.2361958477029342,
"y": 1.1914461335501616,
"yaw": 0.96
},
{
"x": 1.253401447285108,
"y": 1.2160218805991916,
"yaw": 0.96
},
{
"x": 1.2706070468672817,
"y": 1.2405976276482216,
"yaw": 0.96
},
{
"x": 1.2878126464494555,
"y": 1.2651733746972516,
"yaw": 0.96
},
{
"x": 1.305018246031629,
"y": 1.2897491217462815,
"yaw": 0.96
},
{
"x": 1.322223845613803,
"y": 1.3143248687953113,
"yaw": 0.96
},
{
"x": 1.3394294451959765,
"y": 1.3389006158443413,
"yaw": 0.96
},
{
"x": 1.3566350447781503,
"y": 1.3634763628933713,
"yaw": 0.96
},
{
"x": 1.373840644360324,
"y": 1.388052109942401,
"yaw": 0.96
},
{
"x": 1.3910462439424978,
"y": 1.412627856991431,
"yaw": 0.96
},
{
"x": 1.4096833560250326,
"y": 1.4361135669336438,
"yaw": 0.8399999999999999
},
{
"x": 1.430997968024879,
"y": 1.4571992927585407,
"yaw": 0.7199999999999999
},
{
"x": 1.4546835176689885,
"y": 1.4755817642007365,
"yaw": 0.5999999999999999
},
{
"x": 1.4803993421323767,
"y": 1.490996591168138,
"yaw": 0.48000000000000004
},
{
"x": 1.507775577698975,
"y": 1.5032220663928006,
"yaw": 0.3600000000000001
},
{
"x": 1.5364184794109637,
"y": 1.5120823541863244,
"yaw": 0.24000000000000005
},
{
"x": 1.5659160841955175,
"y": 1.5174500194367835,
"yaw": 0.12000000000000005
},
{
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
}
]
},
"metrics": {
"sample_count": 298,
"goal_count": 5,
"plan_count": 5,
"planner_status_count": 15,
"tracker_status_count": 5,
"min_distance_to_goal": 1.1043541046029437,
"min_distance_to_plan_end": 1.1438855302314723,
"final_distance_to_goal": 4.30482511794916,
"final_distance_to_plan_end": 4.317954888033011,
"final_plan_end_to_goal": 0.09775775438188386,
"final_plan_end_yaw_to_goal": 5.551115123125783e-17,
"max_abs_cmd_linear": 0.0,
"max_abs_cmd_angular": 0.0,
"max_abs_ackermann_speed": 0.0,
"max_abs_steering_angle": 0.0,
"tf_failures": 0,
"saw_plan_ok": true,
"saw_plan_failed": false,
"saw_goal_reached": false,
"saw_align_goal_yaw": false,
"saw_no_recent_odom": false
},
"diagnostic_hints": [
"planner 的 goal_xy_tolerance 大于 tracker 的 goal_toleranceplanner 可能发布一个离原始目标较远的路径终点。",
"planner 的 goal_yaw_tolerance 大于 tracker 的 goal_yaw_toleranceplanner 认为合格的终点 yawtracker 可能继续调整。",
"tracker 的 min_linear_speed 数值大于 goal_tolerance接近终点时可能仍以较高速度越过目标。",
"最新 /plan 的终点到 /goal_pose 的距离大于 tracker 到点半径tracker 跟随 /plan 时不会到达你原始输入的目标点。"
],
"events": {
"goals": [
{
"elapsed_sec": 9.941826494999987,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
{
"elapsed_sec": 10.066145799000878,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
{
"elapsed_sec": 10.229273506000027,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
{
"elapsed_sec": 10.312182445000872,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
{
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
}
],
"plans": [
{
"frame_id": "map",
"points": 41,
"length": 1.199568077753336,
"start": {
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.09319654852151868
},
"end": {
"x": 1.5916874467632467,
"y": 1.5979057970032364,
"yaw": 0.0931965485215187
},
"reverse_segment_fraction": 0.0,
"elapsed_sec": 10.033241741000893
},
{
"frame_id": "map",
"points": 157,
"length": 4.679712051835562,
"start": {
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669
},
"end": {
"x": 1.5885732716510643,
"y": 1.4864642022755374,
"yaw": 0.16711489994266904
},
"reverse_segment_fraction": 0.05128205128205128,
"elapsed_sec": 10.219894531001046
},
{
"frame_id": "map",
"points": 77,
"length": 2.279568077753335,
"start": {
"x": 0.0,
"y": 0.0,
"yaw": 0.0
},
"end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"reverse_segment_fraction": 0.0,
"elapsed_sec": 10.281077847999768
},
{
"frame_id": "map",
"points": 157,
"length": 4.679712051835562,
"start": {
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669
},
"end": {
"x": 1.5885732716510643,
"y": 1.4864642022755374,
"yaw": 0.16711489994266904
},
"reverse_segment_fraction": 0.05128205128205128,
"elapsed_sec": 10.456392867999966
},
{
"frame_id": "map",
"points": 77,
"length": 2.279568077753335,
"start": {
"x": 0.0,
"y": 0.0,
"yaw": 0.0
},
"end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"reverse_segment_fraction": 0.0,
"elapsed_sec": 10.544633273999352
}
],
"planner_status": [
{
"elapsed_sec": 9.947005961999821,
"data": "goal_received map=(1.500,1.500,0.000)"
},
{
"elapsed_sec": 9.950010759001088,
"data": "plan_start start=(0.900,2.427,0.093) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175"
},
{
"elapsed_sec": 10.037977666001098,
"data": "plan_ok hybrid_astar points=41 iterations=191 obstacles=0 planning_ms=76.010 goal_error=0.134 yaw_error=0.093",
"parsed_plan_ok": {
"points": 41,
"iterations": 191,
"planning_ms": 76.01,
"goal_error": 0.134,
"yaw_error": 0.093
}
},
{
"elapsed_sec": 10.066788092000934,
"data": "goal_received map=(1.500,1.500,0.000)"
},
{
"elapsed_sec": 10.069245930000761,
"data": "plan_start start=(1.821,-2.793,1.127) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175"
},
{
"elapsed_sec": 10.221086449000722,
"data": "plan_ok hybrid_astar points=157 iterations=712 obstacles=0 planning_ms=98.247 goal_error=0.090 yaw_error=0.167",
"parsed_plan_ok": {
"points": 157,
"iterations": 712,
"planning_ms": 98.247,
"goal_error": 0.09,
"yaw_error": 0.167
}
},
{
"elapsed_sec": 10.229870090000986,
"data": "goal_received map=(1.500,1.500,0.000)"
},
{
"elapsed_sec": 10.235885600999609,
"data": "plan_start start=(0.000,0.000,0.000) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175"
},
{
"elapsed_sec": 10.28201214100045,
"data": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=65.344 goal_error=0.098 yaw_error=0.000",
"parsed_plan_ok": {
"points": 77,
"iterations": 131,
"planning_ms": 65.344,
"goal_error": 0.098,
"yaw_error": 0.0
}
},
{
"elapsed_sec": 10.312838362000548,
"data": "goal_received map=(1.500,1.500,0.000)"
},
{
"elapsed_sec": 10.31520111700047,
"data": "plan_start start=(1.821,-2.793,1.127) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175"
},
{
"elapsed_sec": 10.45822295400103,
"data": "plan_ok hybrid_astar points=157 iterations=712 obstacles=0 planning_ms=91.676 goal_error=0.090 yaw_error=0.167",
"parsed_plan_ok": {
"points": 157,
"iterations": 712,
"planning_ms": 91.676,
"goal_error": 0.09,
"yaw_error": 0.167
}
},
{
"elapsed_sec": 10.47023176699986,
"data": "goal_received map=(1.500,1.500,0.000)"
},
{
"elapsed_sec": 10.47766152999975,
"data": "plan_start start=(0.000,0.000,0.000) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175"
},
{
"elapsed_sec": 10.545816400999684,
"data": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"parsed_plan_ok": {
"points": 77,
"iterations": 131,
"planning_ms": 72.701,
"goal_error": 0.098,
"yaw_error": 0.0
}
}
],
"tracker_status": [
{
"elapsed_sec": 10.038857875999383,
"data": "external_plan_ok points=41 length=1.200 goal=(1.592,1.598,0.093)"
},
{
"elapsed_sec": 10.23035900800096,
"data": "external_plan_ok points=157 length=4.680 goal=(1.589,1.486,0.167)"
},
{
"elapsed_sec": 10.286882983000396,
"data": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 10.546664319999763,
"data": "external_plan_ok points=157 length=4.680 goal=(1.589,1.486,0.167)"
},
{
"elapsed_sec": 10.598924079000426,
"data": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
}
]
},
"samples": [
{
"elapsed_sec": 0.44684939599937934,
"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.5449285739996412,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037678027,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 0.6465588829996705,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.03937803,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 0.7437660590003361,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036358691000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 0.8440133660005813,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036585358000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 0.9438045469996723,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036706483000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.0438397279995115,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036564525,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.1441107440004998,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036952484,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.2437961739997263,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036762108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.343642230000114,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036568775000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.4437635790000058,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036748858,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.543712009999581,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036715317000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.6436962320003659,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036659108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.7438199139996868,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036729359,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.8437365110003157,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036678024000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 1.9437088590002531,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.03665315,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.043698122999558,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.03670215,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.1437525960009225,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036696983,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.2437166510007955,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036574441,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.3438172490004945,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.0367564,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.443824055000732,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036739191000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.5439731950009445,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036734108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.6437720419999096,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036735192,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.743700054999863,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036667233,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.843779569000617,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036813816,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 2.9437622080004076,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036792775,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.043705179999961,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036741608,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.143955277999339,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036780942000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.2439347920008004,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036719441000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.343690429999697,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036383816,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.443719069000508,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036635941000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.5439012500009994,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.03666715,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.6439136379995034,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036510733000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.7444515690003755,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036932067,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.843812123001044,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.03672615,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 3.9439934290003293,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036902859,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.044029942000634,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036829316,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.143788454999594,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036597858000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.24397088600017,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036764317000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.3438631909994,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036719942000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.444469955000386,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037448234000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.543983468000079,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036900525,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.6440715640001144,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036994441,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.7437850770002115,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036865108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.84377796499939,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036773775,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 4.943734935999601,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036728858,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.043970033000733,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.0368949,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.143979587999638,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.0368439,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.24395076700057,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036908942,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.34405890600101,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036926483,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.444120043999646,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036943108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.543953472999419,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036868107000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.64396523600044,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036878441000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.743756165000377,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036825607,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.843783760999941,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036853483,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 5.94400556599976,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036858107,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.0437232029998995,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036747524000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.143830924000213,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036924358000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.243767853000463,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036900607,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.34369469900048,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036767857,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.443738128000405,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036850524,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.543772098999398,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.03675565,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.6438321950008685,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036773232,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.743851123999775,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036698066,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.84407563700006,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036893941,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 6.944314358001066,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036987316,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.044286911001109,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036998108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.143974214999616,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036928816,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.243786184999408,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036808441000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.3437428640008875,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036806107000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.443758834000619,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.036650066,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.5436326380004175,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036688982,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.644315068000651,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037178483000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.746222750000015,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.03922507,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.843714214999636,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036769982,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 7.944275812000342,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037128692000000005,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.04409344799933,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036961024,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.143733168000836,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036687815000000006,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.243736554000861,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036808774,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.343933232999916,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036901107,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.444103537000046,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037019108,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.544017549000273,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036520648,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.643777184999635,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.036869816,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.744193571999858,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037040149,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.84451808400081,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.037343525,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 8.944148970000242,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": -1.1219797865797176,
"y": -2.332862441802514,
"yaw": -0.09319654852151874,
"odom_age_sec": 0.037123649,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.0444638150002,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 2.220446049250313e-16,
"y": 0.0,
"yaw": -4.163336342344337e-17,
"odom_age_sec": 0.03728215,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.143972784000653,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.4315488102256487,
"y": -5.283054429398025,
"yaw": 1.0339183514211503,
"odom_age_sec": 0.036928399,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.244133461999809,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.7405673661903645,
"y": 2.843854621551168,
"yaw": -1.127114899942669,
"odom_age_sec": 0.035804356,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.344130224000764,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036956524000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.443951277000451,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 2.220446049250313e-16,
"yaw": 0.0,
"odom_age_sec": 0.03685194,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.543795495999802,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.7405673661903645,
"y": 2.843854621551168,
"yaw": -1.127114899942669,
"odom_age_sec": 0.036886149,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.645815927000513,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.038625902000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.743772226000146,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036743107000000004,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.84374719600055,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036701732,
"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": null,
"ackermann_cmd": null,
"planner_status": "",
"tracker_status": ""
},
{
"elapsed_sec": 9.945585167999525,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.038173443,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 9.941826494999987,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": null,
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"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": 10.04445363600098,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037165233,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 9.941826494999987,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5916874467632467,
"y": 1.5979057970032364,
"yaw": 0.0931965485215187
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2553872980666205,
"yaw_error_to_plan_end": 0.0931965485215187,
"plan_end_to_goal": 0.13413475679629847,
"plan_end_yaw_to_goal": 0.0931965485215187,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=41 iterations=191 obstacles=0 planning_ms=76.010 goal_error=0.134 yaw_error=0.093",
"tracker_status": "external_plan_ok points=41 length=1.200 goal=(1.592,1.598,0.093)"
},
{
"elapsed_sec": 10.144036687999687,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036976149,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.066145799000878,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5916874467632467,
"y": 1.5979057970032364,
"yaw": 0.0931965485215187
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.396722566685185,
"yaw_error_to_plan_end": 1.0339183514211503,
"plan_end_to_goal": 0.13413475679629847,
"plan_end_yaw_to_goal": 0.0931965485215187,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_start start=(1.821,-2.793,1.127) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175",
"tracker_status": "external_plan_ok points=41 length=1.200 goal=(1.592,1.598,0.093)"
},
{
"elapsed_sec": 10.244629283000904,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037453191000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.229273506000027,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5885732716510643,
"y": 1.4864642022755374,
"yaw": 0.16711489994266904
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.1755782826758536,
"yaw_error_to_plan_end": 0.16711489994266904,
"plan_end_to_goal": 0.08960157515920578,
"plan_end_yaw_to_goal": 0.16711489994266904,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_start start=(0.000,0.000,0.000) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175",
"tracker_status": "external_plan_ok points=157 length=4.680 goal=(1.589,1.486,0.167)"
},
{
"elapsed_sec": 10.344130417999622,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037007566000000006,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.312182445000872,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_start start=(1.821,-2.793,1.127) goal=(1.500,1.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=1.000 goal_yaw_tolerance=0.175",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 10.463070338000762,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.105711021,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.312182445000872,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5885732716510643,
"y": 1.4864642022755374,
"yaw": 0.16711489994266904
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.285605056427637,
"yaw_error_to_plan_end": 0.96,
"plan_end_to_goal": 0.08960157515920578,
"plan_end_yaw_to_goal": 0.16711489994266904,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=157 iterations=712 obstacles=0 planning_ms=91.676 goal_error=0.090 yaw_error=0.167",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 10.550644160000957,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.09319495700000001,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=157 length=4.680 goal=(1.589,1.486,0.167)"
},
{
"elapsed_sec": 10.644078450999586,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.035984855,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 10.744102128001032,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036646232,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 10.844442764000632,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037006149,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 10.943962649000241,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036598565,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.043918700999711,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.03685544,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.143796669999574,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036836524,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.243866556000285,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.03680544,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.34380494099969,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.03680994,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.443775202000324,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036855357000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.543977962999634,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036981941000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.643798263999997,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036941357,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.743809023999347,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03684469,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.843758492999768,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036925898000000006,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 11.943782628000918,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036939357,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.04374913799984,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036946607,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.143617981999341,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.03678869,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.243847241999902,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036867482,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.34533825499966,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.038417109000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.443853929000397,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036860816000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.543972106001092,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036972774,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.643835199000023,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036907607,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.743968209000741,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036890690000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.843882302000566,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036859356,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 12.944013354001072,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036945607000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.043971281000267,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036978857000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.143806665000739,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036940606,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.243771925001056,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036765148000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.343732351000654,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036786440000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.444029112000862,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036894857,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.544109205000495,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036978815000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.644185256000128,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036978565000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.744512641000256,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03728394,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.843900649000716,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03681294,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 13.943874075001077,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036912857,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.04374287599967,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036663190000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.144896554000297,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037850942000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.243833229000302,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036696148000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.34383398799946,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036886523000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.443774747000134,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036862148000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.544838383999377,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.032223890000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.643831391000276,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036914606,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.744014191999668,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037041648,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.843704283999614,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036903315,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 14.943754959000216,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036834023,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.043673468000634,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036891440000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.145151979999355,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.038065858,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.244193279000683,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036347272,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.343765453999367,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036882773,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.443996797001091,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036965357000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.54376951300037,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036865939,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.644059398000536,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037056857000000006,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.744047656000475,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037111148000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.844031747999907,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037126899000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 15.943879923001077,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036968815,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.044753182999557,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037338607,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.144025232000786,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036806731,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.24387403199944,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036996023,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.34408966599949,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037108398,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.443768008000916,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036803481,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.543973932999506,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036978857000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.644007191000128,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036985065000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.745048868000595,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037352982,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.84544433500014,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037492399,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 16.944168133000858,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03690169,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.04398876599953,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037047898,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.143869691000873,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036983815,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.24378094900021,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036901564000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.344484041001124,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036946106,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.44383483999991,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036897689000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.54397884900027,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037023773,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.643778231000397,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036980481,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.744179698000153,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036872023000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.844008871999904,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036670522000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 17.94431788000111,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.033358391,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.04374897100024,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036426439000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.145849398999417,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037504024000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.24392494499989,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036834314,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.343972536000365,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037029273,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.443961627001045,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037065107,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.543995427000482,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037052481000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.643960266999784,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037037898,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.7440303580006,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037092773,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.843994365999606,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037043106,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 18.944129622999753,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037203940000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.043759505000708,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036953189000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.143744095999864,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037037939,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.244272228999762,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037202814,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.343856944000436,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037014898000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.44394961800026,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037085523,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.544021584000802,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037052439,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.64394350800103,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036965356000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.743941390001055,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037025731,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.844046813001114,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037044898,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 19.943965820000813,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036941356,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.043739327000367,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036898522,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.14410466800109,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037044898,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.244277175001116,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037066606,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.34438501600016,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037193315000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.444266022999727,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037135023,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.544155904000945,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037252815,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.64370966000024,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036833022,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.743852625000727,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.03689448,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.844035591000647,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037114773000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 20.94387468000059,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037060397,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.043976811999528,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037061356000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.143998194000233,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036915939,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.243972034000763,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037050897,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.343988664999415,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036903564,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.44397663000018,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037088481,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.543832594999913,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037052189,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.64376376800101,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037016772,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.74400102400068,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037104439,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.84376086300108,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03701523,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 21.94401457800086,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037145689,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.04406904300049,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037148481000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.14374742400105,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037060689,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.244009722000555,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037076272,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.344074186999933,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037057523,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.443971067999883,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037068898,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.543914740001128,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037100564,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.64400445499996,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037143689,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.74416046099941,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037315648,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.84403304999978,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037075106000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 22.944076555999345,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03713098,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.043808811000417,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037013231,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.1438769840006,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037065522000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.244114281000293,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037095689,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.344034412000838,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037021648000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.444084585000383,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037084148000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.54418163199989,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037201105000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.644435513000644,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037255939,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.743916559000354,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037092980000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.843926855999598,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037024938,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 23.943894486999852,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037019355000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.043818699999974,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036937439,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.143908330999693,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036924688000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.24405187800039,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.036982688,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.343616674999794,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.03666623,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.443751971999518,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036894897,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.545716689000983,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.038963858000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.6439898990011,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037061272,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.74415898799998,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037247439,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.843778492000638,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037075647,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 24.943761664000704,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036990813000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.043845460999364,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.03701523,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.143944174000353,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037171897,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.24384297100005,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037040646,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.343894433999594,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.03705323,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.444010438999612,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037060272000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.544042486000762,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037157564000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.644002865999937,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037170314,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.7439623700011,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.03712973,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.843982833001064,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037157188,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 25.94416417100001,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037280189000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.04382355100097,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037075272,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.144052264000493,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037119022,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.243785143000423,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037035855,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.34399502300039,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037131813,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.44392531899939,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037099230000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.5439835319994,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037089105000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.643981036000696,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037129563000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.74460333299976,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037341063,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.844204586999695,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037379772000000006,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 26.94396871600111,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037164439,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.044048761999875,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037008522,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.1438922239995,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.036964605000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.243878687000688,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03682098,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.343979774001127,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037027855000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.443649320000986,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036831979,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.544321658000626,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037400064000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.645773039001142,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.039129025000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.743928124000377,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037210897,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.844173753001087,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037198605,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 27.94378788100039,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.036993854,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.043782967999505,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037175272,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.14412101400012,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037214438,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.244004809001126,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037276772,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.34416543900079,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037278564,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.444002525000542,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.03713748,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.543977654000628,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037134855,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.643910906999736,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037064355,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.744150452999747,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037249146000000004,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.84379770600026,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037130313000000005,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 28.943870500999765,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037167314,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.043926629999987,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037156188,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.143966965999425,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037178396,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.244087887000205,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037283147,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.343840347999503,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037078397,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.443982476999736,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037206272000000006,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.5440536469996,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.03720748,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.64403990000028,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037273355,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.74402244399971,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037164355,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.844222531000923,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.9000106453895569,
"y": 2.4271519631147385,
"yaw": 0.0931965485215187,
"odom_age_sec": 0.037218439,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 1.1043541046029437,
"yaw_error_to_goal": 0.0931965485215187,
"distance_to_plan_end": 1.1438855302314723,
"yaw_error_to_plan_end": 0.09319654852151864,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 29.943915034000383,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037056355,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 30.044200704000104,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 0.0,
"y": 0.0,
"yaw": 0.0,
"odom_age_sec": 0.037025646,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 2.1213203435596424,
"yaw_error_to_goal": 0.0,
"distance_to_plan_end": 2.2033684594309193,
"yaw_error_to_plan_end": 5.551115123125783e-17,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
},
{
"elapsed_sec": 30.144658999000967,
"pose_map": {
"available": true,
"frame_id": "map",
"source_frame": "odom",
"x": 1.8213366866111755,
"y": -2.792815163731575,
"yaw": 1.127114899942669,
"odom_age_sec": 0.037078604,
"odom_linear_x": 0.0,
"odom_angular_z": 0.0
},
"goal": {
"elapsed_sec": 10.469416641000862,
"frame_id": "map",
"x": 1.5,
"y": 1.5,
"yaw": 0.0
},
"plan_end": {
"x": 1.5958441360177473,
"y": 1.519247860473317,
"yaw": 5.551115123125783e-17
},
"distance_to_goal": 4.30482511794916,
"yaw_error_to_goal": 1.127114899942669,
"distance_to_plan_end": 4.317954888033011,
"yaw_error_to_plan_end": 1.127114899942669,
"plan_end_to_goal": 0.09775775438188386,
"plan_end_yaw_to_goal": 5.551115123125783e-17,
"cmd_vel": null,
"ackermann_cmd": null,
"planner_status": "plan_ok hybrid_astar points=77 iterations=131 obstacles=0 planning_ms=72.701 goal_error=0.098 yaw_error=0.000",
"tracker_status": "external_plan_ok points=77 length=2.280 goal=(1.596,1.519,0.000)"
}
]
}