10717 lines
331 KiB
JSON
10717 lines
331 KiB
JSON
{
|
||
"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_tolerance;planner 可能发布一个离原始目标较远的路径终点。",
|
||
"planner 的 goal_yaw_tolerance 大于 tracker 的 goal_yaw_tolerance;planner 认为合格的终点 yaw,tracker 可能继续调整。",
|
||
"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)"
|
||
}
|
||
]
|
||
} |