forked from zbw/yiliao2026
11103 lines
283 KiB
JSON
11103 lines
283 KiB
JSON
{
|
|
"metadata": {
|
|
"started_wall_time": 1784711248.72797,
|
|
"duration_sec": 30.07887561500138,
|
|
"output_path": "/home/sunrise/yiliao_ws/test_results/reach_fail_debug_20260722_170728.json"
|
|
},
|
|
"topics": {
|
|
"odom": "/odom",
|
|
"goal_pose": "/goal_pose",
|
|
"plan": "/plan",
|
|
"cmd_vel": "/planner_cmd_vel",
|
|
"ackermann_cmd": "/ackermann_cmd",
|
|
"planner_status": "/hybrid_astar_status",
|
|
"tracker_status": "/pure_pursuit_status"
|
|
},
|
|
"topic_endpoints": {
|
|
"/odom": {
|
|
"publisher_count": 1,
|
|
"subscriber_count": 4,
|
|
"publishers": [
|
|
{
|
|
"node_name": "origincar_base",
|
|
"node_namespace": "/",
|
|
"topic_type": "nav_msgs/msg/Odometry"
|
|
}
|
|
],
|
|
"subscribers": [
|
|
{
|
|
"node_name": "goal_reach_debug_collector",
|
|
"node_namespace": "/",
|
|
"topic_type": "nav_msgs/msg/Odometry"
|
|
},
|
|
{
|
|
"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"
|
|
}
|
|
]
|
|
},
|
|
"/goal_pose": {
|
|
"publisher_count": 1,
|
|
"subscriber_count": 3,
|
|
"publishers": [
|
|
{
|
|
"node_name": "foxglove_bridge",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/PoseStamped"
|
|
}
|
|
],
|
|
"subscribers": [
|
|
{
|
|
"node_name": "foxglove_bridge",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/PoseStamped"
|
|
},
|
|
{
|
|
"node_name": "goal_reach_debug_collector",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/PoseStamped"
|
|
},
|
|
{
|
|
"node_name": "grid_astar_theta_planner",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/PoseStamped"
|
|
}
|
|
]
|
|
},
|
|
"/plan": {
|
|
"publisher_count": 2,
|
|
"subscriber_count": 3,
|
|
"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": "foxglove_bridge",
|
|
"node_namespace": "/",
|
|
"topic_type": "nav_msgs/msg/Path"
|
|
},
|
|
{
|
|
"node_name": "goal_reach_debug_collector",
|
|
"node_namespace": "/",
|
|
"topic_type": "nav_msgs/msg/Path"
|
|
},
|
|
{
|
|
"node_name": "topology_pure_pursuit",
|
|
"node_namespace": "/",
|
|
"topic_type": "nav_msgs/msg/Path"
|
|
}
|
|
]
|
|
},
|
|
"/planner_cmd_vel": {
|
|
"publisher_count": 1,
|
|
"subscriber_count": 2,
|
|
"publishers": [
|
|
{
|
|
"node_name": "topology_pure_pursuit",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/Twist"
|
|
}
|
|
],
|
|
"subscribers": [
|
|
{
|
|
"node_name": "goal_reach_debug_collector",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/Twist"
|
|
},
|
|
{
|
|
"node_name": "planner_ackermann_cmd_bridge",
|
|
"node_namespace": "/",
|
|
"topic_type": "geometry_msgs/msg/Twist"
|
|
}
|
|
]
|
|
},
|
|
"/ackermann_cmd": {
|
|
"publisher_count": 1,
|
|
"subscriber_count": 2,
|
|
"publishers": [
|
|
{
|
|
"node_name": "planner_ackermann_cmd_bridge",
|
|
"node_namespace": "/",
|
|
"topic_type": "ackermann_msgs/msg/AckermannDriveStamped"
|
|
}
|
|
],
|
|
"subscribers": [
|
|
{
|
|
"node_name": "goal_reach_debug_collector",
|
|
"node_namespace": "/",
|
|
"topic_type": "ackermann_msgs/msg/AckermannDriveStamped"
|
|
},
|
|
{
|
|
"node_name": "origincar_base",
|
|
"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.08,
|
|
"goal_yaw_tolerance": 0.174533,
|
|
"require_goal_yaw": false,
|
|
"resolution": 0.1,
|
|
"yaw_bins": 36,
|
|
"primitive_length": 0.12,
|
|
"min_turning_radius": 0.25,
|
|
"heuristic_weight": 1.35,
|
|
"goal_yaw_heuristic_weight": 0.0,
|
|
"planning_timeout_ms": 1500.0,
|
|
"max_iterations": 200000
|
|
}
|
|
},
|
|
"tracker": {
|
|
"node": "/topology_pure_pursuit",
|
|
"service": "/topology_pure_pursuit/get_parameters",
|
|
"error": "parameter_query_timeout"
|
|
}
|
|
},
|
|
"latest": {
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan": {
|
|
"frame_id": "map",
|
|
"points": 73,
|
|
"length": 2.159568077753335,
|
|
"start": {
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0
|
|
},
|
|
"end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"reverse_segment_fraction": 0.0
|
|
},
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.11867636442184448,
|
|
"y": 0.010635286569595337,
|
|
"yaw": 0.23453302681446075,
|
|
"odom_age_sec": 0.043862951000000004,
|
|
"odom_linear_x": 0.08500000089406967,
|
|
"odom_angular_z": 0.21719703078269958
|
|
},
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.35
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5195767879486084
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)",
|
|
"last_plan_ok": {
|
|
"points": 73,
|
|
"iterations": 27,
|
|
"planning_ms": 158.885,
|
|
"goal_error": 0.049,
|
|
"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.632773400448115,
|
|
"y": 0.5507260302793314,
|
|
"yaw": 0.6000000000000002
|
|
},
|
|
{
|
|
"x": 0.6564589500922244,
|
|
"y": 0.5691085017215272,
|
|
"yaw": 0.7199999999999999
|
|
},
|
|
{
|
|
"x": 0.677773562092071,
|
|
"y": 0.590194227546424,
|
|
"yaw": 0.8400000000000002
|
|
},
|
|
{
|
|
"x": 0.6964106741746057,
|
|
"y": 0.6136799374886368,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.7136162737567794,
|
|
"y": 0.6382556845376668,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.7308218733389531,
|
|
"y": 0.6628314315866967,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.7480274729211268,
|
|
"y": 0.6874071786357266,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.7652330725033005,
|
|
"y": 0.7119829256847566,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.7824386720854742,
|
|
"y": 0.7365586727337866,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.799644271667648,
|
|
"y": 0.7611344197828165,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.8168498712498217,
|
|
"y": 0.7857101668318465,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.8340554708319954,
|
|
"y": 0.8102859138808765,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.8512610704141691,
|
|
"y": 0.8348616609299064,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.8684666699963428,
|
|
"y": 0.8594374079789363,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.8856722695785165,
|
|
"y": 0.8840131550279663,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.9028778691606902,
|
|
"y": 0.9085889020769963,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.920083468742864,
|
|
"y": 0.9331646491260263,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.9372890683250377,
|
|
"y": 0.9577403961750561,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.9544946679072114,
|
|
"y": 0.9823161432240861,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.9717002674893851,
|
|
"y": 1.006891890273116,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 0.9889058670715588,
|
|
"y": 1.031467637322146,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.0061114666537325,
|
|
"y": 1.056043384371176,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.0233170662359061,
|
|
"y": 1.0806191314202058,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.04052266581808,
|
|
"y": 1.1051948784692358,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.0577282654002536,
|
|
"y": 1.1297706255182658,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.0749338649824274,
|
|
"y": 1.1543463725672958,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.092139464564601,
|
|
"y": 1.1789221196163258,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.1093450641467748,
|
|
"y": 1.2034978666653555,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.1265506637289484,
|
|
"y": 1.2280736137143855,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.1437562633111222,
|
|
"y": 1.2526493607634155,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.1609618628932958,
|
|
"y": 1.2772251078124452,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.1781674624754697,
|
|
"y": 1.3018008548614752,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.1953730620576433,
|
|
"y": 1.3263766019105052,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.212578661639817,
|
|
"y": 1.3509523489595352,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.2297842612219907,
|
|
"y": 1.3755280960085652,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.2469898608041645,
|
|
"y": 1.400103843057595,
|
|
"yaw": 0.96
|
|
},
|
|
{
|
|
"x": 1.2656269728866993,
|
|
"y": 1.4235895529998077,
|
|
"yaw": 0.8399999999999999
|
|
},
|
|
{
|
|
"x": 1.2869415848865458,
|
|
"y": 1.4446752788247046,
|
|
"yaw": 0.7199999999999999
|
|
},
|
|
{
|
|
"x": 1.3106271345306553,
|
|
"y": 1.4630577502669004,
|
|
"yaw": 0.5999999999999999
|
|
},
|
|
{
|
|
"x": 1.3363429589940434,
|
|
"y": 1.4784725772343017,
|
|
"yaw": 0.48000000000000004
|
|
},
|
|
{
|
|
"x": 1.3637191945606417,
|
|
"y": 1.4906980524589644,
|
|
"yaw": 0.3600000000000001
|
|
},
|
|
{
|
|
"x": 1.3923620962726304,
|
|
"y": 1.4995583402524881,
|
|
"yaw": 0.24000000000000005
|
|
},
|
|
{
|
|
"x": 1.4218597010571843,
|
|
"y": 1.5049260055029472,
|
|
"yaw": 0.12000000000000005
|
|
},
|
|
{
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
}
|
|
]
|
|
},
|
|
"metrics": {
|
|
"sample_count": 292,
|
|
"goal_count": 2,
|
|
"plan_count": 1,
|
|
"planner_status_count": 3,
|
|
"tracker_status_count": 20,
|
|
"min_distance_to_goal": 2.0313203183689383,
|
|
"min_distance_to_plan_end": 2.0038630076200405,
|
|
"final_distance_to_goal": 2.0313203183689383,
|
|
"final_distance_to_plan_end": 2.0038630076200405,
|
|
"final_plan_end_to_goal": 0.04867885459522371,
|
|
"final_plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"max_abs_cmd_linear": 0.0875,
|
|
"max_abs_cmd_angular": 0.35,
|
|
"max_abs_ackermann_speed": 0.08749999850988388,
|
|
"max_abs_steering_angle": 0.5195767879486084,
|
|
"tf_failures": 49,
|
|
"saw_plan_ok": true,
|
|
"saw_plan_failed": false,
|
|
"saw_goal_reached": false,
|
|
"saw_align_goal_yaw": false,
|
|
"saw_no_recent_odom": true
|
|
},
|
|
"diagnostic_hints": [
|
|
"TF 查询失败 49 次；需要检查 map->odom 和 odom frame。"
|
|
],
|
|
"events": {
|
|
"goals": [
|
|
{
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
{
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
}
|
|
],
|
|
"plans": [
|
|
{
|
|
"frame_id": "map",
|
|
"points": 73,
|
|
"length": 2.159568077753335,
|
|
"start": {
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0
|
|
},
|
|
"end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"reverse_segment_fraction": 0.0,
|
|
"elapsed_sec": 27.445450109000376
|
|
}
|
|
],
|
|
"planner_status": [
|
|
{
|
|
"elapsed_sec": 27.219080243999997,
|
|
"data": "goal_received map=(1.500,1.500,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.22706172800099,
|
|
"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=0.000 goal_yaw_tolerance=0.175"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.45005268300156,
|
|
"data": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"parsed_plan_ok": {
|
|
"points": 73,
|
|
"iterations": 27,
|
|
"planning_ms": 158.885,
|
|
"goal_error": 0.049,
|
|
"yaw_error": 0.0
|
|
}
|
|
}
|
|
],
|
|
"tracker_status": [
|
|
{
|
|
"elapsed_sec": 2.593132850000984,
|
|
"data": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.8535808280012134,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.356866246000209,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.719682037000894,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.944820739001443,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.969680687001528,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.2113998960012395,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.522334170000249,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.637441390001186,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.024322924000444,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.296423153000433,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.445131720000063,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.557063739001023,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.574419452999791,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.7193697370003065,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.002432068000417,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.113605796999764,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.2257008150008915,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.237884956000926,
|
|
"data": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.827167610001197,
|
|
"data": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
}
|
|
]
|
|
},
|
|
"samples": [
|
|
{
|
|
"elapsed_sec": 0.7106968650005001,
|
|
"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.909991952999917,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.0404423090003547,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.2128142440014926,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.3229371409997839,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.435993283001153,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.5504503379997914,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.6596041540014994,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.7721790049999981,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.8915213000000222,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.0100181800007704,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.1262172309998277,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.2364412120005,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.35059614200145,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.4794665010012977,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.5891002750013286,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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.6998446289999265,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 2.8125919379999686,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 2.9369320969999535,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.0486827830009133,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.1583291400002054,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.26771266400101,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.2762970210005733,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.028726974
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.3923060310007713,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.407769791001556,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.061637364
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.599212728000566,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.7143792400001985,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.8282782550013508,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.8376192360010464,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.0415463640000002
|
|
},
|
|
"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": "ready graph_nodes=0 graph_edges=0 motion_enabled=True"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.986984093000501,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 3.999321693001548,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.0541438380000003
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.224384769000608,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.351772548001463,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.359415740000259,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.0618490720000002
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.384857562999969,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.035533542
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.603431360999821,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.715552296000169,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.825195402001555,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.937996919001307,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 4.947141734000979,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.0009222390000003
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": null,
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.085263115000998,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.197251175000929,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.207043780001186,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.048872265
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.388748571000178,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.512502482000855,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.629388323000967,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.744538419001401,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.857185061000564,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 5.864121546001115,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.0139852950000003
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.0012544710007205,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.009615828999813,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.014624169
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.180896183001096,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.2919432039998355,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.406480800000281,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": null,
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.552134540999759,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.560334857000271,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.062767777
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.681452565000654,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.6915979189998325,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "odom_too_old",
|
|
"age_sec": 2.044403232
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.888593012001365,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 6.9976364110007125,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.1087787650012615,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.2202140760000475,
|
|
"pose_map": {
|
|
"available": false,
|
|
"reason": "tf_unavailable",
|
|
"source_frame": "odom"
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": null,
|
|
"yaw_error_to_goal": null,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.23016559700045,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 1.8843320620000001,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.289559558001201,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 1.5882166340000001,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.384162529000605,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 1.132561159,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.486165151000023,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.590255863,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.583595325000715,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.08772386,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.679421251999884,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033476431,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.779366669999945,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033461222,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.881138751001345,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035341593000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 7.985326328000156,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.039384794,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.081462504000228,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035722385,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.178478595000342,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032082142,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.279607469001348,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033740805,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.380890468000871,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032968682,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.478513558000486,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.030361938,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.582611801000894,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035794801,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.680317349000688,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.030131646,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.781107266000618,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034882220000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.880735351000112,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034568554,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 8.985999800001082,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.040146959,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.086231676001262,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.040328084,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.179546483001104,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031956351,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.28123185700133,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035435636,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.378137198000331,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.030448354,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.482124399000895,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036041259,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.578903908000939,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033065099,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.680896363001011,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033595972,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.796014209001441,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.047910692000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.879704119000962,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03404343,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 9.98073799300073,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035002136,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.080112121000639,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033245931,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.178060919000927,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031677018,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.28731773400068,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036780174000000006,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.37856008700146,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032215267,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.47831154800042,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032614932,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.585595909000403,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.039735209,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.679433340001196,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033123432,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.786438827000893,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.040602166,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.880982257000142,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035176261,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 10.98031071800142,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034464595,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.078204766001363,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032432599,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.17884793200028,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.029418523000000002,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.298870851000174,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033952180000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.383845133999785,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.08611453000000001,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.478959478999968,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.066251988,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.586854255001526,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031187894,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.679032981001,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.08032083400000001,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.785704552001334,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.038196421,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.880264232000627,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.024470825,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 11.985671264001212,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034645262,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.07958207000047,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033748014,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.178216866001094,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032357058,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.280507612000292,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033299681000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.378387034999832,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.030390979000000002,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.478690078,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031744809,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.578371663001235,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032632308,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.678857996999795,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032963974,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.779058081001494,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033236890000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.87856841699977,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032638641,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 12.978907210001125,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033104640000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.07885954500125,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032745015,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.17817008900056,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.0324211,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.278453715000069,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032389058000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.378065300999879,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032319142,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.478146510000443,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032505224,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.578313762000107,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032610225,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.679354011001124,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.0322676,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.779013721999945,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03316264,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.878455391000898,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032732224000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 13.978256434000286,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032684974,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.08019343200067,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034526303,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.180878390001453,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035223593000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.278381522000927,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032220684,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.378073982001297,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032375558,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.478069901000708,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032438267,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.579286400001365,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033569014,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.678725027000837,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033028848,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.780370234000657,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03469847,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.879216778999762,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033488431,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 14.978424949000328,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032564766,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.079247199000747,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033408889000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.179983490001177,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034218096,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.280324533001476,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034582595,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.378307872000732,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032507766,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.481663116001073,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035654093000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.578266708000228,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031304852,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.678157627000473,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032382308000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.778555669001435,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032102725,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.880691791000572,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031711309,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 15.97918387900063,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033244139,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.078076883000904,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032496141,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.178926091000903,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033395181,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.27924538300067,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033292306,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.37868842700118,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032622058,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.480786508000165,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035060386,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.585643374000938,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.040004876,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.67978897100147,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033960138,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.779419640000924,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033811014,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.879573433001497,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033866305,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 16.97856756100009,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032964098000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.078138064000086,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031835143,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.180560976999914,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034928177000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.278454441000576,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032528141,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.381135687001006,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035405677,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.498812152000028,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.053006432000000006,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.595766076001382,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.049339606,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.681060525001158,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032529516,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.780298819001473,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034610928,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.887715806000415,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035529218,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 17.98680080899976,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.039523627000000006,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.08057053199991,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03162331,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.18227961299999,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036260175000000006,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.27864124700136,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032843515000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.37822745700032,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031709768,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.479000291001284,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033342056,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.578296793000845,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03138181,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.678604336000717,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032879223,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.77844512900083,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032797599000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.881983873001445,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032595641,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 18.97912546400039,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033506639000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.07942429800096,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033765888,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.178635051001038,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033028932000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.278184179000164,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032517975000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.37853892900057,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032931015,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.480242219000502,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034478345,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.578204766001363,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032646224,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.679034683000282,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033219306000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.778390227000273,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032745973000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.87827906200073,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032332975,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 19.979492394000772,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033859597000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.07906364700102,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033542597,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.17833660799988,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.026845194000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.278640775000895,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032912932,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.385646886999893,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.040032709,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.478400070000134,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032566599,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.57830753000053,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032633849,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.678327407000324,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032690974000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.77821211599985,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032411141000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.87829932600107,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032568433,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 20.982803568000236,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036727216,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.078615037000418,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032816557,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.178999620000468,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031091727000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.279831578000085,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034122429,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.382743741000013,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036746424,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.481449286000498,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035712426000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.579484792000585,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033731596,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.678401962000862,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032702682000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.780532876000507,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033482139,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.87941879600112,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03302714,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 21.9802921290011,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033893888000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.078730384000664,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033164223,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.187692991001313,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.042156204,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.278272012001253,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032658474,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.385601081999994,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036181884000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.485510542001066,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.039943917,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.58098088600127,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035539968000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.679263349000394,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033845721,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.778117269001086,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032554516,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.8790158110005,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033487056,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 22.978856937001183,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033298181,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.078202939999755,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032753641,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.178952857000695,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033337348,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.280948604000514,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035385551,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.37868681800137,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033120515,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.48139593900123,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035934259,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.578349072000492,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031861184,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.678389615000924,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032967974000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.78028436200111,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034836512,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.878809450001427,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033117682,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 23.979876782001156,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034297512,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.078215620000265,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.028550441000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.178065664000314,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032636932,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.280438368999967,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034805678,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.38011578700025,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034633678,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.478251167000053,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.031142060000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.585600820000764,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.037145464,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.688524066001264,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.042220579,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.782620703999783,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03718409,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.87936362900109,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.028532941000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 24.98393853700145,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.038334754000000006,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.0795138400008,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033790097000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.179389800001445,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033901513,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.27865046900115,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033089265,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.37889067800097,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033451306,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.479692595001325,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033602848000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.581575092001003,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.028969941000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.681670010000744,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.029375898,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.77883280900096,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033392139,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.88231651100068,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036435175,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 25.979315685000984,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033816389,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.080683351001426,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.024139866000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.182931806000852,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.037466673,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.281598143001247,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036120675000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.383759223001107,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032844224000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.51122058400142,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.065394989,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.602364979000413,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.09884292,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.73866707200068,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.080892458,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.7826075640005,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035930218,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.908563887000128,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.049520606,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 26.991885422999985,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.085185366,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.079570575000616,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033981138,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.182651570001326,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.036857549,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.282111739001266,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.029226815000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_start start=(0.000,0.000,0.000) goal=(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=0.000 goal_yaw_tolerance=0.175",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.3785048310001,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.025628114,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": null,
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": null,
|
|
"yaw_error_to_plan_end": null,
|
|
"plan_end_to_goal": null,
|
|
"plan_end_yaw_to_goal": null,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_start start=(0.000,0.000,0.000) goal=(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=0.000 goal_yaw_tolerance=0.175",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.481626826000138,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03417197,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 6.4131757030008885,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.579998496999906,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.026242070000000003,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.68972931100143,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.040081292000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.778555003000292,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.023285202,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0,
|
|
"angular_z": 0.0
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "stop no_recent_odom"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.878907002999767,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.028376358,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3211519741184705
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.0,
|
|
"steering_angle": 0.0
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 27.980000336001467,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033659930000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3211519741184705
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.4833326041698456
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.085642867001297,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035724384000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3211519741184705
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.4833326041698456
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.18085092000001,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.03499151,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1213203435596424,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.092344242504418,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3211519741184705
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.4833326041698456
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.27874042500116,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.00030875205993652344,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.024313616000000003,
|
|
"odom_linear_x": 0.006000000052154064,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1211020341200055,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.0921300245325667,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3211519741184705
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.4833326041698456
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.38086650600053,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.00030875205993652344,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.033897513000000004,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1211020341200055,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.0921300245325667,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3216699323247973
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.48399603366851807
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.481297131000247,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.00030875205993652344,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.035672426,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1211020341200055,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.0921300245325667,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3216699323247973
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.48399603366851807
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.578370638000706,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.00030875205993652344,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.032777057000000005,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1211020341200055,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.0921300245325667,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3216699323247973
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.48399603366851807
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.680646135000643,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.00030875205993652344,
|
|
"y": 0.0,
|
|
"yaw": 0.0,
|
|
"odom_age_sec": 0.034896053,
|
|
"odom_linear_x": 0.0,
|
|
"odom_angular_z": 0.0
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1211020341200055,
|
|
"yaw_error_to_goal": 0.0,
|
|
"distance_to_plan_end": 2.0921300245325667,
|
|
"yaw_error_to_plan_end": 5.551115123125783e-17,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3216699323247973
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.48399603366851807
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.780956010999944,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0009791851043701172,
|
|
"y": 0.0,
|
|
"yaw": 0.00012718055222649127,
|
|
"odom_age_sec": 0.035243511000000005,
|
|
"odom_linear_x": 0.013000000268220901,
|
|
"odom_angular_z": 0.0025399650912731886
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1206280681652685,
|
|
"yaw_error_to_goal": 0.00012718055222649127,
|
|
"distance_to_plan_end": 2.091664946892834,
|
|
"yaw_error_to_plan_end": 0.00012718055222643576,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3216699323247973
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.48399603366851807
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.879175641000984,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.005321204662322998,
|
|
"y": 9.834766387939453e-07,
|
|
"yaw": 0.00046674557961523533,
|
|
"odom_age_sec": 0.031727225000000005,
|
|
"odom_linear_x": 0.052000001072883606,
|
|
"odom_angular_z": 0.0034594223834574223
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.117560329908723,
|
|
"yaw_error_to_goal": 0.00046674557961523533,
|
|
"distance_to_plan_end": 2.088654892792812,
|
|
"yaw_error_to_plan_end": 0.0004667455796151798,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3287109969780504
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.4929688274860382
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 28.97853618500085,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.013254940509796143,
|
|
"y": 7.838010787963867e-06,
|
|
"yaw": 0.0031580436043441296,
|
|
"odom_age_sec": 0.032880057000000004,
|
|
"odom_linear_x": 0.08500000089406967,
|
|
"odom_angular_z": 0.03823578730225563
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1119629158552002,
|
|
"yaw_error_to_goal": 0.0031580436043441296,
|
|
"distance_to_plan_end": 2.0831634075656855,
|
|
"yaw_error_to_plan_end": 0.003158043604344074,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3424507753281647
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5102313160896301
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.078177604000302,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.02339226007461548,
|
|
"y": 5.911290645599365e-05,
|
|
"yaw": 0.013085326179862022,
|
|
"odom_age_sec": 0.032551141,
|
|
"odom_linear_x": 0.10400000214576721,
|
|
"odom_angular_z": 0.12265144288539886
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.1048023855893265,
|
|
"yaw_error_to_goal": 0.013085326179862022,
|
|
"distance_to_plan_end": 2.0761387967663762,
|
|
"yaw_error_to_plan_end": 0.013085326179861967,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3389084199464809
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5058119893074036
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.180684183000267,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.033731043338775635,
|
|
"y": 0.00023350119590759277,
|
|
"yaw": 0.030756238847970963,
|
|
"odom_age_sec": 0.034821303000000005,
|
|
"odom_linear_x": 0.09799999743700027,
|
|
"odom_angular_z": 0.1837136596441269
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.097437532848948,
|
|
"yaw_error_to_goal": 0.030756238847970963,
|
|
"distance_to_plan_end": 2.0689122726898357,
|
|
"yaw_error_to_plan_end": 0.030756238847970907,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.34920379975906524
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.518595814704895
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.28820183500102,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.04439741373062134,
|
|
"y": 0.0006121248006820679,
|
|
"yaw": 0.052682600915431976,
|
|
"odom_age_sec": 0.042011121000000005,
|
|
"odom_linear_x": 0.10400000214576721,
|
|
"odom_angular_z": 0.22221532464027405
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.089723160959085,
|
|
"yaw_error_to_goal": 0.052682600915431976,
|
|
"distance_to_plan_end": 2.061339391048539,
|
|
"yaw_error_to_plan_end": 0.05268260091543192,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.35
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5195767879486084
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.382360807001533,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.053907811641693115,
|
|
"y": 0.0011550486087799072,
|
|
"yaw": 0.07480259239673613,
|
|
"odom_age_sec": 0.023877534000000002,
|
|
"odom_linear_x": 0.09799999743700027,
|
|
"odom_angular_z": 0.23624645173549652
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.0827190894457814,
|
|
"yaw_error_to_goal": 0.07480259239673612,
|
|
"distance_to_plan_end": 2.0544599619893473,
|
|
"yaw_error_to_plan_end": 0.07480259239673606,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.34004770436434734
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5072357058525085
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.48006873000122,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.06397747993469238,
|
|
"y": 0.001950100064277649,
|
|
"yaw": 0.09859219938516615,
|
|
"odom_age_sec": 0.033840888,
|
|
"odom_linear_x": 0.09799999743700027,
|
|
"odom_angular_z": 0.23814299702644348
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.0751660610255134,
|
|
"yaw_error_to_goal": 0.09859219938516615,
|
|
"distance_to_plan_end": 2.0470372204168448,
|
|
"yaw_error_to_plan_end": 0.0985921993851661,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3472147879902659
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.516140341758728
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.578285442999913,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.07401776313781738,
|
|
"y": 0.002982497215270996,
|
|
"yaw": 0.12209369987249376,
|
|
"odom_age_sec": 0.032385808,
|
|
"odom_linear_x": 0.09799999743700027,
|
|
"odom_angular_z": 0.2342216968536377
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.06748319061856,
|
|
"yaw_error_to_goal": 0.12209369987249377,
|
|
"distance_to_plan_end": 2.0394823339023938,
|
|
"yaw_error_to_plan_end": 0.12209369987249372,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.35
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5195767879486084
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.6784410270011,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0830010175704956,
|
|
"y": 0.004113733768463135,
|
|
"yaw": 0.14535771310329437,
|
|
"odom_age_sec": 0.031785642,
|
|
"odom_linear_x": 0.08500000089406967,
|
|
"odom_angular_z": 0.23238372802734375
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.060476119178861,
|
|
"yaw_error_to_goal": 0.14535771310329437,
|
|
"distance_to_plan_end": 2.0325880738013242,
|
|
"yaw_error_to_plan_end": 0.14535771310329432,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.35
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5195767879486084
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.780607024000346,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.0919528603553772,
|
|
"y": 0.005451321601867676,
|
|
"yaw": 0.1678539216518402,
|
|
"odom_age_sec": 0.033855347,
|
|
"odom_linear_x": 0.09099999815225601,
|
|
"odom_angular_z": 0.22311070561408997
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.0533563985735666,
|
|
"yaw_error_to_goal": 0.1678539216518402,
|
|
"distance_to_plan_end": 2.0255789614474216,
|
|
"yaw_error_to_plan_end": 0.16785392165184015,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3368720694377304
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5032616853713989
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.878788738000367,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.10117357969284058,
|
|
"y": 0.007035583257675171,
|
|
"yaw": 0.19032199680805206,
|
|
"odom_age_sec": 0.032942182,
|
|
"odom_linear_x": 0.09099999815225601,
|
|
"odom_angular_z": 0.22539964318275452
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.0458880965996387,
|
|
"yaw_error_to_goal": 0.19032199680805206,
|
|
"distance_to_plan_end": 2.0182228647594025,
|
|
"yaw_error_to_plan_end": 0.190321996808052,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.3437659587389417
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.507893443107605
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 29.97981227800119,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.11018162965774536,
|
|
"y": 0.008787423372268677,
|
|
"yaw": 0.2128641456365585,
|
|
"odom_age_sec": 0.033915930000000004,
|
|
"odom_linear_x": 0.08500000089406967,
|
|
"odom_angular_z": 0.22164086997509003
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.0384577629260603,
|
|
"yaw_error_to_goal": 0.2128641456365585,
|
|
"distance_to_plan_end": 2.0109004246150173,
|
|
"yaw_error_to_plan_end": 0.21286414563655845,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.34960583694892405
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5190912485122681
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
},
|
|
{
|
|
"elapsed_sec": 30.078387158000623,
|
|
"pose_map": {
|
|
"available": true,
|
|
"frame_id": "map",
|
|
"source_frame": "odom",
|
|
"x": 0.11867636442184448,
|
|
"y": 0.010635286569595337,
|
|
"yaw": 0.23453302681446075,
|
|
"odom_age_sec": 0.032802557,
|
|
"odom_linear_x": 0.08500000089406967,
|
|
"odom_angular_z": 0.21719703078269958
|
|
},
|
|
"goal": {
|
|
"elapsed_sec": 27.51953966400106,
|
|
"frame_id": "map",
|
|
"x": 1.5,
|
|
"y": 1.5,
|
|
"yaw": 0.0
|
|
},
|
|
"plan_end": {
|
|
"x": 1.451787752879414,
|
|
"y": 1.5067238465394808,
|
|
"yaw": 5.551115123125783e-17
|
|
},
|
|
"distance_to_goal": 2.0313203183689383,
|
|
"yaw_error_to_goal": 0.23453302681446075,
|
|
"distance_to_plan_end": 2.0038630076200405,
|
|
"yaw_error_to_plan_end": 0.2345330268144607,
|
|
"plan_end_to_goal": 0.04867885459522371,
|
|
"plan_end_yaw_to_goal": 5.551115123125783e-17,
|
|
"cmd_vel": {
|
|
"linear_x": 0.0875,
|
|
"angular_z": 0.35
|
|
},
|
|
"ackermann_cmd": {
|
|
"speed": 0.08749999850988388,
|
|
"steering_angle": 0.5195767879486084
|
|
},
|
|
"planner_status": "plan_ok hybrid_astar points=73 iterations=27 obstacles=0 planning_ms=158.885 goal_error=0.049 yaw_error=0.000",
|
|
"tracker_status": "external_plan_ok points=73 length=2.160 goal=(1.452,1.507,0.000)"
|
|
}
|
|
]
|
|
} |