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