diff --git a/Readme.md b/Readme.md index 0391cc3..b8180f8 100644 --- a/Readme.md +++ b/Readme.md @@ -1,5 +1,5 @@ # auto drive misson center webots simulation: -该分支修复了原LQR算法中矩阵错误问题，并对参数进行调教，增加stanley前轮转向控制算法，并适配webots仿真环境。后续实车测试优先使用该分支 +lhy本地控制测试分支，无本地控制测试需求请勿使用 ## 1, `ubuntu20.04`, `ubuntu22.04` ## 2, 安装 `webots` `https://github.com/cyberbotics/webots/tags`， 版本： `ubuntu20.04： R2023a， ubuntu22.04：R2025a` diff --git a/pp_stanley_plot_path_tracking_error.py b/error_calculate.py similarity index 92% rename from pp_stanley_plot_path_tracking_error.py rename to error_calculate.py index e6275c4..c900348 100644 --- a/pp_stanley_plot_path_tracking_error.py +++ b/error_calculate.py @@ -10,12 +10,12 @@ import matplotlib.pyplot as plt # 参数 # ============================================================ -LOG_PATTERN = "logs/mission_center_logger*.txt" +LOG_PATTERN = "path_visualizer.log" # 每 5 个完整数据取 1 个 -SAMPLE_STEP = 40 +SAMPLE_STEP = 1 -CSV_FILE = "recalculated_tracking_error.csv" +CSV_FILE = "tracking_error.csv" # ============================================================ @@ -74,6 +74,9 @@ current_path_pattern = re.compile( r"current_path_yaw:([-+0-9.eE]+)" ) +yaw_command_pattern = re.compile( + r"current_cmd_angular_z:([-+0-9.eE]+)" +) # ============================================================ # 3. 函数：角度归一化 @@ -178,6 +181,7 @@ def calculate_errors( # ============================================================ all_data = [] +yaw_command_data = [] total_raw_count = 0 @@ -202,6 +206,7 @@ for file in files: # -------------------------------------------------------- pending_pose = None + pending_yaw = None with file.open( @@ -222,7 +227,11 @@ for file in files: line ) - + m_yaw = yaw_command_pattern.search(line) + if m_yaw: + pending_yaw = float(m_yaw.group(1)) + if file_data_count % SAMPLE_STEP == 0: + yaw_command_data.append(pending_yaw) if m_pose: pending_pose = { @@ -351,6 +360,7 @@ for file in files: pending_pose = None + print( f"原始完整数据：{file_data_count}" ) @@ -447,6 +457,12 @@ alpha_deg = np.array([ for d in all_data ]) +yaw_command = yaw_command_data# 确保长度一致 + +print( + f"yaw size: {len(yaw_command)}" +) + # ============================================================ # 8. 计算车辆累计行驶距离 @@ -524,13 +540,16 @@ with open( "heading_error_deg", + "yaw_command", + ]) for i in range( len(all_data) ): - + if i>= len(yaw_command): + break writer.writerow([ f"{distance_m[i]:.8f}", @@ -545,6 +564,8 @@ with open( f"{alpha_deg[i]:.8f}", + f"{yaw_command[i]:.8f}" + ]) @@ -630,7 +651,43 @@ plt.grid(True) plt.tight_layout() plt.show() +# ============================================================ +# 14. yaw command rad +# ============================================================ +plt.figure( + figsize=(12, 5) +) + +plt.plot( + distance_m, + yaw_command, + linewidth=1.2 +) + +plt.axhline( + 0.0, + linestyle="--", + linewidth=0.8 +) + +plt.xlabel( + "Distance (m)" +) + +plt.ylabel( + "Yaw Command (rad)" +) + +plt.title( + "Recalculated Yaw Command" +) + +plt.grid(True) + +plt.tight_layout() + +plt.show() # ============================================================ # 15. 车辆轨迹 + 路径点 diff --git a/pp_lqr_stanley_error.py b/error_comparsion.py similarity index 52% rename from pp_lqr_stanley_error.py rename to error_comparsion.py index 6a24435..fc62bdc 100644 --- a/pp_lqr_stanley_error.py +++ b/error_comparsion.py @@ -1,50 +1,67 @@ import csv import os +import re import matplotlib.pyplot as plt import numpy as np +import glob files = [ - "U_turn_0.32_lqr.csv", - "U_turn_0.32_pp.csv", - "U_turn_0.32_stanley.csv", + "stanley_*_*_*_*.csv", ] data = {} +for pattern in files: -for file in files: - if not os.path.exists(file): - raise FileNotFoundError(f"找不到文件: {file}") + matched_files = glob.glob(pattern) - distance = [] - lateral_error = [] - heading_error = [] - yaw_command = [] + if not matched_files: + raise FileNotFoundError( + f"找不到文件: {pattern}" + ) + matched_files.sort( + key=lambda x: ( + float(x.split("_")[1]), # 速度 + float(x.split("_")[2]), # 参数1 + float(x.split("_")[3]), # 参数2 + float(x.split("_")[4].replace(".csv", "")) # 半径 + ) + ) - with open(file, "r", encoding="utf-8-sig", newline="") as f: - reader = csv.DictReader(f) + print(f"匹配到 {len(matched_files)} 个文件:") + for file in matched_files: + if not os.path.exists(file): + raise FileNotFoundError(f"找不到文件: {file}") - required = {"distance_m", "lateral_error_m", "heading_error_rad","yaw_command"} - if not required.issubset(reader.fieldnames or []): - raise ValueError( - f"{file} 缺少必要列，需要: {required}，实际列: {reader.fieldnames}" - ) + distance = [] + lateral_error = [] + heading_error = [] + yaw_command = [] - for row in reader: - try: - distance.append(float(row["distance_m"])) - lateral_error.append(abs(float(row["lateral_error_m"]))) - heading_error.append(abs(float(row["heading_error_rad"]))) - yaw_command.append(float(row["yaw_command"])) - except (ValueError, TypeError): - continue + with open(file, "r", encoding="utf-8-sig", newline="") as f: + reader = csv.DictReader(f) - name = os.path.splitext(os.path.basename(file))[0] - data[name] = { - "distance": distance, - "lateral_error": lateral_error, - "heading_error": heading_error, - "yaw_command": yaw_command, - } + required = {"distance_m", "lateral_error_m", "heading_error_rad","yaw_command"} + if not required.issubset(reader.fieldnames or []): + raise ValueError( + f"{file} 缺少必要列，需要: {required}，实际列: {reader.fieldnames}" + ) + + for row in reader: + try: + distance.append(float(row["distance_m"])) + lateral_error.append(abs(float(row["lateral_error_m"]))) + heading_error.append(abs(float(row["heading_error_rad"]))) + yaw_command.append(float(row["yaw_command"])) + except (ValueError, TypeError): + continue + + name = os.path.splitext(os.path.basename(file))[0] + data[name] = { + "distance": distance, + "lateral_error": lateral_error, + "heading_error": heading_error, + "yaw_command": yaw_command, + } # 颜色由 matplotlib 自动分配，不手动指定 names = list(data.keys()) @@ -56,21 +73,20 @@ plt.figure(figsize=(12, 6)) for name in names: plt.plot( - data[name]["distance"], - data[name]["lateral_error"], + data[name]["distance"][::15], + data[name]["lateral_error"][::15], label=name, linewidth=1.5, ) - plt.xlabel("Distance (m)") plt.ylabel("Lateral Error (m)") plt.title("Lateral Error Comparison") plt.grid(True, alpha=0.3) -plt.legend(["LQR", "Pure Pursuit", "Stanley"]) +plt.legend() plt.tight_layout() -lateral_output = "U_turn_lateral_error_comparison.png" +lateral_output = "Lateral_error_comparison.png" plt.savefig(lateral_output, dpi=200) plt.show() @@ -92,10 +108,10 @@ plt.xlabel("Distance (m)") plt.ylabel("Heading Error (rad)") plt.title("Heading Error Comparison") plt.grid(True, alpha=0.3) -plt.legend(["LQR", "Pure Pursuit", "Stanley"]) +plt.legend() plt.tight_layout() -heading_output = "U_turn_heading_error_comparison.png" +heading_output = "Heading_error_comparison.png" plt.savefig(heading_output, dpi=200) plt.show() @@ -118,10 +134,10 @@ plt.xlabel("Distance (m)") plt.ylabel("Yaw Command (rad)") plt.title("Yaw Command Comparison") plt.grid(True, alpha=0.3) -plt.legend(["LQR", "Pure Pursuit", "Stanley"]) +plt.legend() plt.tight_layout() -yaw_output = "U_turn_yaw_command_comparison.png" +yaw_output = "Yaw_command_comparison.png" plt.savefig(yaw_output, dpi=200) plt.show() print("读取完成：") @@ -134,7 +150,7 @@ print(heading_output) print(yaw_output) -print("\n" + "=" * 100) +print("\n" + "=" * 90) print( f"{'Controller':<20}" f"{'Lat Max(m)':>12}" diff --git a/lqr_plot_path_tracking_error.py b/lqr_plot_path_tracking_error.py deleted file mode 100644 index 218f62f..0000000 --- a/lqr_plot_path_tracking_error.py +++ /dev/null @@ -1,355 +0,0 @@ -#!/usr/bin/env python3 -# -*- coding: utf-8 -*- - -""" -读取当前目录下： - mission_center_logger.txt - mission_center_logger1.txt - mission_center_logger2.txt - ... - -从 [path_follow] 日志中提取： - LQR: dis=..., alpha=... - path controller, current pose point:x:..., y:..., yaw:... - -绘制： - 1. 横向误差 dis 随实际行驶路程变化 - 2. 航向误差 alpha 随实际行驶路程变化 - -说明： -- dis：按你日志中的 LQR dis，单位通常是 m -- alpha：按你日志中的 alpha，单位是 rad -- 路程：根据连续 current pose 的 x/y 计算累计行驶距离 -- 日志中同一时刻可能重复打印多次，因此脚本会保留数据， - 但累计距离对相同位置不会增加。 -""" - -import re -from pathlib import Path - -import numpy as np -import matplotlib.pyplot as plt - - -# ============================================================ -# 1. 日志文件 -# ============================================================ - -LOG_PATTERN = "logs/mission_center_logger*.txt" - -files = sorted(Path(".").glob(LOG_PATTERN)) - -if not files: - raise FileNotFoundError( - f"当前目录没有找到 {LOG_PATTERN}" - ) - -print("找到日志文件：") -for f in files: - print(" ", f) - - -# ============================================================ -# 2. 正则表达式 -# ============================================================ - -# LQR: -# [LQR: dis=0.001038186, alpha=-0.003193076, ... -lqr_pattern = re.compile( - r"\[LQR:\s*" - r"dis=([-+0-9.eE]+),\s*" - r"alpha=([-+0-9.eE]+)" -) - -# current pose: -# [path controller, current pose point:x:24.68, y:1.16, yaw:0.026; -pose_pattern = re.compile( - r"current pose point:x:([-+0-9.eE]+),\s*" - r"y:([-+0-9.eE]+),\s*" - r"yaw:([-+0-9.eE]+)" -) - -yaw_command_pattern = re.compile( - r"PP output angular=([-+0-9.eE]+)" -) - -# ============================================================ -# 3. 读取日志 -# ============================================================ - -all_data = [] - -for file in files: - print(f"\n读取：{file}") - - pending_lqr = None - pending_yaw = None - - with file.open("r", encoding="utf-8", errors="ignore") as f: - for line in f: - - # ---- LQR误差 ---- - m_lqr = lqr_pattern.search(line) - if m_lqr: - dis = float(m_lqr.group(1)) - alpha = float(m_lqr.group(2)) - - pending_lqr = { - "dis": dis, - "alpha": alpha, - } - - # ---- 当前车辆位置 ---- - m_pose = pose_pattern.search(line) - m_yaw = yaw_command_pattern.search(line) - if m_yaw: - pending_yaw = float(m_yaw.group(1)) - if m_pose and pending_lqr is not None: - - x = float(m_pose.group(1)) - y = float(m_pose.group(2)) - yaw = float(m_pose.group(3)) - - - all_data.append({ - "file": file.name, - "x": x, - "y": y, - "yaw": yaw, - "dis": pending_lqr["dis"], - "alpha": pending_lqr["alpha"], - "yaw_command": pending_yaw, - }) - - pending_lqr = None - - -if not all_data: - raise RuntimeError( - "没有解析到数据，请检查日志格式是否和示例一致。" - ) - - -print(f"\n总共解析 {len(all_data)} 个数据点") - - -# ============================================================ -# 4. 根据 x/y 计算实际行驶路程 -# ============================================================ - -x = np.array([d["x"] for d in all_data]) -y = np.array([d["y"] for d in all_data]) - -dis = np.array([d["dis"] for d in all_data]) -alpha = np.array([d["alpha"] for d in all_data]) -yaw_command = np.array([d["yaw_command"] for d in all_data]) - -# 连续位置之间的距离 -step_distance = np.sqrt( - np.diff(x) ** 2 + - np.diff(y) ** 2 -) - -# 累计路程 -distance = np.zeros(len(x)) - -if len(x) > 1: - distance[1:] = np.cumsum(step_distance) - - -# ============================================================ -# 5. 如果希望横向误差取绝对值，可以取消下面注释 -# ============================================================ - -# dis = np.abs(dis) - -# 注意： -# 不建议默认取绝对值。 -# 保留正负号可以观察车辆是在路径左侧还是右侧。 - - -# ============================================================ -# 6. 输出基本统计信息 -# ============================================================ - -print("\n========== 误差统计 ==========") - -print( - f"总行驶距离 : {distance[-1]:.3f} m" -) - -print( - f"横向误差最大值 : {np.max(dis):.6f} m" -) - -print( - f"横向误差最小值 : {np.min(dis):.6f} m" -) - -print( - f"横向误差绝对最大: {np.max(np.abs(dis)):.6f} m" -) - -print( - f"横向误差 RMS : {np.sqrt(np.mean(dis ** 2)):.6f} m" -) - -print( - f"航向误差最大值 : {np.max(alpha):.6f} rad " - f"({np.degrees(np.max(alpha)):.3f} deg)" -) - -print( - f"航向误差最小值 : {np.min(alpha):.6f} rad " - f"({np.degrees(np.min(alpha)):.3f} deg)" -) - -print( - f"航向误差绝对最大: {np.max(np.abs(alpha)):.6f} rad " - f"({np.degrees(np.max(np.abs(alpha))):.3f} deg)" -) - -print( - f"航向误差 RMS : {np.sqrt(np.mean(alpha ** 2)):.6f} rad " - f"({np.degrees(np.sqrt(np.mean(alpha ** 2))):.3f} deg)" -) - - -# ============================================================ -# 7. 转换航向误差为角度 -# ============================================================ - -alpha_deg = np.degrees(alpha) - - -# ============================================================ -# 8. 图1：横向误差 -# ============================================================ - -plt.figure(figsize=(12, 5)) - -plt.plot( - distance, - dis, - linewidth=2.0 -) - -plt.axhline( - 0.0, - linestyle="--", - linewidth=0.8 -) - -plt.xlabel("Travel Distance (m)") -plt.ylabel("Lateral Error dis (m)") -plt.title("Lateral Error vs Travel Distance") -plt.grid(True, alpha=0.3) - -plt.tight_layout() - -plt.savefig( - "lateral_error_vs_distance.png", - dpi=200 -) - -plt.show() - - -# ============================================================ -# 9. 图2：航向误差 -# ============================================================ - -plt.figure(figsize=(12, 5)) - -plt.plot( - distance, - alpha_deg, - linewidth=2.0 -) - -plt.axhline( - 0.0, - linestyle="--", - linewidth=0.8 -) - -plt.xlabel("Travel Distance (m)") -plt.ylabel("Heading Error alpha (deg)") -plt.title("Heading Error vs Travel Distance") -plt.grid(True, alpha=0.3) - -plt.tight_layout() - -plt.savefig( - "heading_error_vs_distance.png", - dpi=200 -) - -plt.show() - -# ============================================================ -# 13. 航向误差 rad -# ============================================================ - -plt.figure( - figsize=(12, 5) -) - -plt.plot( - distance, - yaw_command, - linewidth=1.2 -) - -plt.axhline( - 0.0, - linestyle="--", - linewidth=0.8 -) - -plt.xlabel( - "Distance (m)" -) - -plt.ylabel( - "Yaw Command (rad)" -) - -plt.title( - "Recalculated Yaw Command" -) - -plt.grid(True) - -plt.tight_layout() - -plt.show() -# ============================================================ -# 10. 同时保存 CSV，方便后续 MATLAB / Excel 分析 -# ============================================================ - -output = np.column_stack( - ( - distance, - x, - y, - dis, - alpha, - alpha_deg, - yaw_command, - ) -) - -np.savetxt( - "path_tracking_error.csv", - output, - delimiter=",", - header="distance_m,x_m,y_m,lateral_error_m,heading_error_rad,heading_error_deg,yaw_command", - comments="", - fmt="%.8f" -) - -print("\n输出文件：") -print(" lateral_error_vs_distance.png") -print(" heading_error_vs_distance.png") -print(" path_tracking_error.csv") diff --git a/path_generate_json.py b/path_generate_json.py new file mode 100644 index 0000000..0f9293c --- /dev/null +++ b/path_generate_json.py @@ -0,0 +1,224 @@ +import json +import math +import matplotlib.pyplot as plt + +# ============================================================ +# 参数配置 +# ============================================================ + +# 起点：采用你提供的第一个路径点 +START_LAT = 30.80062100422322 +START_LON = 121.21541599992909 + +TURN_RADIUS = 1.0 +MISSION_SPEED = 0.64 +ARC_SPACING = 0.3 + +# stanley para +K_YAW = 2.0 +K_LAT = 4.0 + +# 地球半径（m） +EARTH_RADIUS = 6378137.0 + + +# +first_line_length = 6.0 +first_arc_rad = math.pi # 180° 半圆 + +second_line_length = 8.0 +second_arc_rad = math.pi / 2 # 90° 四分之一圆 + +third_line_length = 5.0 + + + +# ============================================================ +# 工具函数 +# ============================================================ + +def normalize_yaw(yaw): + """将 yaw 归一化到 [-pi, pi]。""" + return math.atan2(math.sin(yaw), math.cos(yaw)) + + +def local_to_latlon(x, y): + """ + 局部 ENU 坐标转经纬度。 + x: East，向东为正，单位 m + y: North，向北为正，单位 m + """ + lat0 = math.radians(START_LAT) + + lat = START_LAT + math.degrees(y / EARTH_RADIUS) + lon = START_LON + math.degrees( + x / (EARTH_RADIUS * math.cos(lat0)) + ) + + return lat, lon + + +def add_point(points, x, y, yaw): + """添加一个 [latitude, longitude, yaw] 路径点。""" + lat, lon = local_to_latlon(x, y) + + points.append([ + round(lat, 12), + round(lon, 12), + round(normalize_yaw(yaw), 9) + ]) + + +def add_arc(points, cx, cy, radius, + start_angle, sweep_angle, spacing): + """ + 添加圆弧采样点，不重复添加圆弧起点。 + yaw 为圆弧的切线方向，单位 rad。 + """ + arc_length = abs(radius * sweep_angle) + num_segments = max(1, math.ceil(arc_length / spacing)) + + for i in range(1, num_segments + 1): + ratio = i / num_segments + angle = start_angle + sweep_angle * ratio + + x = cx + radius * math.cos(angle) + y = cy + radius * math.sin(angle) + + # CCW 左转时，切线方向 = 圆心角 + pi/2 + yaw = angle + ( + math.pi / 2 if sweep_angle > 0 + else -math.pi / 2 + ) + + add_point(points, x, y, yaw) + + + +coordinates = [] + +# 1. 第一段直线：长度 6 m +# 起点 (0, 0)，终点 (6, 0) +add_point(coordinates, 0, 0, 0.0) +add_point(coordinates, first_line_length, 0, 0.0) + +# 第一段圆弧起始索引 +first_turn_index = len(coordinates) - 1 + +# 2. 第一段半圆：R=1，逆时针 180° +# 圆心 (6, 1)，从 -90° 转到 90° +add_arc( + coordinates, + cx=first_line_length, + cy=TURN_RADIUS, + radius=TURN_RADIUS, + start_angle=-math.pi / 2, + sweep_angle= first_arc_rad, + spacing=ARC_SPACING +) + +# 3. 第二段直线：长度 8 m +# 半圆终点 (6, 2)，直线终点 (-2, 2) +second_line_end_x = first_line_length - second_line_length +second_line_end_y = 2 * TURN_RADIUS + +add_point( + coordinates, + second_line_end_x, + second_line_end_y, + math.pi +) +# 第二段圆弧起始索引 +second_turn_index = len(coordinates) - 1 + +# 4. 第二段四分之一圆：顺时针 90° +# 与第一段圆弧方向相反 +second_arc_cx = second_line_end_x +second_arc_cy = second_line_end_y + TURN_RADIUS + +add_arc( + coordinates, + cx=second_arc_cx, + cy=second_arc_cy, + radius=TURN_RADIUS, + start_angle=-math.pi / 2, + sweep_angle=-second_arc_rad, + spacing=ARC_SPACING +) + +# 5. 最后一段直线：长度 5 m + +third_line_start_x = second_arc_cx +third_line_start_y = second_arc_cy + +add_point( + coordinates, + third_line_start_x - TURN_RADIUS, + third_line_start_y + third_line_length, + math.pi / 2 +) + + +# ============================================================ +# 构造符合现有项目的 GeoJSON +# ============================================================ + +path_json = { + "type": "FeatureCollection", + "properties": { + "turnRadius": TURN_RADIUS, + "misionSpeed": MISSION_SPEED, + "k_yaw": K_YAW, + "k_lat": K_LAT + }, + "features": [ + { + "type": "Feature", + "properties": { + "turnInds": [ + first_turn_index, + second_turn_index + ], + "mission": [], + + }, + "geometry": { + "type": "LineString", + "coordinates": coordinates + } + } + ] +} + + +# ============================================================ +# 保存文件 +# ============================================================ + +output_file = "test_path.json" + +with open(output_file, "w", encoding="utf-8") as f: + json.dump( + path_json, + f, + ensure_ascii=False, + indent=2 + ) + +print(f"JSON 文件已生成: {output_file}") +print(f"路径点数量: {len(coordinates)}") +print(f"turnInds: {path_json['features'][0]['properties']['turnInds']}") +print(f"起点: {coordinates[0]}") +print(f"终点: {coordinates[-1]}") + + +fig, ax = plt.subplots(figsize=(10, 6)) +ax.plot([p[0] for p in coordinates], [p[1] for p in coordinates], "-o", markersize=3, label="Path") + +ax.set_xlabel("X (m)") +ax.set_ylabel("Y (m)") +ax.axis("equal") +ax.grid(True) +ax.legend() +plt.tight_layout() +plt.show() \ No newline at end of file diff --git a/path_visualizer.log b/path_visualizer.log new file mode 100644 index 0000000..a245410 --- /dev/null +++ b/path_visualizer.log @@ -0,0 +1,3373 @@ +[2026-10-05 17:28:36.617] [path_visualizer] [info] PathVisualizer started +[2026-10-05 17:28:47.117] [path_visualizer] [debug] current_pose_x:0.0, current_pose_y:0.0,current_pose_yaw:-7.77364220994059e-06 +[2026-10-05 17:28:47.117] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.117] [path_visualizer] [debug] current_cmd_angular_z:1.554728441988118e-05 +[2026-10-05 17:28:47.167] [path_visualizer] [debug] current_pose_x:0.0, current_pose_y:0.0,current_pose_yaw:-7.77364220994059e-06 +[2026-10-05 17:28:47.167] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.167] [path_visualizer] [debug] current_cmd_angular_z:1.554728441988118e-05 +[2026-10-05 17:28:47.217] [path_visualizer] [debug] current_pose_x:0.00040875952264720163, current_pose_y:0.001893158832196767,current_pose_yaw:-1.0885819392569829e-05 +[2026-10-05 17:28:47.217] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.217] [path_visualizer] [debug] current_cmd_angular_z:-0.011810436551433 +[2026-10-05 17:28:47.266] [path_visualizer] [debug] current_pose_x:0.00040875952264720163, current_pose_y:0.001893158832196767,current_pose_yaw:-1.0885819392569829e-05 +[2026-10-05 17:28:47.267] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.267] [path_visualizer] [debug] current_cmd_angular_z:-0.011810436551433 +[2026-10-05 17:28:47.317] [path_visualizer] [debug] current_pose_x:0.00040875952264720163, current_pose_y:0.001893158832196767,current_pose_yaw:-1.0885819392569829e-05 +[2026-10-05 17:28:47.317] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.317] [path_visualizer] [debug] current_cmd_angular_z:-0.011810436551433 +[2026-10-05 17:28:47.366] [path_visualizer] [debug] current_pose_x:0.006849384323631301, current_pose_y:0.002783643233887732,current_pose_yaw:-1.1937181625398807e-05 +[2026-10-05 17:28:47.366] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.366] [path_visualizer] [debug] current_cmd_angular_z:-0.017373786141480524 +[2026-10-05 17:28:47.416] [path_visualizer] [debug] current_pose_x:0.006849384323631301, current_pose_y:0.002783643233887732,current_pose_yaw:-1.1937181625398807e-05 +[2026-10-05 17:28:47.416] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.416] [path_visualizer] [debug] current_cmd_angular_z:-0.017373786141480524 +[2026-10-05 17:28:47.466] [path_visualizer] [debug] current_pose_x:0.023286462104763768, current_pose_y:0.0034100243928639235,current_pose_yaw:-1.2379937288642395e-05 +[2026-10-05 17:28:47.466] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.467] [path_visualizer] [debug] current_cmd_angular_z:-0.02128769090033863 +[2026-10-05 17:28:47.516] [path_visualizer] [debug] current_pose_x:0.023286462104763768, current_pose_y:0.0034100243928639235,current_pose_yaw:-1.2379937288642395e-05 +[2026-10-05 17:28:47.517] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.517] [path_visualizer] [debug] current_cmd_angular_z:-0.02128769090033863 +[2026-10-05 17:28:47.567] [path_visualizer] [debug] current_pose_x:0.023286462104763768, current_pose_y:0.0034100243928639235,current_pose_yaw:-1.2379937288642395e-05 +[2026-10-05 17:28:47.567] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.567] [path_visualizer] [debug] current_cmd_angular_z:-0.02128769090033863 +[2026-10-05 17:28:47.617] [path_visualizer] [debug] current_pose_x:0.04975470592334748, current_pose_y:0.004042840720907999,current_pose_yaw:-1.2535527275758797e-05 +[2026-10-05 17:28:47.617] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.617] [path_visualizer] [debug] current_cmd_angular_z:-0.025242347366756925 +[2026-10-05 17:28:47.667] [path_visualizer] [debug] current_pose_x:0.04975470592334748, current_pose_y:0.004042840720907999,current_pose_yaw:-1.2535527275758797e-05 +[2026-10-05 17:28:47.667] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.667] [path_visualizer] [debug] current_cmd_angular_z:-0.025242347366756925 +[2026-10-05 17:28:47.716] [path_visualizer] [debug] current_pose_x:0.08627308869187271, current_pose_y:0.004792172324434695,current_pose_yaw:-1.2578233508975245e-05 +[2026-10-05 17:28:47.716] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.717] [path_visualizer] [debug] current_cmd_angular_z:-0.02992536082696012 +[2026-10-05 17:28:47.766] [path_visualizer] [debug] current_pose_x:0.08627308869187271, current_pose_y:0.004792172324434695,current_pose_yaw:-1.2578233508975245e-05 +[2026-10-05 17:28:47.767] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.767] [path_visualizer] [debug] current_cmd_angular_z:-0.02992536082696012 +[2026-10-05 17:28:47.816] [path_visualizer] [debug] current_pose_x:0.08627308869187271, current_pose_y:0.004792172324434695,current_pose_yaw:-1.2578233508975245e-05 +[2026-10-05 17:28:47.816] [path_visualizer] [debug] current_path_x:0.0, current_path_y:0.0,current_path_yaw:0.0 +[2026-10-05 17:28:47.816] [path_visualizer] [debug] current_cmd_angular_z:-0.02992536082696012 +[2026-10-05 17:28:47.867] [path_visualizer] [debug] current_pose_x:0.13274763151001737, current_pose_y:0.0055918320485394,current_pose_yaw:-0.00011033234477508813 +[2026-10-05 17:28:47.867] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:47.867] [path_visualizer] [debug] current_cmd_angular_z:-0.03472705857420042 +[2026-10-05 17:28:47.917] [path_visualizer] [debug] current_pose_x:0.13274763151001737, current_pose_y:0.0055918320485394,current_pose_yaw:-0.00011033234477508813 +[2026-10-05 17:28:47.917] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:47.917] [path_visualizer] [debug] current_cmd_angular_z:-0.03472705857420042 +[2026-10-05 17:28:47.966] [path_visualizer] [debug] current_pose_x:0.18342404587257122, current_pose_y:0.0053751191510345705,current_pose_yaw:-0.001157392165623605 +[2026-10-05 17:28:47.966] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:47.966] [path_visualizer] [debug] current_cmd_angular_z:-0.03127858275659733 +[2026-10-05 17:28:48.016] [path_visualizer] [debug] current_pose_x:0.18342404587257122, current_pose_y:0.0053751191510345705,current_pose_yaw:-0.001157392165623605 +[2026-10-05 17:28:48.017] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.017] [path_visualizer] [debug] current_cmd_angular_z:-0.03127858275659733 +[2026-10-05 17:28:48.066] [path_visualizer] [debug] current_pose_x:0.18342404587257122, current_pose_y:0.0053751191510345705,current_pose_yaw:-0.001157392165623605 +[2026-10-05 17:28:48.066] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.066] [path_visualizer] [debug] current_cmd_angular_z:-0.03127858275659733 +[2026-10-05 17:28:48.116] [path_visualizer] [debug] current_pose_x:0.23407108209866367, current_pose_y:0.004992520513847062,current_pose_yaw:-0.00229636812582612 +[2026-10-05 17:28:48.116] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.116] [path_visualizer] [debug] current_cmd_angular_z:-0.026609546289843487 +[2026-10-05 17:28:48.166] [path_visualizer] [debug] current_pose_x:0.23407108209866367, current_pose_y:0.004992520513847062,current_pose_yaw:-0.00229636812582612 +[2026-10-05 17:28:48.166] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.167] [path_visualizer] [debug] current_cmd_angular_z:-0.026609546289843487 +[2026-10-05 17:28:48.217] [path_visualizer] [debug] current_pose_x:0.23407108209866367, current_pose_y:0.004992520513847062,current_pose_yaw:-0.00229636812582612 +[2026-10-05 17:28:48.217] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.217] [path_visualizer] [debug] current_cmd_angular_z:-0.026609546289843487 +[2026-10-05 17:28:48.266] [path_visualizer] [debug] current_pose_x:0.28469871800472757, current_pose_y:0.004691083539055584,current_pose_yaw:-0.0033100605942308903 +[2026-10-05 17:28:48.267] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.267] [path_visualizer] [debug] current_cmd_angular_z:-0.02269828811460127 +[2026-10-05 17:28:48.316] [path_visualizer] [debug] current_pose_x:0.28469871800472757, current_pose_y:0.004691083539055584,current_pose_yaw:-0.0033100605942308903 +[2026-10-05 17:28:48.317] [path_visualizer] [debug] current_path_x:0.1937184742638588, current_path_y:5.404476226401575e-08,current_path_yaw:0.0 +[2026-10-05 17:28:48.317] [path_visualizer] [debug] current_cmd_angular_z:-0.02269828811460127 +[2026-10-05 17:28:48.367] [path_visualizer] [debug] current_pose_x:0.3353164572590034, current_pose_y:0.004471534200805921,current_pose_yaw:-0.004206088837236166 +[2026-10-05 17:28:48.367] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.367] [path_visualizer] [debug] current_cmd_angular_z:-0.019533780821751424 +[2026-10-05 17:28:48.417] [path_visualizer] [debug] current_pose_x:0.3353164572590034, current_pose_y:0.004471534200805921,current_pose_yaw:-0.004206088837236166 +[2026-10-05 17:28:48.417] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.417] [path_visualizer] [debug] current_cmd_angular_z:-0.019533780821751424 +[2026-10-05 17:28:48.466] [path_visualizer] [debug] current_pose_x:0.3353164572590034, current_pose_y:0.004471534200805921,current_pose_yaw:-0.004206088837236166 +[2026-10-05 17:28:48.466] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.466] [path_visualizer] [debug] current_cmd_angular_z:-0.019533780821751424 +[2026-10-05 17:28:48.516] [path_visualizer] [debug] current_pose_x:0.3859297328107798, current_pose_y:0.0043857240726324805,current_pose_yaw:-0.004943639039993285 +[2026-10-05 17:28:48.516] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.516] [path_visualizer] [debug] current_cmd_angular_z:-0.017522392793605075 +[2026-10-05 17:28:48.567] [path_visualizer] [debug] current_pose_x:0.3859297328107798, current_pose_y:0.0043857240726324805,current_pose_yaw:-0.004943639039993285 +[2026-10-05 17:28:48.567] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.567] [path_visualizer] [debug] current_cmd_angular_z:-0.017522392793605075 +[2026-10-05 17:28:48.616] [path_visualizer] [debug] current_pose_x:0.4365393719853752, current_pose_y:0.004354500010346401,current_pose_yaw:-0.005600792821496726 +[2026-10-05 17:28:48.616] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.616] [path_visualizer] [debug] current_cmd_angular_z:-0.016012943939494553 +[2026-10-05 17:28:48.667] [path_visualizer] [debug] current_pose_x:0.4365393719853752, current_pose_y:0.004354500010346401,current_pose_yaw:-0.005600792821496726 +[2026-10-05 17:28:48.667] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.667] [path_visualizer] [debug] current_cmd_angular_z:-0.016012943939494553 +[2026-10-05 17:28:48.716] [path_visualizer] [debug] current_pose_x:0.4365393719853752, current_pose_y:0.004354500010346401,current_pose_yaw:-0.005600792821496726 +[2026-10-05 17:28:48.716] [path_visualizer] [debug] current_path_x:0.3874369485277176, current_path_y:1.080895245280315e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.716] [path_visualizer] [debug] current_cmd_angular_z:-0.016012943939494553 +[2026-10-05 17:28:48.766] [path_visualizer] [debug] current_pose_x:0.487144493484559, current_pose_y:0.004380398239058248,current_pose_yaw:-0.0061782356351614 +[2026-10-05 17:28:48.766] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.766] [path_visualizer] [debug] current_cmd_angular_z:-0.015019576940552455 +[2026-10-05 17:28:48.816] [path_visualizer] [debug] current_pose_x:0.487144493484559, current_pose_y:0.004380398239058248,current_pose_yaw:-0.0061782356351614 +[2026-10-05 17:28:48.816] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.816] [path_visualizer] [debug] current_cmd_angular_z:-0.015019576940552455 +[2026-10-05 17:28:48.867] [path_visualizer] [debug] current_pose_x:0.487144493484559, current_pose_y:0.004380398239058248,current_pose_yaw:-0.0061782356351614 +[2026-10-05 17:28:48.867] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.867] [path_visualizer] [debug] current_cmd_angular_z:-0.015019576940552455 +[2026-10-05 17:28:48.916] [path_visualizer] [debug] current_pose_x:0.5377485969094019, current_pose_y:0.004430580778440895,current_pose_yaw:-0.0067088115029037 +[2026-10-05 17:28:48.916] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.916] [path_visualizer] [debug] current_cmd_angular_z:-0.014272051216401412 +[2026-10-05 17:28:48.966] [path_visualizer] [debug] current_pose_x:0.5377485969094019, current_pose_y:0.004430580778440895,current_pose_yaw:-0.0067088115029037 +[2026-10-05 17:28:48.966] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:48.966] [path_visualizer] [debug] current_cmd_angular_z:-0.014272051216401412 +[2026-10-05 17:28:49.016] [path_visualizer] [debug] current_pose_x:0.5883494096016741, current_pose_y:0.00448188697824188,current_pose_yaw:-0.007214998360723258 +[2026-10-05 17:28:49.017] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.017] [path_visualizer] [debug] current_cmd_angular_z:-0.013580325704973617 +[2026-10-05 17:28:49.066] [path_visualizer] [debug] current_pose_x:0.5883494096016741, current_pose_y:0.00448188697824188,current_pose_yaw:-0.007214998360723258 +[2026-10-05 17:28:49.067] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.067] [path_visualizer] [debug] current_cmd_angular_z:-0.013580325704973617 +[2026-10-05 17:28:49.117] [path_visualizer] [debug] current_pose_x:0.5883494096016741, current_pose_y:0.00448188697824188,current_pose_yaw:-0.007214998360723258 +[2026-10-05 17:28:49.117] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.117] [path_visualizer] [debug] current_cmd_angular_z:-0.013580325704973617 +[2026-10-05 17:28:49.166] [path_visualizer] [debug] current_pose_x:0.6389301506805548, current_pose_y:0.004548153418738909,current_pose_yaw:-0.00769080687314272 +[2026-10-05 17:28:49.166] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.167] [path_visualizer] [debug] current_cmd_angular_z:-0.01304285332276151 +[2026-10-05 17:28:49.217] [path_visualizer] [debug] current_pose_x:0.6389301506805548, current_pose_y:0.004548153418738909,current_pose_yaw:-0.00769080687314272 +[2026-10-05 17:28:49.217] [path_visualizer] [debug] current_path_x:0.5811554227915764, current_path_y:1.6213428679204724e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.217] [path_visualizer] [debug] current_cmd_angular_z:-0.01304285332276151 +[2026-10-05 17:28:49.266] [path_visualizer] [debug] current_pose_x:0.6895099463450253, current_pose_y:0.004605066722105261,current_pose_yaw:-0.00814718473702669 +[2026-10-05 17:28:49.266] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.266] [path_visualizer] [debug] current_cmd_angular_z:-0.012485449791200618 +[2026-10-05 17:28:49.317] [path_visualizer] [debug] current_pose_x:0.6895099463450253, current_pose_y:0.004605066722105261,current_pose_yaw:-0.00814718473702669 +[2026-10-05 17:28:49.317] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.317] [path_visualizer] [debug] current_cmd_angular_z:-0.012485449791200618 +[2026-10-05 17:28:49.366] [path_visualizer] [debug] current_pose_x:0.6895099463450253, current_pose_y:0.004605066722105261,current_pose_yaw:-0.00814718473702669 +[2026-10-05 17:28:49.367] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.367] [path_visualizer] [debug] current_cmd_angular_z:-0.012485449791200618 +[2026-10-05 17:28:49.417] [path_visualizer] [debug] current_pose_x:0.7400911240949168, current_pose_y:0.00466617599219778,current_pose_yaw:-0.00858018361032009 +[2026-10-05 17:28:49.417] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.417] [path_visualizer] [debug] current_cmd_angular_z:-0.012001364947842985 +[2026-10-05 17:28:49.466] [path_visualizer] [debug] current_pose_x:0.7400911240949168, current_pose_y:0.00466617599219778,current_pose_yaw:-0.00858018361032009 +[2026-10-05 17:28:49.466] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.466] [path_visualizer] [debug] current_cmd_angular_z:-0.012001364947842985 +[2026-10-05 17:28:49.516] [path_visualizer] [debug] current_pose_x:0.7400911240949168, current_pose_y:0.00466617599219778,current_pose_yaw:-0.00858018361032009 +[2026-10-05 17:28:49.517] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.517] [path_visualizer] [debug] current_cmd_angular_z:-0.012001364947842985 +[2026-10-05 17:28:49.566] [path_visualizer] [debug] current_pose_x:0.7906555827335126, current_pose_y:0.004732722859543401,current_pose_yaw:-0.008999587036669254 +[2026-10-05 17:28:49.566] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.566] [path_visualizer] [debug] current_cmd_angular_z:-0.011578453593477409 +[2026-10-05 17:28:49.616] [path_visualizer] [debug] current_pose_x:0.7906555827335126, current_pose_y:0.004732722859543401,current_pose_yaw:-0.008999587036669254 +[2026-10-05 17:28:49.616] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.616] [path_visualizer] [debug] current_cmd_angular_z:-0.011578453593477409 +[2026-10-05 17:28:49.666] [path_visualizer] [debug] current_pose_x:0.8412133514691029, current_pose_y:0.004794881504955676,current_pose_yaw:-0.009407225996255875 +[2026-10-05 17:28:49.666] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.666] [path_visualizer] [debug] current_cmd_angular_z:-0.011151645686670736 +[2026-10-05 17:28:49.716] [path_visualizer] [debug] current_pose_x:0.8412133514691029, current_pose_y:0.004794881504955676,current_pose_yaw:-0.009407225996255875 +[2026-10-05 17:28:49.716] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.716] [path_visualizer] [debug] current_cmd_angular_z:-0.011151645686670736 +[2026-10-05 17:28:49.766] [path_visualizer] [debug] current_pose_x:0.8412133514691029, current_pose_y:0.004794881504955676,current_pose_yaw:-0.009407225996255875 +[2026-10-05 17:28:49.766] [path_visualizer] [debug] current_path_x:0.7748738970554352, current_path_y:2.16179049056063e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.766] [path_visualizer] [debug] current_cmd_angular_z:-0.011151645686670736 +[2026-10-05 17:28:49.816] [path_visualizer] [debug] current_pose_x:0.8917735537076779, current_pose_y:0.004855235612102127,current_pose_yaw:-0.009798147715628147 +[2026-10-05 17:28:49.816] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.816] [path_visualizer] [debug] current_cmd_angular_z:-0.010746656219764138 +[2026-10-05 17:28:49.866] [path_visualizer] [debug] current_pose_x:0.8917735537076779, current_pose_y:0.004855235612102127,current_pose_yaw:-0.009798147715628147 +[2026-10-05 17:28:49.866] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.867] [path_visualizer] [debug] current_cmd_angular_z:-0.010746656219764138 +[2026-10-05 17:28:49.916] [path_visualizer] [debug] current_pose_x:0.9423328373606756, current_pose_y:0.00490727096119113,current_pose_yaw:-0.010179005563259125 +[2026-10-05 17:28:49.916] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.916] [path_visualizer] [debug] current_cmd_angular_z:-0.010310142541062377 +[2026-10-05 17:28:49.967] [path_visualizer] [debug] current_pose_x:0.9423328373606756, current_pose_y:0.00490727096119113,current_pose_yaw:-0.010179005563259125 +[2026-10-05 17:28:49.967] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:49.967] [path_visualizer] [debug] current_cmd_angular_z:-0.010310142541062377 +[2026-10-05 17:28:50.016] [path_visualizer] [debug] current_pose_x:0.9423328373606756, current_pose_y:0.00490727096119113,current_pose_yaw:-0.010179005563259125 +[2026-10-05 17:28:50.016] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.016] [path_visualizer] [debug] current_cmd_angular_z:-0.010310142541062377 +[2026-10-05 17:28:50.067] [path_visualizer] [debug] current_pose_x:0.9928926102671973, current_pose_y:0.004961687371579768,current_pose_yaw:-0.010540752671658993 +[2026-10-05 17:28:50.067] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.067] [path_visualizer] [debug] current_cmd_angular_z:-0.009926730674663015 +[2026-10-05 17:28:50.116] [path_visualizer] [debug] current_pose_x:0.9928926102671973, current_pose_y:0.004961687371579768,current_pose_yaw:-0.010540752671658993 +[2026-10-05 17:28:50.116] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.116] [path_visualizer] [debug] current_cmd_angular_z:-0.009926730674663015 +[2026-10-05 17:28:50.167] [path_visualizer] [debug] current_pose_x:0.9928926102671973, current_pose_y:0.004961687371579768,current_pose_yaw:-0.010540752671658993 +[2026-10-05 17:28:50.167] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.167] [path_visualizer] [debug] current_cmd_angular_z:-0.009926730674663015 +[2026-10-05 17:28:50.216] [path_visualizer] [debug] current_pose_x:1.0434528950359743, current_pose_y:0.005014169962752125,current_pose_yaw:-0.01088813878595829 +[2026-10-05 17:28:50.217] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.217] [path_visualizer] [debug] current_cmd_angular_z:-0.009559954720109835 +[2026-10-05 17:28:50.267] [path_visualizer] [debug] current_pose_x:1.0434528950359743, current_pose_y:0.005014169962752125,current_pose_yaw:-0.01088813878595829 +[2026-10-05 17:28:50.267] [path_visualizer] [debug] current_path_x:0.968592371319294, current_path_y:2.7022381132007877e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.267] [path_visualizer] [debug] current_cmd_angular_z:-0.009559954720109835 +[2026-10-05 17:28:50.316] [path_visualizer] [debug] current_pose_x:1.0940137359748106, current_pose_y:0.005058966239167057,current_pose_yaw:-0.011226898990571499 +[2026-10-05 17:28:50.316] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.316] [path_visualizer] [debug] current_cmd_angular_z:-0.00916205594334036 +[2026-10-05 17:28:50.367] [path_visualizer] [debug] current_pose_x:1.0940137359748106, current_pose_y:0.005058966239167057,current_pose_yaw:-0.011226898990571499 +[2026-10-05 17:28:50.367] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.367] [path_visualizer] [debug] current_cmd_angular_z:-0.00916205594334036 +[2026-10-05 17:28:50.416] [path_visualizer] [debug] current_pose_x:1.0940137359748106, current_pose_y:0.005058966239167057,current_pose_yaw:-0.011226898990571499 +[2026-10-05 17:28:50.416] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.416] [path_visualizer] [debug] current_cmd_angular_z:-0.00916205594334036 +[2026-10-05 17:28:50.467] [path_visualizer] [debug] current_pose_x:1.1445750444696219, current_pose_y:0.005103962597824347,current_pose_yaw:-0.011550363153219221 +[2026-10-05 17:28:50.467] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.467] [path_visualizer] [debug] current_cmd_angular_z:-0.00879633713428538 +[2026-10-05 17:28:50.516] [path_visualizer] [debug] current_pose_x:1.1445750444696219, current_pose_y:0.005103962597824347,current_pose_yaw:-0.011550363153219221 +[2026-10-05 17:28:50.516] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.517] [path_visualizer] [debug] current_cmd_angular_z:-0.00879633713428538 +[2026-10-05 17:28:50.566] [path_visualizer] [debug] current_pose_x:1.1951368585620274, current_pose_y:0.005145770462380494,current_pose_yaw:-0.011862322688102722 +[2026-10-05 17:28:50.566] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.566] [path_visualizer] [debug] current_cmd_angular_z:-0.008433700466144216 +[2026-10-05 17:28:50.616] [path_visualizer] [debug] current_pose_x:1.1951368585620274, current_pose_y:0.005145770462380494,current_pose_yaw:-0.011862322688102722 +[2026-10-05 17:28:50.617] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.617] [path_visualizer] [debug] current_cmd_angular_z:-0.008433700466144216 +[2026-10-05 17:28:50.666] [path_visualizer] [debug] current_pose_x:1.1951368585620274, current_pose_y:0.005145770462380494,current_pose_yaw:-0.011862322688102722 +[2026-10-05 17:28:50.666] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.666] [path_visualizer] [debug] current_cmd_angular_z:-0.008433700466144216 +[2026-10-05 17:28:50.717] [path_visualizer] [debug] current_pose_x:1.2456991445749694, current_pose_y:0.0051880697357534495,current_pose_yaw:-0.012159937992691992 +[2026-10-05 17:28:50.717] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.717] [path_visualizer] [debug] current_cmd_angular_z:-0.008102823087498472 +[2026-10-05 17:28:50.767] [path_visualizer] [debug] current_pose_x:1.2456991445749694, current_pose_y:0.0051880697357534495,current_pose_yaw:-0.012159937992691992 +[2026-10-05 17:28:50.767] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.767] [path_visualizer] [debug] current_cmd_angular_z:-0.008102823087498472 +[2026-10-05 17:28:50.816] [path_visualizer] [debug] current_pose_x:1.2456991445749694, current_pose_y:0.0051880697357534495,current_pose_yaw:-0.012159937992691992 +[2026-10-05 17:28:50.816] [path_visualizer] [debug] current_path_x:1.1623108455831528, current_path_y:3.242685735840945e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.817] [path_visualizer] [debug] current_cmd_angular_z:-0.008102823087498472 +[2026-10-05 17:28:50.866] [path_visualizer] [debug] current_pose_x:1.2962619256227566, current_pose_y:0.005228407064523408,current_pose_yaw:-0.012446055188775063 +[2026-10-05 17:28:50.866] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.867] [path_visualizer] [debug] current_cmd_angular_z:-0.007782342550155134 +[2026-10-05 17:28:50.917] [path_visualizer] [debug] current_pose_x:1.2962619256227566, current_pose_y:0.005228407064523408,current_pose_yaw:-0.012446055188775063 +[2026-10-05 17:28:50.917] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.917] [path_visualizer] [debug] current_cmd_angular_z:-0.007782342550155134 +[2026-10-05 17:28:50.966] [path_visualizer] [debug] current_pose_x:1.3468252185137166, current_pose_y:0.005264164083285122,current_pose_yaw:-0.012723539024591448 +[2026-10-05 17:28:50.966] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:50.966] [path_visualizer] [debug] current_cmd_angular_z:-0.0074508412318286844 +[2026-10-05 17:28:51.016] [path_visualizer] [debug] current_pose_x:1.3468252185137166, current_pose_y:0.005264164083285122,current_pose_yaw:-0.012723539024591448 +[2026-10-05 17:28:51.016] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.016] [path_visualizer] [debug] current_cmd_angular_z:-0.0074508412318286844 +[2026-10-05 17:28:51.066] [path_visualizer] [debug] current_pose_x:1.3468252185137166, current_pose_y:0.005264164083285122,current_pose_yaw:-0.012723539024591448 +[2026-10-05 17:28:51.066] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.066] [path_visualizer] [debug] current_cmd_angular_z:-0.0074508412318286844 +[2026-10-05 17:28:51.116] [path_visualizer] [debug] current_pose_x:1.3973889724447137, current_pose_y:0.005302152775807458,current_pose_yaw:-0.012986674904823303 +[2026-10-05 17:28:51.116] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.116] [path_visualizer] [debug] current_cmd_angular_z:-0.007161982623606178 +[2026-10-05 17:28:51.167] [path_visualizer] [debug] current_pose_x:1.3973889724447137, current_pose_y:0.005302152775807458,current_pose_yaw:-0.012986674904823303 +[2026-10-05 17:28:51.167] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.167] [path_visualizer] [debug] current_cmd_angular_z:-0.007161982623606178 +[2026-10-05 17:28:51.216] [path_visualizer] [debug] current_pose_x:1.3973889724447137, current_pose_y:0.005302152775807458,current_pose_yaw:-0.012986674904823303 +[2026-10-05 17:28:51.217] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.217] [path_visualizer] [debug] current_cmd_angular_z:-0.007161982623606178 +[2026-10-05 17:28:51.266] [path_visualizer] [debug] current_pose_x:1.4479537232442696, current_pose_y:0.005339395832850899,current_pose_yaw:-0.013238783925771713 +[2026-10-05 17:28:51.266] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.266] [path_visualizer] [debug] current_cmd_angular_z:-0.006890517603082631 +[2026-10-05 17:28:51.316] [path_visualizer] [debug] current_pose_x:1.4479537232442696, current_pose_y:0.005339395832850899,current_pose_yaw:-0.013238783925771713 +[2026-10-05 17:28:51.316] [path_visualizer] [debug] current_path_x:1.3560293198470115, current_path_y:3.7831333584811025e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.316] [path_visualizer] [debug] current_cmd_angular_z:-0.006890517603082631 +[2026-10-05 17:28:51.366] [path_visualizer] [debug] current_pose_x:1.498520601695106, current_pose_y:0.005372150256342784,current_pose_yaw:-0.0134836882352829 +[2026-10-05 17:28:51.366] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.366] [path_visualizer] [debug] current_cmd_angular_z:-0.006605072041688764 +[2026-10-05 17:28:51.416] [path_visualizer] [debug] current_pose_x:1.498520601695106, current_pose_y:0.005372150256342784,current_pose_yaw:-0.0134836882352829 +[2026-10-05 17:28:51.416] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.416] [path_visualizer] [debug] current_cmd_angular_z:-0.006605072041688764 +[2026-10-05 17:28:51.466] [path_visualizer] [debug] current_pose_x:1.498520601695106, current_pose_y:0.005372150256342784,current_pose_yaw:-0.0134836882352829 +[2026-10-05 17:28:51.466] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.466] [path_visualizer] [debug] current_cmd_angular_z:-0.006605072041688764 +[2026-10-05 17:28:51.516] [path_visualizer] [debug] current_pose_x:1.549085816625234, current_pose_y:0.005405538318877432,current_pose_yaw:-0.013717105612158775 +[2026-10-05 17:28:51.516] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.516] [path_visualizer] [debug] current_cmd_angular_z:-0.006346897887576489 +[2026-10-05 17:28:51.566] [path_visualizer] [debug] current_pose_x:1.549085816625234, current_pose_y:0.005405538318877432,current_pose_yaw:-0.013717105612158775 +[2026-10-05 17:28:51.566] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.566] [path_visualizer] [debug] current_cmd_angular_z:-0.006346897887576489 +[2026-10-05 17:28:51.616] [path_visualizer] [debug] current_pose_x:1.5996515126553028, current_pose_y:0.005433738924609328,current_pose_yaw:-0.013944745063781738 +[2026-10-05 17:28:51.616] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.616] [path_visualizer] [debug] current_cmd_angular_z:-0.006067860133861222 +[2026-10-05 17:28:51.667] [path_visualizer] [debug] current_pose_x:1.5996515126553028, current_pose_y:0.005433738924609328,current_pose_yaw:-0.013944745063781738 +[2026-10-05 17:28:51.667] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.667] [path_visualizer] [debug] current_cmd_angular_z:-0.006067860133861222 +[2026-10-05 17:28:51.716] [path_visualizer] [debug] current_pose_x:1.5996515126553028, current_pose_y:0.005433738924609328,current_pose_yaw:-0.013944745063781738 +[2026-10-05 17:28:51.716] [path_visualizer] [debug] current_path_x:1.5497477941108704, current_path_y:4.32358098112126e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.717] [path_visualizer] [debug] current_cmd_angular_z:-0.006067860133861222 +[2026-10-05 17:28:51.767] [path_visualizer] [debug] current_pose_x:1.65021764776281, current_pose_y:0.005465633161243314,current_pose_yaw:-0.014158979058265686 +[2026-10-05 17:28:51.767] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.767] [path_visualizer] [debug] current_cmd_angular_z:-0.005838378918446491 +[2026-10-05 17:28:51.817] [path_visualizer] [debug] current_pose_x:1.65021764776281, current_pose_y:0.005465633161243314,current_pose_yaw:-0.014158979058265686 +[2026-10-05 17:28:51.817] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.817] [path_visualizer] [debug] current_cmd_angular_z:-0.005838378918446491 +[2026-10-05 17:28:51.866] [path_visualizer] [debug] current_pose_x:1.7007806821656786, current_pose_y:0.005501277641124235,current_pose_yaw:-0.01436355896294117 +[2026-10-05 17:28:51.867] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.867] [path_visualizer] [debug] current_cmd_angular_z:-0.005651980758508285 +[2026-10-05 17:28:51.916] [path_visualizer] [debug] current_pose_x:1.7007806821656786, current_pose_y:0.005501277641124235,current_pose_yaw:-0.01436355896294117 +[2026-10-05 17:28:51.917] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.917] [path_visualizer] [debug] current_cmd_angular_z:-0.005651980758508285 +[2026-10-05 17:28:51.966] [path_visualizer] [debug] current_pose_x:1.7007806821656786, current_pose_y:0.005501277641124235,current_pose_yaw:-0.01436355896294117 +[2026-10-05 17:28:51.966] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:51.966] [path_visualizer] [debug] current_cmd_angular_z:-0.005651980758508285 +[2026-10-05 17:28:52.016] [path_visualizer] [debug] current_pose_x:1.7513311345300033, current_pose_y:0.005551419439368843,current_pose_yaw:-0.014554077759385109 +[2026-10-05 17:28:52.017] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.017] [path_visualizer] [debug] current_cmd_angular_z:-0.00558430604369007 +[2026-10-05 17:28:52.066] [path_visualizer] [debug] current_pose_x:1.7513311345300033, current_pose_y:0.005551419439368843,current_pose_yaw:-0.014554077759385109 +[2026-10-05 17:28:52.066] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.066] [path_visualizer] [debug] current_cmd_angular_z:-0.00558430604369007 +[2026-10-05 17:28:52.116] [path_visualizer] [debug] current_pose_x:1.7513311345300033, current_pose_y:0.005551419439368843,current_pose_yaw:-0.014554077759385109 +[2026-10-05 17:28:52.116] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.116] [path_visualizer] [debug] current_cmd_angular_z:-0.00558430604369007 +[2026-10-05 17:28:52.166] [path_visualizer] [debug] current_pose_x:1.801869946294039, current_pose_y:0.005589587744030972,current_pose_yaw:-0.014736341312527655 +[2026-10-05 17:28:52.166] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.167] [path_visualizer] [debug] current_cmd_angular_z:-0.005458312773762419 +[2026-10-05 17:28:52.216] [path_visualizer] [debug] current_pose_x:1.801869946294039, current_pose_y:0.005589587744030972,current_pose_yaw:-0.014736341312527655 +[2026-10-05 17:28:52.216] [path_visualizer] [debug] current_path_x:1.7434662683747293, current_path_y:4.864028603761418e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.216] [path_visualizer] [debug] current_cmd_angular_z:-0.005458312773762419 +[2026-10-05 17:28:52.266] [path_visualizer] [debug] current_pose_x:1.8524048583175605, current_pose_y:0.005615271189300526,current_pose_yaw:-0.014917473308742045 +[2026-10-05 17:28:52.266] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.267] [path_visualizer] [debug] current_cmd_angular_z:-0.005256220262960635 +[2026-10-05 17:28:52.316] [path_visualizer] [debug] current_pose_x:1.8524048583175605, current_pose_y:0.005615271189300526,current_pose_yaw:-0.014917473308742045 +[2026-10-05 17:28:52.316] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.316] [path_visualizer] [debug] current_cmd_angular_z:-0.005256220262960635 +[2026-10-05 17:28:52.366] [path_visualizer] [debug] current_pose_x:1.8524048583175605, current_pose_y:0.005615271189300526,current_pose_yaw:-0.014917473308742045 +[2026-10-05 17:28:52.366] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.366] [path_visualizer] [debug] current_cmd_angular_z:-0.005256220262960635 +[2026-10-05 17:28:52.416] [path_visualizer] [debug] current_pose_x:1.902943210110975, current_pose_y:0.005639294550173843,current_pose_yaw:-0.015091783367097378 +[2026-10-05 17:28:52.416] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.416] [path_visualizer] [debug] current_cmd_angular_z:-0.0050577345469793936 +[2026-10-05 17:28:52.466] [path_visualizer] [debug] current_pose_x:1.902943210110975, current_pose_y:0.005639294550173843,current_pose_yaw:-0.015091783367097378 +[2026-10-05 17:28:52.467] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.467] [path_visualizer] [debug] current_cmd_angular_z:-0.0050577345469793936 +[2026-10-05 17:28:52.516] [path_visualizer] [debug] current_pose_x:1.95349138761429, current_pose_y:0.005667956280758691,current_pose_yaw:-0.015268744900822638 +[2026-10-05 17:28:52.516] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.516] [path_visualizer] [debug] current_cmd_angular_z:-0.004882933320403068 +[2026-10-05 17:28:52.567] [path_visualizer] [debug] current_pose_x:1.95349138761429, current_pose_y:0.005667956280758691,current_pose_yaw:-0.015268744900822638 +[2026-10-05 17:28:52.567] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.567] [path_visualizer] [debug] current_cmd_angular_z:-0.004882933320403068 +[2026-10-05 17:28:52.616] [path_visualizer] [debug] current_pose_x:1.95349138761429, current_pose_y:0.005667956280758691,current_pose_yaw:-0.015268744900822638 +[2026-10-05 17:28:52.616] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.616] [path_visualizer] [debug] current_cmd_angular_z:-0.004882933320403068 +[2026-10-05 17:28:52.666] [path_visualizer] [debug] current_pose_x:2.0040511023656746, current_pose_y:0.00569096163514061,current_pose_yaw:-0.015445468015968798 +[2026-10-05 17:28:52.666] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.667] [path_visualizer] [debug] current_cmd_angular_z:-0.004673259234991376 +[2026-10-05 17:28:52.716] [path_visualizer] [debug] current_pose_x:2.0040511023656746, current_pose_y:0.00569096163514061,current_pose_yaw:-0.015445468015968798 +[2026-10-05 17:28:52.716] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.716] [path_visualizer] [debug] current_cmd_angular_z:-0.004673259234991376 +[2026-10-05 17:28:52.766] [path_visualizer] [debug] current_pose_x:2.0040511023656746, current_pose_y:0.00569096163514061,current_pose_yaw:-0.015445468015968798 +[2026-10-05 17:28:52.767] [path_visualizer] [debug] current_path_x:1.937184742638588, current_path_y:5.404476226401575e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.767] [path_visualizer] [debug] current_cmd_angular_z:-0.004673259234991376 +[2026-10-05 17:28:52.816] [path_visualizer] [debug] current_pose_x:2.0546111093109447, current_pose_y:0.005711312209992248,current_pose_yaw:-0.01561623252928257 +[2026-10-05 17:28:52.816] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.816] [path_visualizer] [debug] current_cmd_angular_z:-0.004458573458031273 +[2026-10-05 17:28:52.866] [path_visualizer] [debug] current_pose_x:2.0546111093109447, current_pose_y:0.005711312209992248,current_pose_yaw:-0.01561623252928257 +[2026-10-05 17:28:52.866] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.866] [path_visualizer] [debug] current_cmd_angular_z:-0.004458573458031273 +[2026-10-05 17:28:52.916] [path_visualizer] [debug] current_pose_x:2.105169517812987, current_pose_y:0.005728002733655993,current_pose_yaw:-0.01578247174620628 +[2026-10-05 17:28:52.916] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.916] [path_visualizer] [debug] current_cmd_angular_z:-0.004230402467841413 +[2026-10-05 17:28:52.966] [path_visualizer] [debug] current_pose_x:2.105169517812987, current_pose_y:0.005728002733655993,current_pose_yaw:-0.01578247174620628 +[2026-10-05 17:28:52.966] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:52.966] [path_visualizer] [debug] current_cmd_angular_z:-0.004230402467841413 +[2026-10-05 17:28:53.016] [path_visualizer] [debug] current_pose_x:2.105169517812987, current_pose_y:0.005728002733655993,current_pose_yaw:-0.01578247174620628 +[2026-10-05 17:28:53.016] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.016] [path_visualizer] [debug] current_cmd_angular_z:-0.004230402467841413 +[2026-10-05 17:28:53.066] [path_visualizer] [debug] current_pose_x:2.155728257662971, current_pose_y:0.005747267396694255,current_pose_yaw:-0.01593893952667713 +[2026-10-05 17:28:53.066] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.067] [path_visualizer] [debug] current_cmd_angular_z:-0.0040378613765155655 +[2026-10-05 17:28:53.116] [path_visualizer] [debug] current_pose_x:2.155728257662971, current_pose_y:0.005747267396694255,current_pose_yaw:-0.01593893952667713 +[2026-10-05 17:28:53.117] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.117] [path_visualizer] [debug] current_cmd_angular_z:-0.0040378613765155655 +[2026-10-05 17:28:53.166] [path_visualizer] [debug] current_pose_x:2.2062874697826933, current_pose_y:0.005765438892744921,current_pose_yaw:-0.01608942821621895 +[2026-10-05 17:28:53.166] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.166] [path_visualizer] [debug] current_cmd_angular_z:-0.003850446662706744 +[2026-10-05 17:28:53.216] [path_visualizer] [debug] current_pose_x:2.2062874697826933, current_pose_y:0.005765438892744921,current_pose_yaw:-0.01608942821621895 +[2026-10-05 17:28:53.216] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.216] [path_visualizer] [debug] current_cmd_angular_z:-0.003850446662706744 +[2026-10-05 17:28:53.266] [path_visualizer] [debug] current_pose_x:2.2062874697826933, current_pose_y:0.005765438892744921,current_pose_yaw:-0.01608942821621895 +[2026-10-05 17:28:53.267] [path_visualizer] [debug] current_path_x:2.1309032169024467, current_path_y:5.944923849041734e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.267] [path_visualizer] [debug] current_cmd_angular_z:-0.003850446662706744 +[2026-10-05 17:28:53.316] [path_visualizer] [debug] current_pose_x:2.256847693802495, current_pose_y:0.005786546004117631,current_pose_yaw:-0.01623060554265976 +[2026-10-05 17:28:53.316] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.316] [path_visualizer] [debug] current_cmd_angular_z:-0.003699662961926427 +[2026-10-05 17:28:53.366] [path_visualizer] [debug] current_pose_x:2.256847693802495, current_pose_y:0.005786546004117631,current_pose_yaw:-0.01623060554265976 +[2026-10-05 17:28:53.366] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.366] [path_visualizer] [debug] current_cmd_angular_z:-0.003699662961926427 +[2026-10-05 17:28:53.416] [path_visualizer] [debug] current_pose_x:2.3074095415125564, current_pose_y:0.005807343474111519,current_pose_yaw:-0.016365788877010345 +[2026-10-05 17:28:53.416] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.416] [path_visualizer] [debug] current_cmd_angular_z:-0.0035592698197209685 +[2026-10-05 17:28:53.466] [path_visualizer] [debug] current_pose_x:2.3074095415125564, current_pose_y:0.005807343474111519,current_pose_yaw:-0.016365788877010345 +[2026-10-05 17:28:53.466] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.466] [path_visualizer] [debug] current_cmd_angular_z:-0.0035592698197209685 +[2026-10-05 17:28:53.516] [path_visualizer] [debug] current_pose_x:2.3074095415125564, current_pose_y:0.005807343474111519,current_pose_yaw:-0.016365788877010345 +[2026-10-05 17:28:53.516] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.516] [path_visualizer] [debug] current_cmd_angular_z:-0.0035592698197209685 +[2026-10-05 17:28:53.567] [path_visualizer] [debug] current_pose_x:2.357970265371083, current_pose_y:0.005827598085561594,current_pose_yaw:-0.016495453193783757 +[2026-10-05 17:28:53.567] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.567] [path_visualizer] [debug] current_cmd_angular_z:-0.003426522051386556 +[2026-10-05 17:28:53.616] [path_visualizer] [debug] current_pose_x:2.357970265371083, current_pose_y:0.005827598085561594,current_pose_yaw:-0.016495453193783757 +[2026-10-05 17:28:53.616] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.616] [path_visualizer] [debug] current_cmd_angular_z:-0.003426522051386556 +[2026-10-05 17:28:53.667] [path_visualizer] [debug] current_pose_x:2.357970265371083, current_pose_y:0.005827598085561594,current_pose_yaw:-0.016495453193783757 +[2026-10-05 17:28:53.667] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.667] [path_visualizer] [debug] current_cmd_angular_z:-0.003426522051386556 +[2026-10-05 17:28:53.716] [path_visualizer] [debug] current_pose_x:2.4085314694248794, current_pose_y:0.005845964387190993,current_pose_yaw:-0.016621019691228863 +[2026-10-05 17:28:53.716] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.717] [path_visualizer] [debug] current_cmd_angular_z:-0.003290168897110604 +[2026-10-05 17:28:53.766] [path_visualizer] [debug] current_pose_x:2.4085314694248794, current_pose_y:0.005845964387190993,current_pose_yaw:-0.016621019691228863 +[2026-10-05 17:28:53.766] [path_visualizer] [debug] current_path_x:2.3246216911663056, current_path_y:6.48537147168189e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.767] [path_visualizer] [debug] current_cmd_angular_z:-0.003290168897110604 +[2026-10-05 17:28:53.816] [path_visualizer] [debug] current_pose_x:2.4590931438363866, current_pose_y:0.005861596335976507,current_pose_yaw:-0.016743436455726624 +[2026-10-05 17:28:53.816] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.816] [path_visualizer] [debug] current_cmd_angular_z:-0.003142689125613024 +[2026-10-05 17:28:53.866] [path_visualizer] [debug] current_pose_x:2.4590931438363866, current_pose_y:0.005861596335976507,current_pose_yaw:-0.016743436455726624 +[2026-10-05 17:28:53.866] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.866] [path_visualizer] [debug] current_cmd_angular_z:-0.003142689125613024 +[2026-10-05 17:28:53.916] [path_visualizer] [debug] current_pose_x:2.4590931438363866, current_pose_y:0.005861596335976507,current_pose_yaw:-0.016743436455726624 +[2026-10-05 17:28:53.916] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.916] [path_visualizer] [debug] current_cmd_angular_z:-0.003142689125613024 +[2026-10-05 17:28:53.966] [path_visualizer] [debug] current_pose_x:2.5096568511655306, current_pose_y:0.005879475998503477,current_pose_yaw:-0.01685840077698231 +[2026-10-05 17:28:53.966] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:53.967] [path_visualizer] [debug] current_cmd_angular_z:-0.003024498974611274 +[2026-10-05 17:28:54.016] [path_visualizer] [debug] current_pose_x:2.5096568511655306, current_pose_y:0.005879475998503477,current_pose_yaw:-0.01685840077698231 +[2026-10-05 17:28:54.016] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.016] [path_visualizer] [debug] current_cmd_angular_z:-0.003024498974611274 +[2026-10-05 17:28:54.066] [path_visualizer] [debug] current_pose_x:2.560219356596043, current_pose_y:0.005897869808855802,current_pose_yaw:-0.016967806965112686 +[2026-10-05 17:28:54.066] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.066] [path_visualizer] [debug] current_cmd_angular_z:-0.0029206381836405435 +[2026-10-05 17:28:54.117] [path_visualizer] [debug] current_pose_x:2.560219356596043, current_pose_y:0.005897869808855802,current_pose_yaw:-0.016967806965112686 +[2026-10-05 17:28:54.117] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.117] [path_visualizer] [debug] current_cmd_angular_z:-0.0029206381836405435 +[2026-10-05 17:28:54.166] [path_visualizer] [debug] current_pose_x:2.560219356596043, current_pose_y:0.005897869808855802,current_pose_yaw:-0.016967806965112686 +[2026-10-05 17:28:54.166] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.166] [path_visualizer] [debug] current_cmd_angular_z:-0.0029206381836405435 +[2026-10-05 17:28:54.216] [path_visualizer] [debug] current_pose_x:2.6107822577789523, current_pose_y:0.005915440273667694,current_pose_yaw:-0.01707308180630207 +[2026-10-05 17:28:54.217] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.217] [path_visualizer] [debug] current_cmd_angular_z:-0.0028198945555838115 +[2026-10-05 17:28:54.266] [path_visualizer] [debug] current_pose_x:2.6107822577789523, current_pose_y:0.005915440273667694,current_pose_yaw:-0.01707308180630207 +[2026-10-05 17:28:54.266] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.267] [path_visualizer] [debug] current_cmd_angular_z:-0.0028198945555838115 +[2026-10-05 17:28:54.317] [path_visualizer] [debug] current_pose_x:2.6107822577789523, current_pose_y:0.005915440273667694,current_pose_yaw:-0.01707308180630207 +[2026-10-05 17:28:54.317] [path_visualizer] [debug] current_path_x:2.5183401654301645, current_path_y:7.025819094322048e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.317] [path_visualizer] [debug] current_cmd_angular_z:-0.0028198945555838115 +[2026-10-05 17:28:54.366] [path_visualizer] [debug] current_pose_x:2.6613455258533434, current_pose_y:0.005932394417311309,current_pose_yaw:-0.01717422157526016 +[2026-10-05 17:28:54.366] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.366] [path_visualizer] [debug] current_cmd_angular_z:-0.002723231589117324 +[2026-10-05 17:28:54.416] [path_visualizer] [debug] current_pose_x:2.6613455258533434, current_pose_y:0.005932394417311309,current_pose_yaw:-0.01717422157526016 +[2026-10-05 17:28:54.417] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.417] [path_visualizer] [debug] current_cmd_angular_z:-0.002723231589117324 +[2026-10-05 17:28:54.466] [path_visualizer] [debug] current_pose_x:2.7119091338907193, current_pose_y:0.005947888830966102,current_pose_yaw:-0.017272168770432472 +[2026-10-05 17:28:54.466] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.467] [path_visualizer] [debug] current_cmd_angular_z:-0.0026241689445958977 +[2026-10-05 17:28:54.516] [path_visualizer] [debug] current_pose_x:2.7119091338907193, current_pose_y:0.005947888830966102,current_pose_yaw:-0.017272168770432472 +[2026-10-05 17:28:54.516] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.516] [path_visualizer] [debug] current_cmd_angular_z:-0.0026241689445958977 +[2026-10-05 17:28:54.566] [path_visualizer] [debug] current_pose_x:2.7119091338907193, current_pose_y:0.005947888830966102,current_pose_yaw:-0.017272168770432472 +[2026-10-05 17:28:54.566] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.566] [path_visualizer] [debug] current_cmd_angular_z:-0.0026241689445958977 +[2026-10-05 17:28:54.616] [path_visualizer] [debug] current_pose_x:2.762474667179031, current_pose_y:0.0059615115926065785,current_pose_yaw:-0.01736740581691265 +[2026-10-05 17:28:54.616] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.616] [path_visualizer] [debug] current_cmd_angular_z:-0.0025188297437588256 +[2026-10-05 17:28:54.666] [path_visualizer] [debug] current_pose_x:2.762474667179031, current_pose_y:0.0059615115926065785,current_pose_yaw:-0.01736740581691265 +[2026-10-05 17:28:54.666] [path_visualizer] [debug] current_path_x:2.712058639694023, current_path_y:7.566266716962205e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.666] [path_visualizer] [debug] current_cmd_angular_z:-0.0025188297437588256 +[2026-10-05 17:28:54.716] [path_visualizer] [debug] current_pose_x:2.813038886242471, current_pose_y:0.005972341836243157,current_pose_yaw:-0.017460873350501057 +[2026-10-05 17:28:54.716] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.716] [path_visualizer] [debug] current_cmd_angular_z:-0.0023992400671280084 +[2026-10-05 17:28:54.766] [path_visualizer] [debug] current_pose_x:2.813038886242471, current_pose_y:0.005972341836243157,current_pose_yaw:-0.017460873350501057 +[2026-10-05 17:28:54.767] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.767] [path_visualizer] [debug] current_cmd_angular_z:-0.0023992400671280084 +[2026-10-05 17:28:54.816] [path_visualizer] [debug] current_pose_x:2.813038886242471, current_pose_y:0.005972341836243157,current_pose_yaw:-0.017460873350501057 +[2026-10-05 17:28:54.816] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.816] [path_visualizer] [debug] current_cmd_angular_z:-0.0023992400671280084 +[2026-10-05 17:28:54.866] [path_visualizer] [debug] current_pose_x:2.8636033713002753, current_pose_y:0.00598422465804683,current_pose_yaw:-0.017549229785799984 +[2026-10-05 17:28:54.866] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.866] [path_visualizer] [debug] current_cmd_angular_z:-0.0022967883548604615 +[2026-10-05 17:28:54.916] [path_visualizer] [debug] current_pose_x:2.8636033713002753, current_pose_y:0.00598422465804683,current_pose_yaw:-0.017549229785799984 +[2026-10-05 17:28:54.916] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.916] [path_visualizer] [debug] current_cmd_angular_z:-0.0022967883548604615 +[2026-10-05 17:28:54.966] [path_visualizer] [debug] current_pose_x:2.8636033713002753, current_pose_y:0.00598422465804683,current_pose_yaw:-0.017549229785799984 +[2026-10-05 17:28:54.967] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:54.967] [path_visualizer] [debug] current_cmd_angular_z:-0.0022967883548604615 +[2026-10-05 17:28:55.016] [path_visualizer] [debug] current_pose_x:2.914168100083593, current_pose_y:0.005996374536635789,current_pose_yaw:-0.01763342320919037 +[2026-10-05 17:28:55.017] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.017] [path_visualizer] [debug] current_cmd_angular_z:-0.002204331599076806 +[2026-10-05 17:28:55.066] [path_visualizer] [debug] current_pose_x:2.914168100083593, current_pose_y:0.005996374536635789,current_pose_yaw:-0.01763342320919037 +[2026-10-05 17:28:55.067] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.067] [path_visualizer] [debug] current_cmd_angular_z:-0.002204331599076806 +[2026-10-05 17:28:55.116] [path_visualizer] [debug] current_pose_x:2.964745150528334, current_pose_y:0.005986742160160321,current_pose_yaw:-0.01771221123635769 +[2026-10-05 17:28:55.116] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.116] [path_visualizer] [debug] current_cmd_angular_z:-0.0019865584662257935 +[2026-10-05 17:28:55.166] [path_visualizer] [debug] current_pose_x:2.964745150528334, current_pose_y:0.005986742160160321,current_pose_yaw:-0.01771221123635769 +[2026-10-05 17:28:55.167] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.167] [path_visualizer] [debug] current_cmd_angular_z:-0.0019865584662257935 +[2026-10-05 17:28:55.216] [path_visualizer] [debug] current_pose_x:2.964745150528334, current_pose_y:0.005986742160160321,current_pose_yaw:-0.01771221123635769 +[2026-10-05 17:28:55.216] [path_visualizer] [debug] current_path_x:2.905777113957882, current_path_y:8.106714339602363e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.216] [path_visualizer] [debug] current_cmd_angular_z:-0.0019865584662257935 +[2026-10-05 17:28:55.266] [path_visualizer] [debug] current_pose_x:3.015325221706875, current_pose_y:0.005973825462096193,current_pose_yaw:-0.017784476280212402 +[2026-10-05 17:28:55.266] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.266] [path_visualizer] [debug] current_cmd_angular_z:-0.0017609683115462418 +[2026-10-05 17:28:55.316] [path_visualizer] [debug] current_pose_x:3.015325221706875, current_pose_y:0.005973825462096193,current_pose_yaw:-0.017784476280212402 +[2026-10-05 17:28:55.317] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.317] [path_visualizer] [debug] current_cmd_angular_z:-0.0017609683115462418 +[2026-10-05 17:28:55.366] [path_visualizer] [debug] current_pose_x:3.0659047563167414, current_pose_y:0.005964681790740168,current_pose_yaw:-0.017850996926426884 +[2026-10-05 17:28:55.366] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.366] [path_visualizer] [debug] current_cmd_angular_z:-0.0015707840426939512 +[2026-10-05 17:28:55.416] [path_visualizer] [debug] current_pose_x:3.0659047563167414, current_pose_y:0.005964681790740168,current_pose_yaw:-0.017850996926426884 +[2026-10-05 17:28:55.416] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.416] [path_visualizer] [debug] current_cmd_angular_z:-0.0015707840426939512 +[2026-10-05 17:28:55.466] [path_visualizer] [debug] current_pose_x:3.0659047563167414, current_pose_y:0.005964681790740168,current_pose_yaw:-0.017850996926426884 +[2026-10-05 17:28:55.466] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.466] [path_visualizer] [debug] current_cmd_angular_z:-0.0015707840426939512 +[2026-10-05 17:28:55.517] [path_visualizer] [debug] current_pose_x:3.1164840595218632, current_pose_y:0.00596333368630633,current_pose_yaw:-0.017907969653606418 +[2026-10-05 17:28:55.517] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.517] [path_visualizer] [debug] current_cmd_angular_z:-0.0014484136670257566 +[2026-10-05 17:28:55.566] [path_visualizer] [debug] current_pose_x:3.1164840595218632, current_pose_y:0.00596333368630633,current_pose_yaw:-0.017907969653606418 +[2026-10-05 17:28:55.566] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.566] [path_visualizer] [debug] current_cmd_angular_z:-0.0014484136670257566 +[2026-10-05 17:28:55.617] [path_visualizer] [debug] current_pose_x:3.1164840595218632, current_pose_y:0.00596333368630633,current_pose_yaw:-0.017907969653606418 +[2026-10-05 17:28:55.617] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.617] [path_visualizer] [debug] current_cmd_angular_z:-0.0014484136670257566 +[2026-10-05 17:28:55.666] [path_visualizer] [debug] current_pose_x:3.167102907652292, current_pose_y:0.005969668060154747,current_pose_yaw:-0.01795958541333675 +[2026-10-05 17:28:55.666] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.666] [path_visualizer] [debug] current_cmd_angular_z:-0.0013847685445838032 +[2026-10-05 17:28:55.716] [path_visualizer] [debug] current_pose_x:3.167102907652292, current_pose_y:0.005969668060154747,current_pose_yaw:-0.01795958541333675 +[2026-10-05 17:28:55.717] [path_visualizer] [debug] current_path_x:3.0994955882217408, current_path_y:8.64716196224252e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.717] [path_visualizer] [debug] current_cmd_angular_z:-0.0013847685445838032 +[2026-10-05 17:28:55.766] [path_visualizer] [debug] current_pose_x:3.2177258992113575, current_pose_y:0.005973816848614292,current_pose_yaw:-0.01800732128322124 +[2026-10-05 17:28:55.766] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.767] [path_visualizer] [debug] current_cmd_angular_z:-0.0013148867256088867 +[2026-10-05 17:28:55.816] [path_visualizer] [debug] current_pose_x:3.2177258992113575, current_pose_y:0.005973816848614292,current_pose_yaw:-0.01800732128322124 +[2026-10-05 17:28:55.817] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.817] [path_visualizer] [debug] current_cmd_angular_z:-0.0013148867256088867 +[2026-10-05 17:28:55.866] [path_visualizer] [debug] current_pose_x:3.2177258992113575, current_pose_y:0.005973816848614292,current_pose_yaw:-0.01800732128322124 +[2026-10-05 17:28:55.867] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.867] [path_visualizer] [debug] current_cmd_angular_z:-0.0013148867256088867 +[2026-10-05 17:28:55.916] [path_visualizer] [debug] current_pose_x:3.268347217211639, current_pose_y:0.005976504837488324,current_pose_yaw:-0.01805409975349903 +[2026-10-05 17:28:55.916] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.916] [path_visualizer] [debug] current_cmd_angular_z:-0.001238128251737601 +[2026-10-05 17:28:55.966] [path_visualizer] [debug] current_pose_x:3.268347217211639, current_pose_y:0.005976504837488324,current_pose_yaw:-0.01805409975349903 +[2026-10-05 17:28:55.967] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:55.967] [path_visualizer] [debug] current_cmd_angular_z:-0.001238128251737601 +[2026-10-05 17:28:56.016] [path_visualizer] [debug] current_pose_x:3.318967135325551, current_pose_y:0.0059800672738939105,current_pose_yaw:-0.018098006024956703 +[2026-10-05 17:28:56.016] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.016] [path_visualizer] [debug] current_cmd_angular_z:-0.0011725789943572568 +[2026-10-05 17:28:56.066] [path_visualizer] [debug] current_pose_x:3.318967135325551, current_pose_y:0.0059800672738939105,current_pose_yaw:-0.018098006024956703 +[2026-10-05 17:28:56.067] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.067] [path_visualizer] [debug] current_cmd_angular_z:-0.0011725789943572568 +[2026-10-05 17:28:56.116] [path_visualizer] [debug] current_pose_x:3.318967135325551, current_pose_y:0.0059800672738939105,current_pose_yaw:-0.018098006024956703 +[2026-10-05 17:28:56.116] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.116] [path_visualizer] [debug] current_cmd_angular_z:-0.0011725789943572568 +[2026-10-05 17:28:56.166] [path_visualizer] [debug] current_pose_x:3.369585771879065, current_pose_y:0.005985739988792487,current_pose_yaw:-0.018138090148568153 +[2026-10-05 17:28:56.166] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.167] [path_visualizer] [debug] current_cmd_angular_z:-0.0011278621180897605 +[2026-10-05 17:28:56.216] [path_visualizer] [debug] current_pose_x:3.369585771879065, current_pose_y:0.005985739988792487,current_pose_yaw:-0.018138090148568153 +[2026-10-05 17:28:56.216] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.216] [path_visualizer] [debug] current_cmd_angular_z:-0.0011278621180897605 +[2026-10-05 17:28:56.266] [path_visualizer] [debug] current_pose_x:3.369585771879065, current_pose_y:0.005985739988792487,current_pose_yaw:-0.018138090148568153 +[2026-10-05 17:28:56.266] [path_visualizer] [debug] current_path_x:3.2932140624855992, current_path_y:9.187609584882677e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.267] [path_visualizer] [debug] current_cmd_angular_z:-0.0011278621180897605 +[2026-10-05 17:28:56.316] [path_visualizer] [debug] current_pose_x:3.4202036889045577, current_pose_y:0.005989933864217503,current_pose_yaw:-0.01817769557237625 +[2026-10-05 17:28:56.317] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.317] [path_visualizer] [debug] current_cmd_angular_z:-0.001074522948162876 +[2026-10-05 17:28:56.366] [path_visualizer] [debug] current_pose_x:3.4202036889045577, current_pose_y:0.005989933864217503,current_pose_yaw:-0.01817769557237625 +[2026-10-05 17:28:56.366] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.366] [path_visualizer] [debug] current_cmd_angular_z:-0.001074522948162876 +[2026-10-05 17:28:56.416] [path_visualizer] [debug] current_pose_x:3.4708220123431213, current_pose_y:0.005993776727558223,current_pose_yaw:-0.018215864896774292 +[2026-10-05 17:28:56.416] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.416] [path_visualizer] [debug] current_cmd_angular_z:-0.001022200090893391 +[2026-10-05 17:28:56.466] [path_visualizer] [debug] current_pose_x:3.4708220123431213, current_pose_y:0.005993776727558223,current_pose_yaw:-0.018215864896774292 +[2026-10-05 17:28:56.466] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.467] [path_visualizer] [debug] current_cmd_angular_z:-0.001022200090893391 +[2026-10-05 17:28:56.516] [path_visualizer] [debug] current_pose_x:3.4708220123431213, current_pose_y:0.005993776727558223,current_pose_yaw:-0.018215864896774292 +[2026-10-05 17:28:56.516] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.517] [path_visualizer] [debug] current_cmd_angular_z:-0.001022200090893391 +[2026-10-05 17:28:56.566] [path_visualizer] [debug] current_pose_x:3.521437513751919, current_pose_y:0.005998401044247006,current_pose_yaw:-0.01825164631009102 +[2026-10-05 17:28:56.566] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.566] [path_visualizer] [debug] current_cmd_angular_z:-0.0009795367077079092 +[2026-10-05 17:28:56.616] [path_visualizer] [debug] current_pose_x:3.521437513751919, current_pose_y:0.005998401044247006,current_pose_yaw:-0.01825164631009102 +[2026-10-05 17:28:56.617] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.617] [path_visualizer] [debug] current_cmd_angular_z:-0.0009795367077079092 +[2026-10-05 17:28:56.666] [path_visualizer] [debug] current_pose_x:3.572053415078349, current_pose_y:0.006002875282476567,current_pose_yaw:-0.01828599162399769 +[2026-10-05 17:28:56.666] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.666] [path_visualizer] [debug] current_cmd_angular_z:-0.0009388076115468477 +[2026-10-05 17:28:56.716] [path_visualizer] [debug] current_pose_x:3.572053415078349, current_pose_y:0.006002875282476567,current_pose_yaw:-0.01828599162399769 +[2026-10-05 17:28:56.716] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.716] [path_visualizer] [debug] current_cmd_angular_z:-0.0009388076115468477 +[2026-10-05 17:28:56.766] [path_visualizer] [debug] current_pose_x:3.572053415078349, current_pose_y:0.006002875282476567,current_pose_yaw:-0.01828599162399769 +[2026-10-05 17:28:56.766] [path_visualizer] [debug] current_path_x:3.4869325367494586, current_path_y:9.728057207522837e-07,current_path_yaw:0.0 +[2026-10-05 17:28:56.766] [path_visualizer] [debug] current_cmd_angular_z:-0.0009388076115468477 +[2026-10-05 17:28:56.816] [path_visualizer] [debug] current_pose_x:3.6226659841370816, current_pose_y:0.006007793768147262,current_pose_yaw:-0.018318427726626396 +[2026-10-05 17:28:56.816] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:56.817] [path_visualizer] [debug] current_cmd_angular_z:-0.0009043354862229569 +[2026-10-05 17:28:56.866] [path_visualizer] [debug] current_pose_x:3.6226659841370816, current_pose_y:0.006007793768147262,current_pose_yaw:-0.018318427726626396 +[2026-10-05 17:28:56.866] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:56.866] [path_visualizer] [debug] current_cmd_angular_z:-0.0009043354862229569 +[2026-10-05 17:28:56.916] [path_visualizer] [debug] current_pose_x:3.6732778562238115, current_pose_y:0.006011624736562854,current_pose_yaw:-0.018350383266806606 +[2026-10-05 17:28:56.916] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:56.916] [path_visualizer] [debug] current_cmd_angular_z:-0.0008643658481372746 +[2026-10-05 17:28:56.966] [path_visualizer] [debug] current_pose_x:3.6732778562238115, current_pose_y:0.006011624736562854,current_pose_yaw:-0.018350383266806606 +[2026-10-05 17:28:56.966] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:56.966] [path_visualizer] [debug] current_cmd_angular_z:-0.0008643658481372746 +[2026-10-05 17:28:57.016] [path_visualizer] [debug] current_pose_x:3.6732778562238115, current_pose_y:0.006011624736562854,current_pose_yaw:-0.018350383266806606 +[2026-10-05 17:28:57.017] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.017] [path_visualizer] [debug] current_cmd_angular_z:-0.0008643658481372746 +[2026-10-05 17:28:57.066] [path_visualizer] [debug] current_pose_x:3.7238896325052337, current_pose_y:0.006016027544598995,current_pose_yaw:-0.018380427733063698 +[2026-10-05 17:28:57.066] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.066] [path_visualizer] [debug] current_cmd_angular_z:-0.0008317920371990264 +[2026-10-05 17:28:57.116] [path_visualizer] [debug] current_pose_x:3.7238896325052337, current_pose_y:0.006016027544598995,current_pose_yaw:-0.018380427733063698 +[2026-10-05 17:28:57.116] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.116] [path_visualizer] [debug] current_cmd_angular_z:-0.0008317920371990264 +[2026-10-05 17:28:57.166] [path_visualizer] [debug] current_pose_x:3.7238896325052337, current_pose_y:0.006016027544598995,current_pose_yaw:-0.018380427733063698 +[2026-10-05 17:28:57.167] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.167] [path_visualizer] [debug] current_cmd_angular_z:-0.0008317920371990264 +[2026-10-05 17:28:57.216] [path_visualizer] [debug] current_pose_x:3.7744985745771977, current_pose_y:0.006020564532673136,current_pose_yaw:-0.018409037962555885 +[2026-10-05 17:28:57.216] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.216] [path_visualizer] [debug] current_cmd_angular_z:-0.0008029252472905035 +[2026-10-05 17:28:57.266] [path_visualizer] [debug] current_pose_x:3.7744985745771977, current_pose_y:0.006020564532673136,current_pose_yaw:-0.018409037962555885 +[2026-10-05 17:28:57.266] [path_visualizer] [debug] current_path_x:3.680651011013317, current_path_y:1.0268504830162994e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.266] [path_visualizer] [debug] current_cmd_angular_z:-0.0008029252472905035 +[2026-10-05 17:28:57.316] [path_visualizer] [debug] current_pose_x:3.825106319032891, current_pose_y:0.006023671077645428,current_pose_yaw:-0.018437644466757774 +[2026-10-05 17:28:57.316] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.316] [path_visualizer] [debug] current_cmd_angular_z:-0.0007647886767664439 +[2026-10-05 17:28:57.367] [path_visualizer] [debug] current_pose_x:3.825106319032891, current_pose_y:0.006023671077645428,current_pose_yaw:-0.018437644466757774 +[2026-10-05 17:28:57.367] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.367] [path_visualizer] [debug] current_cmd_angular_z:-0.0007647886767664439 +[2026-10-05 17:28:57.416] [path_visualizer] [debug] current_pose_x:3.825106319032891, current_pose_y:0.006023671077645428,current_pose_yaw:-0.018437644466757774 +[2026-10-05 17:28:57.416] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.417] [path_visualizer] [debug] current_cmd_angular_z:-0.0007647886767664439 +[2026-10-05 17:28:57.467] [path_visualizer] [debug] current_pose_x:3.875714465603462, current_pose_y:0.0060280476759454514,current_pose_yaw:-0.018463866785168648 +[2026-10-05 17:28:57.467] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.467] [path_visualizer] [debug] current_cmd_angular_z:-0.000739695355499323 +[2026-10-05 17:28:57.516] [path_visualizer] [debug] current_pose_x:3.875714465603462, current_pose_y:0.0060280476759454514,current_pose_yaw:-0.018463866785168648 +[2026-10-05 17:28:57.517] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.517] [path_visualizer] [debug] current_cmd_angular_z:-0.000739695355499323 +[2026-10-05 17:28:57.566] [path_visualizer] [debug] current_pose_x:3.875714465603462, current_pose_y:0.0060280476759454514,current_pose_yaw:-0.018463866785168648 +[2026-10-05 17:28:57.566] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.566] [path_visualizer] [debug] current_cmd_angular_z:-0.000739695355499323 +[2026-10-05 17:28:57.616] [path_visualizer] [debug] current_pose_x:3.9263198030186715, current_pose_y:0.0060327540672539875,current_pose_yaw:-0.01848865486681461 +[2026-10-05 17:28:57.616] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.616] [path_visualizer] [debug] current_cmd_angular_z:-0.0007195315274906369 +[2026-10-05 17:28:57.666] [path_visualizer] [debug] current_pose_x:3.9263198030186715, current_pose_y:0.0060327540672539875,current_pose_yaw:-0.01848865486681461 +[2026-10-05 17:28:57.666] [path_visualizer] [debug] current_path_x:3.874369485277176, current_path_y:1.080895245280315e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.666] [path_visualizer] [debug] current_cmd_angular_z:-0.0007195315274906369 +[2026-10-05 17:28:57.717] [path_visualizer] [debug] current_pose_x:3.9769239379990893, current_pose_y:0.006036225375916122,current_pose_yaw:-0.018513441085815433 +[2026-10-05 17:28:57.717] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.717] [path_visualizer] [debug] current_cmd_angular_z:-0.0006913150909269167 +[2026-10-05 17:28:57.766] [path_visualizer] [debug] current_pose_x:3.9769239379990893, current_pose_y:0.006036225375916122,current_pose_yaw:-0.018513441085815433 +[2026-10-05 17:28:57.766] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.766] [path_visualizer] [debug] current_cmd_angular_z:-0.0006913150909269167 +[2026-10-05 17:28:57.816] [path_visualizer] [debug] current_pose_x:3.9769239379990893, current_pose_y:0.006036225375916122,current_pose_yaw:-0.018513441085815433 +[2026-10-05 17:28:57.816] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.816] [path_visualizer] [debug] current_cmd_angular_z:-0.0006913150909269167 +[2026-10-05 17:28:57.866] [path_visualizer] [debug] current_pose_x:4.027526870798374, current_pose_y:0.006038457666724695,current_pose_yaw:-0.018538225442171097 +[2026-10-05 17:28:57.866] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.866] [path_visualizer] [debug] current_cmd_angular_z:-0.0006556969548016864 +[2026-10-05 17:28:57.916] [path_visualizer] [debug] current_pose_x:4.027526870798374, current_pose_y:0.006038457666724695,current_pose_yaw:-0.018538225442171097 +[2026-10-05 17:28:57.917] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.917] [path_visualizer] [debug] current_cmd_angular_z:-0.0006556969548016864 +[2026-10-05 17:28:57.966] [path_visualizer] [debug] current_pose_x:4.078128604682517, current_pose_y:0.006039451650905504,current_pose_yaw:-0.018563011661171913 +[2026-10-05 17:28:57.966] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:57.966] [path_visualizer] [debug] current_cmd_angular_z:-0.0006123363650624644 +[2026-10-05 17:28:58.016] [path_visualizer] [debug] current_pose_x:4.078128604682517, current_pose_y:0.006039451650905504,current_pose_yaw:-0.018563011661171913 +[2026-10-05 17:28:58.016] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.017] [path_visualizer] [debug] current_cmd_angular_z:-0.0006123363650624644 +[2026-10-05 17:28:58.066] [path_visualizer] [debug] current_pose_x:4.078128604682517, current_pose_y:0.006039451650905504,current_pose_yaw:-0.018563011661171913 +[2026-10-05 17:28:58.066] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.066] [path_visualizer] [debug] current_cmd_angular_z:-0.0006123363650624644 +[2026-10-05 17:28:58.116] [path_visualizer] [debug] current_pose_x:4.128729134347906, current_pose_y:0.0060435459274127854,current_pose_yaw:-0.018583975732326508 +[2026-10-05 17:28:58.116] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.117] [path_visualizer] [debug] current_cmd_angular_z:-0.0005959951717115289 +[2026-10-05 17:28:58.166] [path_visualizer] [debug] current_pose_x:4.128729134347906, current_pose_y:0.0060435459274127854,current_pose_yaw:-0.018583975732326508 +[2026-10-05 17:28:58.166] [path_visualizer] [debug] current_path_x:4.068087959541034, current_path_y:1.1349400075443308e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.166] [path_visualizer] [debug] current_cmd_angular_z:-0.0005959951717115289 +[2026-10-05 17:28:58.216] [path_visualizer] [debug] current_pose_x:4.179328464354966, current_pose_y:0.006046602588175371,current_pose_yaw:-0.018604936078190804 +[2026-10-05 17:28:58.216] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.216] [path_visualizer] [debug] current_cmd_angular_z:-0.0005728391565168051 +[2026-10-05 17:28:58.267] [path_visualizer] [debug] current_pose_x:4.179328464354966, current_pose_y:0.006046602588175371,current_pose_yaw:-0.018604936078190804 +[2026-10-05 17:28:58.267] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.267] [path_visualizer] [debug] current_cmd_angular_z:-0.0005728391565168051 +[2026-10-05 17:28:58.316] [path_visualizer] [debug] current_pose_x:4.179328464354966, current_pose_y:0.006046602588175371,current_pose_yaw:-0.018604936078190804 +[2026-10-05 17:28:58.316] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.316] [path_visualizer] [debug] current_cmd_angular_z:-0.0005728391565168051 +[2026-10-05 17:28:58.366] [path_visualizer] [debug] current_pose_x:4.229927107796063, current_pose_y:0.0060491496138464175,current_pose_yaw:-0.018625419586896896 +[2026-10-05 17:28:58.367] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.367] [path_visualizer] [debug] current_cmd_angular_z:-0.0005477896286940967 +[2026-10-05 17:28:58.416] [path_visualizer] [debug] current_pose_x:4.229927107796063, current_pose_y:0.0060491496138464175,current_pose_yaw:-0.018625419586896896 +[2026-10-05 17:28:58.416] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.416] [path_visualizer] [debug] current_cmd_angular_z:-0.0005477896286940967 +[2026-10-05 17:28:58.467] [path_visualizer] [debug] current_pose_x:4.229927107796063, current_pose_y:0.0060491496138464175,current_pose_yaw:-0.018625419586896896 +[2026-10-05 17:28:58.467] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.467] [path_visualizer] [debug] current_cmd_angular_z:-0.0005477896286940967 +[2026-10-05 17:28:58.516] [path_visualizer] [debug] current_pose_x:4.280525655776389, current_pose_y:0.006052844504214922,current_pose_yaw:-0.018643993884325027 +[2026-10-05 17:28:58.516] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.516] [path_visualizer] [debug] current_cmd_angular_z:-0.0005337320353236419 +[2026-10-05 17:28:58.566] [path_visualizer] [debug] current_pose_x:4.280525655776389, current_pose_y:0.006052844504214922,current_pose_yaw:-0.018643993884325027 +[2026-10-05 17:28:58.567] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.567] [path_visualizer] [debug] current_cmd_angular_z:-0.0005337320353236419 +[2026-10-05 17:28:58.616] [path_visualizer] [debug] current_pose_x:4.331108220024824, current_pose_y:0.00606445244002944,current_pose_yaw:-0.018663533031940457 +[2026-10-05 17:28:58.616] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.616] [path_visualizer] [debug] current_cmd_angular_z:-0.0005671968403705152 +[2026-10-05 17:28:58.666] [path_visualizer] [debug] current_pose_x:4.331108220024824, current_pose_y:0.00606445244002944,current_pose_yaw:-0.018663533031940457 +[2026-10-05 17:28:58.667] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.667] [path_visualizer] [debug] current_cmd_angular_z:-0.0005671968403705152 +[2026-10-05 17:28:58.716] [path_visualizer] [debug] current_pose_x:4.331108220024824, current_pose_y:0.00606445244002944,current_pose_yaw:-0.018663533031940457 +[2026-10-05 17:28:58.716] [path_visualizer] [debug] current_path_x:4.261806433804893, current_path_y:1.1889847698083467e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.716] [path_visualizer] [debug] current_cmd_angular_z:-0.0005671968403705152 +[2026-10-05 17:28:58.767] [path_visualizer] [debug] current_pose_x:4.381683152804946, current_pose_y:0.006068582586589949,current_pose_yaw:-0.018681397661566734 +[2026-10-05 17:28:58.767] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.767] [path_visualizer] [debug] current_cmd_angular_z:-0.0005569409294893732 +[2026-10-05 17:28:58.816] [path_visualizer] [debug] current_pose_x:4.381683152804946, current_pose_y:0.006068582586589949,current_pose_yaw:-0.018681397661566734 +[2026-10-05 17:28:58.816] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.816] [path_visualizer] [debug] current_cmd_angular_z:-0.0005569409294893732 +[2026-10-05 17:28:58.867] [path_visualizer] [debug] current_pose_x:4.381683152804946, current_pose_y:0.006068582586589949,current_pose_yaw:-0.018681397661566734 +[2026-10-05 17:28:58.867] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.867] [path_visualizer] [debug] current_cmd_angular_z:-0.0005569409294893732 +[2026-10-05 17:28:58.916] [path_visualizer] [debug] current_pose_x:4.432246238330142, current_pose_y:0.006076719278769001,current_pose_yaw:-0.018703008070588115 +[2026-10-05 17:28:58.916] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.916] [path_visualizer] [debug] current_cmd_angular_z:-0.0005645698613365585 +[2026-10-05 17:28:58.966] [path_visualizer] [debug] current_pose_x:4.432246238330142, current_pose_y:0.006076719278769001,current_pose_yaw:-0.018703008070588115 +[2026-10-05 17:28:58.966] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:58.966] [path_visualizer] [debug] current_cmd_angular_z:-0.0005645698613365585 +[2026-10-05 17:28:59.016] [path_visualizer] [debug] current_pose_x:4.482803301112655, current_pose_y:0.006087432290013696,current_pose_yaw:-0.018724242225289345 +[2026-10-05 17:28:59.017] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.017] [path_visualizer] [debug] current_cmd_angular_z:-0.0005890518282941487 +[2026-10-05 17:28:59.066] [path_visualizer] [debug] current_pose_x:4.482803301112655, current_pose_y:0.006087432290013696,current_pose_yaw:-0.018724242225289345 +[2026-10-05 17:28:59.066] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.066] [path_visualizer] [debug] current_cmd_angular_z:-0.0005890518282941487 +[2026-10-05 17:28:59.116] [path_visualizer] [debug] current_pose_x:4.482803301112655, current_pose_y:0.006087432290013696,current_pose_yaw:-0.018724242225289345 +[2026-10-05 17:28:59.117] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.117] [path_visualizer] [debug] current_cmd_angular_z:-0.0005890518282941487 +[2026-10-05 17:28:59.166] [path_visualizer] [debug] current_pose_x:4.533363259707896, current_pose_y:0.00609401785477032,current_pose_yaw:-0.0187478456646204 +[2026-10-05 17:28:59.166] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.166] [path_visualizer] [debug] current_cmd_angular_z:-0.0005830010034323305 +[2026-10-05 17:28:59.216] [path_visualizer] [debug] current_pose_x:4.533363259707896, current_pose_y:0.00609401785477032,current_pose_yaw:-0.0187478456646204 +[2026-10-05 17:28:59.217] [path_visualizer] [debug] current_path_x:4.455524908068752, current_path_y:1.2430295320723624e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.217] [path_visualizer] [debug] current_cmd_angular_z:-0.0005830010034323305 +[2026-10-05 17:28:59.266] [path_visualizer] [debug] current_pose_x:4.583922464697679, current_pose_y:0.006097635227559192,current_pose_yaw:-0.01877286471426487 +[2026-10-05 17:28:59.266] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.266] [path_visualizer] [debug] current_cmd_angular_z:-0.0005552316849172928 +[2026-10-05 17:28:59.316] [path_visualizer] [debug] current_pose_x:4.583922464697679, current_pose_y:0.006097635227559192,current_pose_yaw:-0.01877286471426487 +[2026-10-05 17:28:59.317] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.317] [path_visualizer] [debug] current_cmd_angular_z:-0.0005552316849172928 +[2026-10-05 17:28:59.366] [path_visualizer] [debug] current_pose_x:4.583922464697679, current_pose_y:0.006097635227559192,current_pose_yaw:-0.01877286471426487 +[2026-10-05 17:28:59.367] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.367] [path_visualizer] [debug] current_cmd_angular_z:-0.0005552316849172928 +[2026-10-05 17:28:59.416] [path_visualizer] [debug] current_pose_x:4.634482347448281, current_pose_y:0.00610100911843043,current_pose_yaw:-0.018796909600496296 +[2026-10-05 17:28:59.416] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.416] [path_visualizer] [debug] current_cmd_angular_z:-0.0005282268161873882 +[2026-10-05 17:28:59.466] [path_visualizer] [debug] current_pose_x:4.634482347448281, current_pose_y:0.00610100911843043,current_pose_yaw:-0.018796909600496296 +[2026-10-05 17:28:59.466] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.466] [path_visualizer] [debug] current_cmd_angular_z:-0.0005282268161873882 +[2026-10-05 17:28:59.516] [path_visualizer] [debug] current_pose_x:4.685042830278937, current_pose_y:0.0061064376102161625,current_pose_yaw:-0.018818065524101257 +[2026-10-05 17:28:59.516] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.516] [path_visualizer] [debug] current_cmd_angular_z:-0.000519839958279554 +[2026-10-05 17:28:59.566] [path_visualizer] [debug] current_pose_x:4.685042830278937, current_pose_y:0.0061064376102161625,current_pose_yaw:-0.018818065524101257 +[2026-10-05 17:28:59.566] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.567] [path_visualizer] [debug] current_cmd_angular_z:-0.000519839958279554 +[2026-10-05 17:28:59.616] [path_visualizer] [debug] current_pose_x:4.685042830278937, current_pose_y:0.0061064376102161625,current_pose_yaw:-0.018818065524101257 +[2026-10-05 17:28:59.616] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.616] [path_visualizer] [debug] current_cmd_angular_z:-0.000519839958279554 +[2026-10-05 17:28:59.667] [path_visualizer] [debug] current_pose_x:4.73560388772953, current_pose_y:0.006110808823797617,current_pose_yaw:-0.018839197233319283 +[2026-10-05 17:28:59.667] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.667] [path_visualizer] [debug] current_cmd_angular_z:-0.000504894137103272 +[2026-10-05 17:28:59.716] [path_visualizer] [debug] current_pose_x:4.73560388772953, current_pose_y:0.006110808823797617,current_pose_yaw:-0.018839197233319283 +[2026-10-05 17:28:59.716] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.716] [path_visualizer] [debug] current_cmd_angular_z:-0.000504894137103272 +[2026-10-05 17:28:59.766] [path_visualizer] [debug] current_pose_x:4.73560388772953, current_pose_y:0.006110808823797617,current_pose_yaw:-0.018839197233319283 +[2026-10-05 17:28:59.766] [path_visualizer] [debug] current_path_x:4.649243382332611, current_path_y:1.297074294336378e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.767] [path_visualizer] [debug] current_cmd_angular_z:-0.000504894137103272 +[2026-10-05 17:28:59.816] [path_visualizer] [debug] current_pose_x:4.786165499423392, current_pose_y:0.00611412859549736,current_pose_yaw:-0.018860306590795517 +[2026-10-05 17:28:59.816] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.816] [path_visualizer] [debug] current_cmd_angular_z:-0.00048308435468528976 +[2026-10-05 17:28:59.867] [path_visualizer] [debug] current_pose_x:4.786165499423392, current_pose_y:0.00611412859549736,current_pose_yaw:-0.018860306590795517 +[2026-10-05 17:28:59.867] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.867] [path_visualizer] [debug] current_cmd_angular_z:-0.00048308435468528976 +[2026-10-05 17:28:59.916] [path_visualizer] [debug] current_pose_x:4.836727656098491, current_pose_y:0.0061164036495635335,current_pose_yaw:-0.018881389871239662 +[2026-10-05 17:28:59.916] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.916] [path_visualizer] [debug] current_cmd_angular_z:-0.0004551355841998575 +[2026-10-05 17:28:59.967] [path_visualizer] [debug] current_pose_x:4.836727656098491, current_pose_y:0.0061164036495635335,current_pose_yaw:-0.018881389871239662 +[2026-10-05 17:28:59.967] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:28:59.967] [path_visualizer] [debug] current_cmd_angular_z:-0.0004551355841998575 +[2026-10-05 17:29:00.016] [path_visualizer] [debug] current_pose_x:4.836727656098491, current_pose_y:0.0061164036495635335,current_pose_yaw:-0.018881389871239662 +[2026-10-05 17:29:00.016] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.016] [path_visualizer] [debug] current_cmd_angular_z:-0.0004551355841998575 +[2026-10-05 17:29:00.066] [path_visualizer] [debug] current_pose_x:4.887290866206308, current_pose_y:0.006118166082169497,current_pose_yaw:-0.01890197023749351 +[2026-10-05 17:29:00.067] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.067] [path_visualizer] [debug] current_cmd_angular_z:-0.0004249890496635725 +[2026-10-05 17:29:00.116] [path_visualizer] [debug] current_pose_x:4.887290866206308, current_pose_y:0.006118166082169497,current_pose_yaw:-0.01890197023749351 +[2026-10-05 17:29:00.116] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.116] [path_visualizer] [debug] current_cmd_angular_z:-0.0004249890496635725 +[2026-10-05 17:29:00.166] [path_visualizer] [debug] current_pose_x:4.887290866206308, current_pose_y:0.006118166082169497,current_pose_yaw:-0.01890197023749351 +[2026-10-05 17:29:00.166] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.166] [path_visualizer] [debug] current_cmd_angular_z:-0.0004249890496635725 +[2026-10-05 17:29:00.216] [path_visualizer] [debug] current_pose_x:4.93785570950348, current_pose_y:0.006121084960895835,current_pose_yaw:-0.018920613452792164 +[2026-10-05 17:29:00.217] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.217] [path_visualizer] [debug] current_cmd_angular_z:-0.00040594394403393325 +[2026-10-05 17:29:00.266] [path_visualizer] [debug] current_pose_x:4.93785570950348, current_pose_y:0.006121084960895835,current_pose_yaw:-0.018920613452792164 +[2026-10-05 17:29:00.266] [path_visualizer] [debug] current_path_x:4.842961856596469, current_path_y:1.3511190566003936e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.266] [path_visualizer] [debug] current_cmd_angular_z:-0.00040594394403393325 +[2026-10-05 17:29:00.316] [path_visualizer] [debug] current_pose_x:4.988419450695902, current_pose_y:0.006124727095486243,current_pose_yaw:-0.018937792629003528 +[2026-10-05 17:29:00.316] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.316] [path_visualizer] [debug] current_cmd_angular_z:-0.00039400910157583874 +[2026-10-05 17:29:00.366] [path_visualizer] [debug] current_pose_x:4.988419450695902, current_pose_y:0.006124727095486243,current_pose_yaw:-0.018937792629003528 +[2026-10-05 17:29:00.366] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.367] [path_visualizer] [debug] current_cmd_angular_z:-0.00039400910157583874 +[2026-10-05 17:29:00.416] [path_visualizer] [debug] current_pose_x:4.988419450695902, current_pose_y:0.006124727095486243,current_pose_yaw:-0.018937792629003528 +[2026-10-05 17:29:00.416] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.416] [path_visualizer] [debug] current_cmd_angular_z:-0.00039400910157583874 +[2026-10-05 17:29:00.466] [path_visualizer] [debug] current_pose_x:5.038983711918162, current_pose_y:0.006127528944884298,current_pose_yaw:-0.018954942002892494 +[2026-10-05 17:29:00.466] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.466] [path_visualizer] [debug] current_cmd_angular_z:-0.00037722030892863023 +[2026-10-05 17:29:00.517] [path_visualizer] [debug] current_pose_x:5.038983711918162, current_pose_y:0.006127528944884298,current_pose_yaw:-0.018954942002892494 +[2026-10-05 17:29:00.517] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.517] [path_visualizer] [debug] current_cmd_angular_z:-0.00037722030892863023 +[2026-10-05 17:29:00.566] [path_visualizer] [debug] current_pose_x:5.089548484785673, current_pose_y:0.00612949069958344,current_pose_yaw:-0.018972063437104225 +[2026-10-05 17:29:00.566] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.566] [path_visualizer] [debug] current_cmd_angular_z:-0.0003552372837131307 +[2026-10-05 17:29:00.616] [path_visualizer] [debug] current_pose_x:5.089548484785673, current_pose_y:0.00612949069958344,current_pose_yaw:-0.018972063437104225 +[2026-10-05 17:29:00.616] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.616] [path_visualizer] [debug] current_cmd_angular_z:-0.0003552372837131307 +[2026-10-05 17:29:00.667] [path_visualizer] [debug] current_pose_x:5.089548484785673, current_pose_y:0.00612949069958344,current_pose_yaw:-0.018972063437104225 +[2026-10-05 17:29:00.667] [path_visualizer] [debug] current_path_x:5.036680330860329, current_path_y:1.4051638188644096e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.667] [path_visualizer] [debug] current_cmd_angular_z:-0.0003552372837131307 +[2026-10-05 17:29:00.716] [path_visualizer] [debug] current_pose_x:5.140113761869266, current_pose_y:0.00613061657112672,current_pose_yaw:-0.01898915320634842 +[2026-10-05 17:29:00.716] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.716] [path_visualizer] [debug] current_cmd_angular_z:-0.00032775604837690514 +[2026-10-05 17:29:00.766] [path_visualizer] [debug] current_pose_x:5.140113761869266, current_pose_y:0.00613061657112672,current_pose_yaw:-0.01898915320634842 +[2026-10-05 17:29:00.766] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.766] [path_visualizer] [debug] current_cmd_angular_z:-0.00032775604837690514 +[2026-10-05 17:29:00.816] [path_visualizer] [debug] current_pose_x:5.1906795386159, current_pose_y:0.006130905636035383,current_pose_yaw:-0.019006213173270226 +[2026-10-05 17:29:00.816] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.816] [path_visualizer] [debug] current_cmd_angular_z:-0.0002954426045219255 +[2026-10-05 17:29:00.866] [path_visualizer] [debug] current_pose_x:5.1906795386159, current_pose_y:0.006130905636035383,current_pose_yaw:-0.019006213173270226 +[2026-10-05 17:29:00.867] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.867] [path_visualizer] [debug] current_cmd_angular_z:-0.0002954426045219255 +[2026-10-05 17:29:00.916] [path_visualizer] [debug] current_pose_x:5.1906795386159, current_pose_y:0.006130905636035383,current_pose_yaw:-0.019006213173270226 +[2026-10-05 17:29:00.916] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.916] [path_visualizer] [debug] current_cmd_angular_z:-0.0002954426045219255 +[2026-10-05 17:29:00.966] [path_visualizer] [debug] current_pose_x:5.241245798539223, current_pose_y:0.006134701143005346,current_pose_yaw:-0.019019419327378276 +[2026-10-05 17:29:00.967] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:00.967] [path_visualizer] [debug] current_cmd_angular_z:-0.00029275003785314557 +[2026-10-05 17:29:01.016] [path_visualizer] [debug] current_pose_x:5.241245798539223, current_pose_y:0.006134701143005346,current_pose_yaw:-0.019019419327378276 +[2026-10-05 17:29:01.016] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.016] [path_visualizer] [debug] current_cmd_angular_z:-0.00029275003785314557 +[2026-10-05 17:29:01.066] [path_visualizer] [debug] current_pose_x:5.241245798539223, current_pose_y:0.006134701143005346,current_pose_yaw:-0.019019419327378276 +[2026-10-05 17:29:01.067] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.067] [path_visualizer] [debug] current_cmd_angular_z:-0.00029275003785314557 +[2026-10-05 17:29:01.116] [path_visualizer] [debug] current_pose_x:5.291812545556134, current_pose_y:0.00613786608056919,current_pose_yaw:-0.01903259009122849 +[2026-10-05 17:29:01.117] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.117] [path_visualizer] [debug] current_cmd_angular_z:-0.0002861875525306326 +[2026-10-05 17:29:01.167] [path_visualizer] [debug] current_pose_x:5.291812545556134, current_pose_y:0.00613786608056919,current_pose_yaw:-0.01903259009122849 +[2026-10-05 17:29:01.167] [path_visualizer] [debug] current_path_x:5.230398805124188, current_path_y:1.4592085811284253e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.167] [path_visualizer] [debug] current_cmd_angular_z:-0.0002861875525306326 +[2026-10-05 17:29:01.216] [path_visualizer] [debug] current_pose_x:5.342379768006184, current_pose_y:0.00614039907702222,current_pose_yaw:-0.01904572732746601 +[2026-10-05 17:29:01.217] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.217] [path_visualizer] [debug] current_cmd_angular_z:-0.00027540510332939305 +[2026-10-05 17:29:01.266] [path_visualizer] [debug] current_pose_x:5.342379768006184, current_pose_y:0.00614039907702222,current_pose_yaw:-0.01904572732746601 +[2026-10-05 17:29:01.266] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.266] [path_visualizer] [debug] current_cmd_angular_z:-0.00027540510332939305 +[2026-10-05 17:29:01.317] [path_visualizer] [debug] current_pose_x:5.342379768006184, current_pose_y:0.00614039907702222,current_pose_yaw:-0.01904572732746601 +[2026-10-05 17:29:01.317] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.317] [path_visualizer] [debug] current_cmd_angular_z:-0.00027540510332939305 +[2026-10-05 17:29:01.366] [path_visualizer] [debug] current_pose_x:5.392942098095346, current_pose_y:0.006140130767689507,current_pose_yaw:-0.019057780504226685 +[2026-10-05 17:29:01.366] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.366] [path_visualizer] [debug] current_cmd_angular_z:-0.00024962197074665515 +[2026-10-05 17:29:01.416] [path_visualizer] [debug] current_pose_x:5.392942098095346, current_pose_y:0.006140130767689507,current_pose_yaw:-0.019057780504226685 +[2026-10-05 17:29:01.417] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.417] [path_visualizer] [debug] current_cmd_angular_z:-0.00024962197074665515 +[2026-10-05 17:29:01.466] [path_visualizer] [debug] current_pose_x:5.443491148209138, current_pose_y:0.006133223411836615,current_pose_yaw:-0.019067106768488884 +[2026-10-05 17:29:01.466] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.466] [path_visualizer] [debug] current_cmd_angular_z:-0.00018780243497879684 +[2026-10-05 17:29:01.516] [path_visualizer] [debug] current_pose_x:5.443491148209138, current_pose_y:0.006133223411836615,current_pose_yaw:-0.019067106768488884 +[2026-10-05 17:29:01.517] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.517] [path_visualizer] [debug] current_cmd_angular_z:-0.00018780243497879684 +[2026-10-05 17:29:01.566] [path_visualizer] [debug] current_pose_x:5.443491148209138, current_pose_y:0.006133223411836615,current_pose_yaw:-0.019067106768488884 +[2026-10-05 17:29:01.566] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.566] [path_visualizer] [debug] current_cmd_angular_z:-0.00018780243497879684 +[2026-10-05 17:29:01.616] [path_visualizer] [debug] current_pose_x:5.494038972195268, current_pose_y:0.006126092950373933,current_pose_yaw:-0.019074929878115654 +[2026-10-05 17:29:01.616] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.616] [path_visualizer] [debug] current_cmd_angular_z:-0.00012759491718489918 +[2026-10-05 17:29:01.666] [path_visualizer] [debug] current_pose_x:5.494038972195268, current_pose_y:0.006126092950373933,current_pose_yaw:-0.019074929878115654 +[2026-10-05 17:29:01.666] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.666] [path_visualizer] [debug] current_cmd_angular_z:-0.00012759491718489918 +[2026-10-05 17:29:01.716] [path_visualizer] [debug] current_pose_x:5.494038972195268, current_pose_y:0.006126092950373933,current_pose_yaw:-0.019074929878115654 +[2026-10-05 17:29:01.716] [path_visualizer] [debug] current_path_x:5.424117279388046, current_path_y:1.513253343392441e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.716] [path_visualizer] [debug] current_cmd_angular_z:-0.00012759491718489918 +[2026-10-05 17:29:01.766] [path_visualizer] [debug] current_pose_x:5.544588278883707, current_pose_y:0.006122129283125692,current_pose_yaw:-0.019079886376857758 +[2026-10-05 17:29:01.766] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.766] [path_visualizer] [debug] current_cmd_angular_z:-9.257351751204568e-05 +[2026-10-05 17:29:01.816] [path_visualizer] [debug] current_pose_x:5.544588278883707, current_pose_y:0.006122129283125692,current_pose_yaw:-0.019079886376857758 +[2026-10-05 17:29:01.816] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.816] [path_visualizer] [debug] current_cmd_angular_z:-9.257351751204568e-05 +[2026-10-05 17:29:01.866] [path_visualizer] [debug] current_pose_x:5.595145513740306, current_pose_y:0.006133284603511118,current_pose_yaw:-0.019091157242655754 +[2026-10-05 17:29:01.866] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.866] [path_visualizer] [debug] current_cmd_angular_z:-0.0001397461507467515 +[2026-10-05 17:29:01.916] [path_visualizer] [debug] current_pose_x:5.595145513740306, current_pose_y:0.006133284603511118,current_pose_yaw:-0.019091157242655754 +[2026-10-05 17:29:01.916] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.916] [path_visualizer] [debug] current_cmd_angular_z:-0.0001397461507467515 +[2026-10-05 17:29:01.966] [path_visualizer] [debug] current_pose_x:5.595145513740306, current_pose_y:0.006133284603511118,current_pose_yaw:-0.019091157242655754 +[2026-10-05 17:29:01.967] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:01.967] [path_visualizer] [debug] current_cmd_angular_z:-0.0001397461507467515 +[2026-10-05 17:29:02.016] [path_visualizer] [debug] current_pose_x:5.6457047802290035, current_pose_y:0.006150909870079422,current_pose_yaw:-0.019101437181234363 +[2026-10-05 17:29:02.016] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.016] [path_visualizer] [debug] current_cmd_angular_z:-0.00022933404987875855 +[2026-10-05 17:29:02.067] [path_visualizer] [debug] current_pose_x:5.6457047802290035, current_pose_y:0.006150909870079422,current_pose_yaw:-0.019101437181234363 +[2026-10-05 17:29:02.067] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.067] [path_visualizer] [debug] current_cmd_angular_z:-0.00022933404987875855 +[2026-10-05 17:29:02.116] [path_visualizer] [debug] current_pose_x:5.696264268518363, current_pose_y:0.006164286286984903,current_pose_yaw:-0.01911439187824726 +[2026-10-05 17:29:02.116] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.116] [path_visualizer] [debug] current_cmd_angular_z:-0.00028701952720494583 +[2026-10-05 17:29:02.166] [path_visualizer] [debug] current_pose_x:5.696264268518363, current_pose_y:0.006164286286984903,current_pose_yaw:-0.01911439187824726 +[2026-10-05 17:29:02.166] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.167] [path_visualizer] [debug] current_cmd_angular_z:-0.00028701952720494583 +[2026-10-05 17:29:02.216] [path_visualizer] [debug] current_pose_x:5.696264268518363, current_pose_y:0.006164286286984903,current_pose_yaw:-0.01911439187824726 +[2026-10-05 17:29:02.216] [path_visualizer] [debug] current_path_x:5.617835753651905, current_path_y:1.5672981056564567e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.216] [path_visualizer] [debug] current_cmd_angular_z:-0.00028701952720494583 +[2026-10-05 17:29:02.266] [path_visualizer] [debug] current_pose_x:5.7468257818039605, current_pose_y:0.006174247373466722,current_pose_yaw:-0.019129544496536255 +[2026-10-05 17:29:02.266] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.267] [path_visualizer] [debug] current_cmd_angular_z:-0.00031862755139285687 +[2026-10-05 17:29:02.316] [path_visualizer] [debug] current_pose_x:5.7468257818039605, current_pose_y:0.006174247373466722,current_pose_yaw:-0.019129544496536255 +[2026-10-05 17:29:02.316] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.316] [path_visualizer] [debug] current_cmd_angular_z:-0.00031862755139285687 +[2026-10-05 17:29:02.366] [path_visualizer] [debug] current_pose_x:5.7468257818039605, current_pose_y:0.006174247373466722,current_pose_yaw:-0.019129544496536255 +[2026-10-05 17:29:02.366] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.366] [path_visualizer] [debug] current_cmd_angular_z:-0.00031862755139285687 +[2026-10-05 17:29:02.416] [path_visualizer] [debug] current_pose_x:5.797386178540636, current_pose_y:0.006181900455161294,current_pose_yaw:-0.019145935773849484 +[2026-10-05 17:29:02.417] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.417] [path_visualizer] [debug] current_cmd_angular_z:-0.00033367230290582556 +[2026-10-05 17:29:02.467] [path_visualizer] [debug] current_pose_x:5.797386178540636, current_pose_y:0.006181900455161294,current_pose_yaw:-0.019145935773849484 +[2026-10-05 17:29:02.467] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.467] [path_visualizer] [debug] current_cmd_angular_z:-0.00033367230290582556 +[2026-10-05 17:29:02.517] [path_visualizer] [debug] current_pose_x:5.847947092906781, current_pose_y:0.006188898756502145,current_pose_yaw:-0.019162124022841454 +[2026-10-05 17:29:02.517] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.517] [path_visualizer] [debug] current_cmd_angular_z:-0.0003450311052961008 +[2026-10-05 17:29:02.566] [path_visualizer] [debug] current_pose_x:5.847947092906781, current_pose_y:0.006188898756502145,current_pose_yaw:-0.019162124022841454 +[2026-10-05 17:29:02.566] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.566] [path_visualizer] [debug] current_cmd_angular_z:-0.0003450311052961008 +[2026-10-05 17:29:02.616] [path_visualizer] [debug] current_pose_x:5.847947092906781, current_pose_y:0.006188898756502145,current_pose_yaw:-0.019162124022841454 +[2026-10-05 17:29:02.616] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.617] [path_visualizer] [debug] current_cmd_angular_z:-0.0003450311052961008 +[2026-10-05 17:29:02.666] [path_visualizer] [debug] current_pose_x:5.898510639560085, current_pose_y:0.006193127324383801,current_pose_yaw:-0.019180011004209515 +[2026-10-05 17:29:02.666] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.666] [path_visualizer] [debug] current_cmd_angular_z:-0.0003356832202742466 +[2026-10-05 17:29:02.716] [path_visualizer] [debug] current_pose_x:5.898510639560085, current_pose_y:0.006193127324383801,current_pose_yaw:-0.019180011004209515 +[2026-10-05 17:29:02.716] [path_visualizer] [debug] current_path_x:5.811554227915764, current_path_y:1.6213428679204726e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.716] [path_visualizer] [debug] current_cmd_angular_z:-0.0003356832202742466 +[2026-10-05 17:29:02.766] [path_visualizer] [debug] current_pose_x:5.949074698032369, current_pose_y:0.006196676859201466,current_pose_yaw:-0.019197680056095123 +[2026-10-05 17:29:02.766] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.766] [path_visualizer] [debug] current_cmd_angular_z:-0.0003221898837280149 +[2026-10-05 17:29:02.817] [path_visualizer] [debug] current_pose_x:5.949074698032369, current_pose_y:0.006196676859201466,current_pose_yaw:-0.019197680056095123 +[2026-10-05 17:29:02.817] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.817] [path_visualizer] [debug] current_cmd_angular_z:-0.0003221898837280149 +[2026-10-05 17:29:02.866] [path_visualizer] [debug] current_pose_x:5.949074698032369, current_pose_y:0.006196676859201466,current_pose_yaw:-0.019197680056095123 +[2026-10-05 17:29:02.866] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.866] [path_visualizer] [debug] current_cmd_angular_z:-0.0003221898837280149 +[2026-10-05 17:29:02.917] [path_visualizer] [debug] current_pose_x:5.999638717478558, current_pose_y:0.006200109464959711,current_pose_yaw:-0.019214646890759468 +[2026-10-05 17:29:02.917] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.917] [path_visualizer] [debug] current_cmd_angular_z:-0.000309707989320486 +[2026-10-05 17:29:02.966] [path_visualizer] [debug] current_pose_x:5.999638717478558, current_pose_y:0.006200109464959711,current_pose_yaw:-0.019214646890759468 +[2026-10-05 17:29:02.967] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:02.967] [path_visualizer] [debug] current_cmd_angular_z:-0.000309707989320486 +[2026-10-05 17:29:03.017] [path_visualizer] [debug] current_pose_x:6.050201574076938, current_pose_y:0.006204576275340791,current_pose_yaw:-0.019229946658015248 +[2026-10-05 17:29:03.017] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:03.017] [path_visualizer] [debug] current_cmd_angular_z:-0.00030702339937432876 +[2026-10-05 17:29:03.067] [path_visualizer] [debug] current_pose_x:6.050201574076938, current_pose_y:0.006204576275340791,current_pose_yaw:-0.019229946658015248 +[2026-10-05 17:29:03.067] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:03.067] [path_visualizer] [debug] current_cmd_angular_z:-0.00030702339937432876 +[2026-10-05 17:29:03.116] [path_visualizer] [debug] current_pose_x:6.050201574076938, current_pose_y:0.006204576275340791,current_pose_yaw:-0.019229946658015248 +[2026-10-05 17:29:03.116] [path_visualizer] [debug] current_path_x:6.005272702179623, current_path_y:1.6753876301844883e-06,current_path_yaw:0.0 +[2026-10-05 17:29:03.116] [path_visualizer] [debug] current_cmd_angular_z:-0.00030702339937432876 +[2026-10-05 17:29:03.167] [path_visualizer] [debug] current_pose_x:6.100764879159353, current_pose_y:0.006208539839082049,current_pose_yaw:-0.019245004281401634 +[2026-10-05 17:29:03.167] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.167] [path_visualizer] [debug] current_cmd_angular_z:0.3700060504748971 +[2026-10-05 17:29:03.216] [path_visualizer] [debug] current_pose_x:6.100764879159353, current_pose_y:0.006208539839082049,current_pose_yaw:-0.019245004281401634 +[2026-10-05 17:29:03.216] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.216] [path_visualizer] [debug] current_cmd_angular_z:0.3700060504748971 +[2026-10-05 17:29:03.266] [path_visualizer] [debug] current_pose_x:6.100764879159353, current_pose_y:0.006208539839082049,current_pose_yaw:-0.019245004281401634 +[2026-10-05 17:29:03.266] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.266] [path_visualizer] [debug] current_cmd_angular_z:0.3700060504748971 +[2026-10-05 17:29:03.316] [path_visualizer] [debug] current_pose_x:6.151328254825194, current_pose_y:0.006838425271676197,current_pose_yaw:-0.018696933984756473 +[2026-10-05 17:29:03.316] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.316] [path_visualizer] [debug] current_cmd_angular_z:0.4099759918067618 +[2026-10-05 17:29:03.367] [path_visualizer] [debug] current_pose_x:6.151328254825194, current_pose_y:0.006838425271676197,current_pose_yaw:-0.018696933984756473 +[2026-10-05 17:29:03.367] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.367] [path_visualizer] [debug] current_cmd_angular_z:0.4099759918067618 +[2026-10-05 17:29:03.416] [path_visualizer] [debug] current_pose_x:6.201851402726167, current_pose_y:0.015776856158402436,current_pose_yaw:-0.010818736627697945 +[2026-10-05 17:29:03.416] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.417] [path_visualizer] [debug] current_cmd_angular_z:0.38386607878667905 +[2026-10-05 17:29:03.466] [path_visualizer] [debug] current_pose_x:6.201851402726167, current_pose_y:0.015776856158402436,current_pose_yaw:-0.010818736627697945 +[2026-10-05 17:29:03.467] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.467] [path_visualizer] [debug] current_cmd_angular_z:0.38386607878667905 +[2026-10-05 17:29:03.516] [path_visualizer] [debug] current_pose_x:6.201851402726167, current_pose_y:0.015776856158402436,current_pose_yaw:-0.010818736627697945 +[2026-10-05 17:29:03.516] [path_visualizer] [debug] current_path_x:6.146262740500577, current_path_y:0.02017269184405583,current_path_yaw:0.142799666 +[2026-10-05 17:29:03.516] [path_visualizer] [debug] current_cmd_angular_z:0.38386607878667905 +[2026-10-05 17:29:03.566] [path_visualizer] [debug] current_pose_x:6.252182696055914, current_pose_y:0.03155112438578369,current_pose_yaw:0.0026879289653152227 +[2026-10-05 17:29:03.567] [path_visualizer] [debug] current_path_x:6.287252778821532, current_path_y:0.04034370830048148,current_path_yaw:0.285599332 +[2026-10-05 17:29:03.567] [path_visualizer] [debug] current_cmd_angular_z:0.5567980614143364 +[2026-10-05 17:29:03.616] [path_visualizer] [debug] current_pose_x:6.252182696055914, current_pose_y:0.03155112438578369,current_pose_yaw:0.0026879289653152227 +[2026-10-05 17:29:03.616] [path_visualizer] [debug] current_path_x:6.287252778821532, current_path_y:0.04034370830048148,current_path_yaw:0.285599332 +[2026-10-05 17:29:03.616] [path_visualizer] [debug] current_cmd_angular_z:0.5567980614143364 +[2026-10-05 17:29:03.666] [path_visualizer] [debug] current_pose_x:6.252182696055914, current_pose_y:0.03155112438578369,current_pose_yaw:0.0026879289653152227 +[2026-10-05 17:29:03.666] [path_visualizer] [debug] current_path_x:6.287252778821532, current_path_y:0.04034370830048148,current_path_yaw:0.285599332 +[2026-10-05 17:29:03.666] [path_visualizer] [debug] current_cmd_angular_z:0.5567980614143364 +[2026-10-05 17:29:03.716] [path_visualizer] [debug] current_pose_x:6.302304755942518, current_pose_y:0.04798163663408409,current_pose_yaw:0.01616819016635418 +[2026-10-05 17:29:03.716] [path_visualizer] [debug] current_path_x:6.287252778821532, current_path_y:0.04034370830048148,current_path_yaw:0.285599332 +[2026-10-05 17:29:03.716] [path_visualizer] [debug] current_cmd_angular_z:0.5195630173508325 +[2026-10-05 17:29:03.766] [path_visualizer] [debug] current_pose_x:6.302304755942518, current_pose_y:0.04798163663408409,current_pose_yaw:0.01616819016635418 +[2026-10-05 17:29:03.766] [path_visualizer] [debug] current_path_x:6.287252778821532, current_path_y:0.04034370830048148,current_path_yaw:0.285599332 +[2026-10-05 17:29:03.766] [path_visualizer] [debug] current_cmd_angular_z:0.5195630173508325 +[2026-10-05 17:29:03.817] [path_visualizer] [debug] current_pose_x:6.351916288130804, current_pose_y:0.07067794712878976,current_pose_yaw:0.034577932208776474 +[2026-10-05 17:29:03.817] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:03.817] [path_visualizer] [debug] current_cmd_angular_z:0.7814091796360545 +[2026-10-05 17:29:03.866] [path_visualizer] [debug] current_pose_x:6.351916288130804, current_pose_y:0.07067794712878976,current_pose_yaw:0.034577932208776474 +[2026-10-05 17:29:03.866] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:03.866] [path_visualizer] [debug] current_cmd_angular_z:0.7814091796360545 +[2026-10-05 17:29:03.916] [path_visualizer] [debug] current_pose_x:6.351916288130804, current_pose_y:0.07067794712878976,current_pose_yaw:0.034577932208776474 +[2026-10-05 17:29:03.917] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:03.917] [path_visualizer] [debug] current_cmd_angular_z:0.7814091796360545 +[2026-10-05 17:29:03.966] [path_visualizer] [debug] current_pose_x:6.401133557127947, current_pose_y:0.09388980369467156,current_pose_yaw:0.052628785371780396 +[2026-10-05 17:29:03.966] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:03.966] [path_visualizer] [debug] current_cmd_angular_z:0.7411283981855619 +[2026-10-05 17:29:04.016] [path_visualizer] [debug] current_pose_x:6.401133557127947, current_pose_y:0.09388980369467156,current_pose_yaw:0.052628785371780396 +[2026-10-05 17:29:04.017] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:04.017] [path_visualizer] [debug] current_cmd_angular_z:0.7411283981855619 +[2026-10-05 17:29:04.066] [path_visualizer] [debug] current_pose_x:6.449224909907802, current_pose_y:0.12549140626781818,current_pose_yaw:0.07734033465385437 +[2026-10-05 17:29:04.066] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:04.066] [path_visualizer] [debug] current_cmd_angular_z:0.6369113096660792 +[2026-10-05 17:29:04.116] [path_visualizer] [debug] current_pose_x:6.449224909907802, current_pose_y:0.12549140626781818,current_pose_yaw:0.07734033465385437 +[2026-10-05 17:29:04.116] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:04.116] [path_visualizer] [debug] current_cmd_angular_z:0.6369113096660792 +[2026-10-05 17:29:04.166] [path_visualizer] [debug] current_pose_x:6.449224909907802, current_pose_y:0.12549140626781818,current_pose_yaw:0.07734033465385437 +[2026-10-05 17:29:04.166] [path_visualizer] [debug] current_path_x:6.41682066455334, current_path_y:0.0992224347612564,current_path_yaw:0.428398998 +[2026-10-05 17:29:04.166] [path_visualizer] [debug] current_cmd_angular_z:0.6369113096660792 +[2026-10-05 17:29:04.217] [path_visualizer] [debug] current_pose_x:6.4965644626534935, current_pose_y:0.15795842654537007,current_pose_yaw:0.10172297060489656 +[2026-10-05 17:29:04.217] [path_visualizer] [debug] current_path_x:6.5463885502851475, current_path_y:0.15810116122203133,current_path_yaw:0.571198664 +[2026-10-05 17:29:04.217] [path_visualizer] [debug] current_cmd_angular_z:0.7714440018287865 +[2026-10-05 17:29:04.266] [path_visualizer] [debug] current_pose_x:6.4965644626534935, current_pose_y:0.15795842654537007,current_pose_yaw:0.10172297060489656 +[2026-10-05 17:29:04.266] [path_visualizer] [debug] current_path_x:6.5463885502851475, current_path_y:0.15810116122203133,current_path_yaw:0.571198664 +[2026-10-05 17:29:04.266] [path_visualizer] [debug] current_cmd_angular_z:0.7714440018287865 +[2026-10-05 17:29:04.316] [path_visualizer] [debug] current_pose_x:6.4965644626534935, current_pose_y:0.15795842654537007,current_pose_yaw:0.10172297060489656 +[2026-10-05 17:29:04.316] [path_visualizer] [debug] current_path_x:6.5463885502851475, current_path_y:0.15810116122203133,current_path_yaw:0.571198664 +[2026-10-05 17:29:04.316] [path_visualizer] [debug] current_cmd_angular_z:0.7714440018287865 +[2026-10-05 17:29:04.366] [path_visualizer] [debug] current_pose_x:6.5434949618053135, current_pose_y:0.18888348276269332,current_pose_yaw:0.12372322380542755 +[2026-10-05 17:29:04.367] [path_visualizer] [debug] current_path_x:6.5463885502851475, current_path_y:0.15810116122203133,current_path_yaw:0.571198664 +[2026-10-05 17:29:04.367] [path_visualizer] [debug] current_cmd_angular_z:0.7234302782218756 +[2026-10-05 17:29:04.416] [path_visualizer] [debug] current_pose_x:6.5434949618053135, current_pose_y:0.18888348276269332,current_pose_yaw:0.12372322380542755 +[2026-10-05 17:29:04.416] [path_visualizer] [debug] current_path_x:6.5463885502851475, current_path_y:0.15810116122203133,current_path_yaw:0.571198664 +[2026-10-05 17:29:04.416] [path_visualizer] [debug] current_cmd_angular_z:0.7234302782218756 +[2026-10-05 17:29:04.466] [path_visualizer] [debug] current_pose_x:6.588979547736777, current_pose_y:0.22527595749479154,current_pose_yaw:0.14968512952327728 +[2026-10-05 17:29:04.467] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.467] [path_visualizer] [debug] current_cmd_angular_z:0.9835328999717129 +[2026-10-05 17:29:04.516] [path_visualizer] [debug] current_pose_x:6.588979547736777, current_pose_y:0.22527595749479154,current_pose_yaw:0.14968512952327728 +[2026-10-05 17:29:04.516] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.516] [path_visualizer] [debug] current_cmd_angular_z:0.9835328999717129 +[2026-10-05 17:29:04.566] [path_visualizer] [debug] current_pose_x:6.588979547736777, current_pose_y:0.22527595749479154,current_pose_yaw:0.14968512952327728 +[2026-10-05 17:29:04.567] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.567] [path_visualizer] [debug] current_cmd_angular_z:0.9835328999717129 +[2026-10-05 17:29:04.616] [path_visualizer] [debug] current_pose_x:6.6337381869781336, current_pose_y:0.26166910511762437,current_pose_yaw:0.17460061609745026 +[2026-10-05 17:29:04.616] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.616] [path_visualizer] [debug] current_cmd_angular_z:0.9449792602105995 +[2026-10-05 17:29:04.666] [path_visualizer] [debug] current_pose_x:6.6337381869781336, current_pose_y:0.26166910511762437,current_pose_yaw:0.17460061609745026 +[2026-10-05 17:29:04.667] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.667] [path_visualizer] [debug] current_cmd_angular_z:0.9449792602105995 +[2026-10-05 17:29:04.716] [path_visualizer] [debug] current_pose_x:6.675933143792197, current_pose_y:0.3064774292003506,current_pose_yaw:0.2061471790075302 +[2026-10-05 17:29:04.716] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.716] [path_visualizer] [debug] current_cmd_angular_z:0.8429932749243391 +[2026-10-05 17:29:04.767] [path_visualizer] [debug] current_pose_x:6.675933143792197, current_pose_y:0.3064774292003506,current_pose_yaw:0.2061471790075302 +[2026-10-05 17:29:04.767] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.767] [path_visualizer] [debug] current_cmd_angular_z:0.8429932749243391 +[2026-10-05 17:29:04.816] [path_visualizer] [debug] current_pose_x:6.675933143792197, current_pose_y:0.3064774292003506,current_pose_yaw:0.2061471790075302 +[2026-10-05 17:29:04.817] [path_visualizer] [debug] current_path_x:6.654037359590546, current_path_y:0.2509175982974925,current_path_yaw:0.7139983299999999 +[2026-10-05 17:29:04.817] [path_visualizer] [debug] current_cmd_angular_z:0.8429932749243391 +[2026-10-05 17:29:04.866] [path_visualizer] [debug] current_pose_x:6.716791053068276, current_pose_y:0.3523050017387136,current_pose_yaw:0.2373965829610825 +[2026-10-05 17:29:04.866] [path_visualizer] [debug] current_path_x:6.761686168895946, current_path_y:0.3437340353729536,current_path_yaw:0.856797996 +[2026-10-05 17:29:04.866] [path_visualizer] [debug] current_cmd_angular_z:0.9919774931045731 +[2026-10-05 17:29:04.916] [path_visualizer] [debug] current_pose_x:6.716791053068276, current_pose_y:0.3523050017387136,current_pose_yaw:0.2373965829610825 +[2026-10-05 17:29:04.916] [path_visualizer] [debug] current_path_x:6.761686168895946, current_path_y:0.3437340353729536,current_path_yaw:0.856797996 +[2026-10-05 17:29:04.916] [path_visualizer] [debug] current_cmd_angular_z:0.9919774931045731 +[2026-10-05 17:29:04.966] [path_visualizer] [debug] current_pose_x:6.757147276950232, current_pose_y:0.3962505324915213,current_pose_yaw:0.26577892899513245 +[2026-10-05 17:29:04.966] [path_visualizer] [debug] current_path_x:6.761686168895946, current_path_y:0.3437340353729536,current_path_yaw:0.856797996 +[2026-10-05 17:29:04.966] [path_visualizer] [debug] current_cmd_angular_z:0.9459298729189949 +[2026-10-05 17:29:05.016] [path_visualizer] [debug] current_pose_x:6.757147276950232, current_pose_y:0.3962505324915213,current_pose_yaw:0.26577892899513245 +[2026-10-05 17:29:05.017] [path_visualizer] [debug] current_path_x:6.761686168895946, current_path_y:0.3437340353729536,current_path_yaw:0.856797996 +[2026-10-05 17:29:05.017] [path_visualizer] [debug] current_cmd_angular_z:0.9459298729189949 +[2026-10-05 17:29:05.066] [path_visualizer] [debug] current_pose_x:6.757147276950232, current_pose_y:0.3962505324915213,current_pose_yaw:0.26577892899513245 +[2026-10-05 17:29:05.066] [path_visualizer] [debug] current_path_x:6.761686168895946, current_path_y:0.3437340353729536,current_path_yaw:0.856797996 +[2026-10-05 17:29:05.066] [path_visualizer] [debug] current_cmd_angular_z:0.9459298729189949 +[2026-10-05 17:29:05.116] [path_visualizer] [debug] current_pose_x:6.79489423401659, current_pose_y:0.4454213530165919,current_pose_yaw:0.29797124862670904 +[2026-10-05 17:29:05.116] [path_visualizer] [debug] current_path_x:6.8386949301250155, current_path_y:0.4629687766805124,current_path_yaw:0.9995976625 +[2026-10-05 17:29:05.116] [path_visualizer] [debug] current_cmd_angular_z:1.2323529115696794 +[2026-10-05 17:29:05.166] [path_visualizer] [debug] current_pose_x:6.79489423401659, current_pose_y:0.4454213530165919,current_pose_yaw:0.29797124862670904 +[2026-10-05 17:29:05.166] [path_visualizer] [debug] current_path_x:6.8386949301250155, current_path_y:0.4629687766805124,current_path_yaw:0.9995976625 +[2026-10-05 17:29:05.166] [path_visualizer] [debug] current_cmd_angular_z:1.2323529115696794 +[2026-10-05 17:29:05.216] [path_visualizer] [debug] current_pose_x:6.79489423401659, current_pose_y:0.4454213530165919,current_pose_yaw:0.29797124862670904 +[2026-10-05 17:29:05.216] [path_visualizer] [debug] current_path_x:6.8386949301250155, current_path_y:0.4629687766805124,current_path_yaw:0.9995976625 +[2026-10-05 17:29:05.217] [path_visualizer] [debug] current_cmd_angular_z:1.2323529115696794 +[2026-10-05 17:29:05.266] [path_visualizer] [debug] current_pose_x:6.8309707650386216, current_pose_y:0.4960069809498512,current_pose_yaw:0.3303682804107666 +[2026-10-05 17:29:05.266] [path_visualizer] [debug] current_path_x:6.8386949301250155, current_path_y:0.4629687766805124,current_path_yaw:0.9995976625 +[2026-10-05 17:29:05.266] [path_visualizer] [debug] current_cmd_angular_z:1.1862835793147555 +[2026-10-05 17:29:05.316] [path_visualizer] [debug] current_pose_x:6.8309707650386216, current_pose_y:0.4960069809498512,current_pose_yaw:0.3303682804107666 +[2026-10-05 17:29:05.316] [path_visualizer] [debug] current_path_x:6.8386949301250155, current_path_y:0.4629687766805124,current_path_yaw:0.9995976625 +[2026-10-05 17:29:05.316] [path_visualizer] [debug] current_cmd_angular_z:1.1862835793147555 +[2026-10-05 17:29:05.366] [path_visualizer] [debug] current_pose_x:6.863439954961307, current_pose_y:0.5544151564476152,current_pose_yaw:0.3688963651657104 +[2026-10-05 17:29:05.366] [path_visualizer] [debug] current_path_x:6.915703691354086, current_path_y:0.5822035179880711,current_path_yaw:1.142397329 +[2026-10-05 17:29:05.366] [path_visualizer] [debug] current_cmd_angular_z:1.3222570733159638 +[2026-10-05 17:29:05.416] [path_visualizer] [debug] current_pose_x:6.863439954961307, current_pose_y:0.5544151564476152,current_pose_yaw:0.3688963651657104 +[2026-10-05 17:29:05.416] [path_visualizer] [debug] current_path_x:6.915703691354086, current_path_y:0.5822035179880711,current_path_yaw:1.142397329 +[2026-10-05 17:29:05.416] [path_visualizer] [debug] current_cmd_angular_z:1.3222570733159638 +[2026-10-05 17:29:05.466] [path_visualizer] [debug] current_pose_x:6.863439954961307, current_pose_y:0.5544151564476152,current_pose_yaw:0.3688963651657104 +[2026-10-05 17:29:05.466] [path_visualizer] [debug] current_path_x:6.915703691354086, current_path_y:0.5822035179880711,current_path_yaw:1.142397329 +[2026-10-05 17:29:05.467] [path_visualizer] [debug] current_cmd_angular_z:1.3222570733159638 +[2026-10-05 17:29:05.516] [path_visualizer] [debug] current_pose_x:6.893377111552335, current_pose_y:0.6151417965982444,current_pose_yaw:0.4083920121192932 +[2026-10-05 17:29:05.516] [path_visualizer] [debug] current_path_x:6.915703691354086, current_path_y:0.5822035179880711,current_path_yaw:1.142397329 +[2026-10-05 17:29:05.516] [path_visualizer] [debug] current_cmd_angular_z:1.2557598989231853 +[2026-10-05 17:29:05.566] [path_visualizer] [debug] current_pose_x:6.893377111552335, current_pose_y:0.6151417965982444,current_pose_yaw:0.4083920121192932 +[2026-10-05 17:29:05.566] [path_visualizer] [debug] current_path_x:6.915703691354086, current_path_y:0.5822035179880711,current_path_yaw:1.142397329 +[2026-10-05 17:29:05.567] [path_visualizer] [debug] current_cmd_angular_z:1.2557598989231853 +[2026-10-05 17:29:05.616] [path_visualizer] [debug] current_pose_x:6.919465339824308, current_pose_y:0.6802939856647607,current_pose_yaw:0.45103734731674194 +[2026-10-05 17:29:05.616] [path_visualizer] [debug] current_path_x:6.955833573678928, current_path_y:0.7181967851818496,current_path_yaw:1.285196995 +[2026-10-05 17:29:05.616] [path_visualizer] [debug] current_cmd_angular_z:1.5170376404110426 +[2026-10-05 17:29:05.667] [path_visualizer] [debug] current_pose_x:6.919465339824308, current_pose_y:0.6802939856647607,current_pose_yaw:0.45103734731674194 +[2026-10-05 17:29:05.667] [path_visualizer] [debug] current_path_x:6.955833573678928, current_path_y:0.7181967851818496,current_path_yaw:1.285196995 +[2026-10-05 17:29:05.667] [path_visualizer] [debug] current_cmd_angular_z:1.5170376404110426 +[2026-10-05 17:29:05.716] [path_visualizer] [debug] current_pose_x:6.919465339824308, current_pose_y:0.6802939856647607,current_pose_yaw:0.45103734731674194 +[2026-10-05 17:29:05.716] [path_visualizer] [debug] current_path_x:6.955833573678928, current_path_y:0.7181967851818496,current_path_yaw:1.285196995 +[2026-10-05 17:29:05.716] [path_visualizer] [debug] current_cmd_angular_z:1.5170376404110426 +[2026-10-05 17:29:05.766] [path_visualizer] [debug] current_pose_x:6.943569608901562, current_pose_y:0.7452828756186296,current_pose_yaw:0.49239715933799744 +[2026-10-05 17:29:05.767] [path_visualizer] [debug] current_path_x:6.955833573678928, current_path_y:0.7181967851818496,current_path_yaw:1.285196995 +[2026-10-05 17:29:05.767] [path_visualizer] [debug] current_cmd_angular_z:1.46439789280595 +[2026-10-05 17:29:05.816] [path_visualizer] [debug] current_pose_x:6.943569608901562, current_pose_y:0.7452828756186296,current_pose_yaw:0.49239715933799744 +[2026-10-05 17:29:05.816] [path_visualizer] [debug] current_path_x:6.955833573678928, current_path_y:0.7181967851818496,current_path_yaw:1.285196995 +[2026-10-05 17:29:05.816] [path_visualizer] [debug] current_cmd_angular_z:1.46439789280595 +[2026-10-05 17:29:05.866] [path_visualizer] [debug] current_pose_x:6.943569608901562, current_pose_y:0.7452828756186296,current_pose_yaw:0.49239715933799744 +[2026-10-05 17:29:05.867] [path_visualizer] [debug] current_path_x:6.955833573678928, current_path_y:0.7181967851818496,current_path_yaw:1.285196995 +[2026-10-05 17:29:05.867] [path_visualizer] [debug] current_cmd_angular_z:1.46439789280595 +[2026-10-05 17:29:05.916] [path_visualizer] [debug] current_pose_x:6.962210965010925, current_pose_y:0.8159355204866773,current_pose_yaw:0.538582980632782 +[2026-10-05 17:29:05.917] [path_visualizer] [debug] current_path_x:6.99596345600377, current_path_y:0.854190052375628,current_path_yaw:1.427996661 +[2026-10-05 17:29:05.917] [path_visualizer] [debug] current_cmd_angular_z:1.6041587672764923 +[2026-10-05 17:29:05.966] [path_visualizer] [debug] current_pose_x:6.962210965010925, current_pose_y:0.8159355204866773,current_pose_yaw:0.538582980632782 +[2026-10-05 17:29:05.966] [path_visualizer] [debug] current_path_x:6.99596345600377, current_path_y:0.854190052375628,current_path_yaw:1.427996661 +[2026-10-05 17:29:05.966] [path_visualizer] [debug] current_cmd_angular_z:1.6041587672764923 +[2026-10-05 17:29:06.016] [path_visualizer] [debug] current_pose_x:6.977528291250405, current_pose_y:0.8876375431284875,current_pose_yaw:0.5849648714065552 +[2026-10-05 17:29:06.017] [path_visualizer] [debug] current_path_x:6.99596345600377, current_path_y:0.854190052375628,current_path_yaw:1.427996661 +[2026-10-05 17:29:06.017] [path_visualizer] [debug] current_cmd_angular_z:1.5423280046771048 +[2026-10-05 17:29:06.066] [path_visualizer] [debug] current_pose_x:6.977528291250405, current_pose_y:0.8876375431284875,current_pose_yaw:0.5849648714065552 +[2026-10-05 17:29:06.066] [path_visualizer] [debug] current_path_x:6.99596345600377, current_path_y:0.854190052375628,current_path_yaw:1.427996661 +[2026-10-05 17:29:06.066] [path_visualizer] [debug] current_cmd_angular_z:1.5423280046771048 +[2026-10-05 17:29:06.116] [path_visualizer] [debug] current_pose_x:6.977528291250405, current_pose_y:0.8876375431284875,current_pose_yaw:0.5849648714065552 +[2026-10-05 17:29:06.117] [path_visualizer] [debug] current_path_x:6.99596345600377, current_path_y:0.854190052375628,current_path_yaw:1.427996661 +[2026-10-05 17:29:06.117] [path_visualizer] [debug] current_cmd_angular_z:1.5423280046771048 +[2026-10-05 17:29:06.166] [path_visualizer] [debug] current_pose_x:6.987716202275301, current_pose_y:0.9625158720933646,current_pose_yaw:0.6340873837471008 +[2026-10-05 17:29:06.166] [path_visualizer] [debug] current_path_x:6.9959633636062, current_path_y:0.9959245781619435,current_path_yaw:1.570796327 +[2026-10-05 17:29:06.166] [path_visualizer] [debug] current_cmd_angular_z:1.8218759809297074 +[2026-10-05 17:29:06.216] [path_visualizer] [debug] current_pose_x:6.987716202275301, current_pose_y:0.9625158720933646,current_pose_yaw:0.6340873837471008 +[2026-10-05 17:29:06.217] [path_visualizer] [debug] current_path_x:6.9959633636062, current_path_y:0.9959245781619435,current_path_yaw:1.570796327 +[2026-10-05 17:29:06.217] [path_visualizer] [debug] current_cmd_angular_z:1.8218759809297074 +[2026-10-05 17:29:06.266] [path_visualizer] [debug] current_pose_x:6.994789278352901, current_pose_y:1.0372652575244872,current_pose_yaw:0.6825142502784729 +[2026-10-05 17:29:06.266] [path_visualizer] [debug] current_path_x:6.9959633636062, current_path_y:0.9959245781619435,current_path_yaw:1.570796327 +[2026-10-05 17:29:06.266] [path_visualizer] [debug] current_cmd_angular_z:1.7692261288947664 +[2026-10-05 17:29:06.316] [path_visualizer] [debug] current_pose_x:6.994789278352901, current_pose_y:1.0372652575244872,current_pose_yaw:0.6825142502784729 +[2026-10-05 17:29:06.317] [path_visualizer] [debug] current_path_x:6.9959633636062, current_path_y:0.9959245781619435,current_path_yaw:1.570796327 +[2026-10-05 17:29:06.317] [path_visualizer] [debug] current_cmd_angular_z:1.7692261288947664 +[2026-10-05 17:29:06.366] [path_visualizer] [debug] current_pose_x:6.994789278352901, current_pose_y:1.0372652575244872,current_pose_yaw:0.6825142502784729 +[2026-10-05 17:29:06.366] [path_visualizer] [debug] current_path_x:6.9959633636062, current_path_y:0.9959245781619435,current_path_yaw:1.570796327 +[2026-10-05 17:29:06.366] [path_visualizer] [debug] current_cmd_angular_z:1.7692261288947664 +[2026-10-05 17:29:06.416] [path_visualizer] [debug] current_pose_x:6.995143357822091, current_pose_y:1.1157177773019251,current_pose_yaw:0.7352385520935059 +[2026-10-05 17:29:06.416] [path_visualizer] [debug] current_path_x:6.99596327120863, current_path_y:1.137659103948259,current_path_yaw:1.713595993 +[2026-10-05 17:29:06.417] [path_visualizer] [debug] current_cmd_angular_z:1.9321267902211938 +[2026-10-05 17:29:06.466] [path_visualizer] [debug] current_pose_x:6.995143357822091, current_pose_y:1.1157177773019251,current_pose_yaw:0.7352385520935059 +[2026-10-05 17:29:06.466] [path_visualizer] [debug] current_path_x:6.99596327120863, current_path_y:1.137659103948259,current_path_yaw:1.713595993 +[2026-10-05 17:29:06.466] [path_visualizer] [debug] current_cmd_angular_z:1.9321267902211938 +[2026-10-05 17:29:06.517] [path_visualizer] [debug] current_pose_x:6.989549232400682, current_pose_y:1.1959230769344953,current_pose_yaw:0.7904223203659058 +[2026-10-05 17:29:06.517] [path_visualizer] [debug] current_path_x:6.99596327120863, current_path_y:1.137659103948259,current_path_yaw:1.713595993 +[2026-10-05 17:29:06.517] [path_visualizer] [debug] current_cmd_angular_z:1.8584915252004897 +[2026-10-05 17:29:06.566] [path_visualizer] [debug] current_pose_x:6.989549232400682, current_pose_y:1.1959230769344953,current_pose_yaw:0.7904223203659058 +[2026-10-05 17:29:06.566] [path_visualizer] [debug] current_path_x:6.99596327120863, current_path_y:1.137659103948259,current_path_yaw:1.713595993 +[2026-10-05 17:29:06.567] [path_visualizer] [debug] current_cmd_angular_z:1.8584915252004897 +[2026-10-05 17:29:06.616] [path_visualizer] [debug] current_pose_x:6.989549232400682, current_pose_y:1.1959230769344953,current_pose_yaw:0.7904223203659058 +[2026-10-05 17:29:06.616] [path_visualizer] [debug] current_path_x:6.99596327120863, current_path_y:1.137659103948259,current_path_yaw:1.713595993 +[2026-10-05 17:29:06.616] [path_visualizer] [debug] current_cmd_angular_z:1.8584915252004897 +[2026-10-05 17:29:06.666] [path_visualizer] [debug] current_pose_x:6.976810332912315, current_pose_y:1.2781127456647523,current_pose_yaw:0.8490720391273497 +[2026-10-05 17:29:06.666] [path_visualizer] [debug] current_path_x:6.955833214032888, current_path_y:1.2736523749854722,current_path_yaw:1.856395659 +[2026-10-05 17:29:06.666] [path_visualizer] [debug] current_cmd_angular_z:2.1482477237171795 +[2026-10-05 17:29:06.716] [path_visualizer] [debug] current_pose_x:6.976810332912315, current_pose_y:1.2781127456647523,current_pose_yaw:0.8490720391273497 +[2026-10-05 17:29:06.716] [path_visualizer] [debug] current_path_x:6.955833214032888, current_path_y:1.2736523749854722,current_path_yaw:1.856395659 +[2026-10-05 17:29:06.716] [path_visualizer] [debug] current_cmd_angular_z:2.1482477237171795 +[2026-10-05 17:29:06.766] [path_visualizer] [debug] current_pose_x:6.976810332912315, current_pose_y:1.2781127456647523,current_pose_yaw:0.8490720391273497 +[2026-10-05 17:29:06.766] [path_visualizer] [debug] current_path_x:6.955833214032888, current_path_y:1.2736523749854722,current_path_yaw:1.856395659 +[2026-10-05 17:29:06.766] [path_visualizer] [debug] current_cmd_angular_z:2.1482477237171795 +[2026-10-05 17:29:06.816] [path_visualizer] [debug] current_pose_x:6.960078568004806, current_pose_y:1.3588672239946216,current_pose_yaw:0.9068065881729126 +[2026-10-05 17:29:06.816] [path_visualizer] [debug] current_path_x:6.915703156857146, current_path_y:1.4096456460226856,current_path_yaw:1.999195325 +[2026-10-05 17:29:06.816] [path_visualizer] [debug] current_cmd_angular_z:2.305185934978566 +[2026-10-05 17:29:06.866] [path_visualizer] [debug] current_pose_x:6.960078568004806, current_pose_y:1.3588672239946216,current_pose_yaw:0.9068065881729126 +[2026-10-05 17:29:06.866] [path_visualizer] [debug] current_path_x:6.915703156857146, current_path_y:1.4096456460226856,current_path_yaw:1.999195325 +[2026-10-05 17:29:06.866] [path_visualizer] [debug] current_cmd_angular_z:2.305185934978566 +[2026-10-05 17:29:06.916] [path_visualizer] [debug] current_pose_x:6.9336912953777485, current_pose_y:1.4409949799798998,current_pose_yaw:0.9698053002357482 +[2026-10-05 17:29:06.916] [path_visualizer] [debug] current_path_x:6.915703156857146, current_path_y:1.4096456460226856,current_path_yaw:1.999195325 +[2026-10-05 17:29:06.916] [path_visualizer] [debug] current_cmd_angular_z:2.2423109641327166 +[2026-10-05 17:29:06.966] [path_visualizer] [debug] current_pose_x:6.9336912953777485, current_pose_y:1.4409949799798998,current_pose_yaw:0.9698053002357482 +[2026-10-05 17:29:06.966] [path_visualizer] [debug] current_path_x:6.915703156857146, current_path_y:1.4096456460226856,current_path_yaw:1.999195325 +[2026-10-05 17:29:06.967] [path_visualizer] [debug] current_cmd_angular_z:2.2423109641327166 +[2026-10-05 17:29:07.016] [path_visualizer] [debug] current_pose_x:6.9336912953777485, current_pose_y:1.4409949799798998,current_pose_yaw:0.9698053002357482 +[2026-10-05 17:29:07.016] [path_visualizer] [debug] current_path_x:6.915703156857146, current_path_y:1.4096456460226856,current_path_yaw:1.999195325 +[2026-10-05 17:29:07.017] [path_visualizer] [debug] current_cmd_angular_z:2.2423109641327166 +[2026-10-05 17:29:07.066] [path_visualizer] [debug] current_pose_x:6.897804729506406, current_pose_y:1.519956129079715,current_pose_yaw:1.0354732275009155 +[2026-10-05 17:29:07.066] [path_visualizer] [debug] current_path_x:6.83869425091352, current_path_y:1.5288802342267218,current_path_yaw:2.141994991 +[2026-10-05 17:29:07.066] [path_visualizer] [debug] current_cmd_angular_z:2.4932229344989985 +[2026-10-05 17:29:07.116] [path_visualizer] [debug] current_pose_x:6.897804729506406, current_pose_y:1.519956129079715,current_pose_yaw:1.0354732275009155 +[2026-10-05 17:29:07.116] [path_visualizer] [debug] current_path_x:6.83869425091352, current_path_y:1.5288802342267218,current_path_yaw:2.141994991 +[2026-10-05 17:29:07.116] [path_visualizer] [debug] current_cmd_angular_z:2.4932229344989985 +[2026-10-05 17:29:07.167] [path_visualizer] [debug] current_pose_x:6.897804729506406, current_pose_y:1.519956129079715,current_pose_yaw:1.0354732275009155 +[2026-10-05 17:29:07.167] [path_visualizer] [debug] current_path_x:6.83869425091352, current_path_y:1.5288802342267218,current_path_yaw:2.141994991 +[2026-10-05 17:29:07.167] [path_visualizer] [debug] current_cmd_angular_z:2.4932229344989985 +[2026-10-05 17:29:07.216] [path_visualizer] [debug] current_pose_x:6.856804763026534, current_pose_y:1.5962454314288448,current_pose_yaw:1.1010773181915283 +[2026-10-05 17:29:07.216] [path_visualizer] [debug] current_path_x:6.83869425091352, current_path_y:1.5288802342267218,current_path_yaw:2.141994991 +[2026-10-05 17:29:07.216] [path_visualizer] [debug] current_cmd_angular_z:2.403986429693459 +[2026-10-05 17:29:07.266] [path_visualizer] [debug] current_pose_x:6.856804763026534, current_pose_y:1.5962454314288448,current_pose_yaw:1.1010773181915283 +[2026-10-05 17:29:07.266] [path_visualizer] [debug] current_path_x:6.83869425091352, current_path_y:1.5288802342267218,current_path_yaw:2.141994991 +[2026-10-05 17:29:07.266] [path_visualizer] [debug] current_cmd_angular_z:2.403986429693459 +[2026-10-05 17:29:07.316] [path_visualizer] [debug] current_pose_x:6.8066576998220185, current_pose_y:1.6672900170623273,current_pose_yaw:1.169693946838379 +[2026-10-05 17:29:07.316] [path_visualizer] [debug] current_path_x:6.761685344969894, current_path_y:1.648114822430758,current_path_yaw:2.284794657 +[2026-10-05 17:29:07.316] [path_visualizer] [debug] current_cmd_angular_z:2.5205959123460393 +[2026-10-05 17:29:07.366] [path_visualizer] [debug] current_pose_x:6.8066576998220185, current_pose_y:1.6672900170623273,current_pose_yaw:1.169693946838379 +[2026-10-05 17:29:07.366] [path_visualizer] [debug] current_path_x:6.761685344969894, current_path_y:1.648114822430758,current_path_yaw:2.284794657 +[2026-10-05 17:29:07.366] [path_visualizer] [debug] current_cmd_angular_z:2.5205959123460393 +[2026-10-05 17:29:07.416] [path_visualizer] [debug] current_pose_x:6.8066576998220185, current_pose_y:1.6672900170623273,current_pose_yaw:1.169693946838379 +[2026-10-05 17:29:07.416] [path_visualizer] [debug] current_path_x:6.761685344969894, current_path_y:1.648114822430758,current_path_yaw:2.284794657 +[2026-10-05 17:29:07.416] [path_visualizer] [debug] current_cmd_angular_z:2.5205959123460393 +[2026-10-05 17:29:07.466] [path_visualizer] [debug] current_pose_x:6.752192096048788, current_pose_y:1.7348603396060716,current_pose_yaw:1.2379084825515747 +[2026-10-05 17:29:07.466] [path_visualizer] [debug] current_path_x:6.761685344969894, current_path_y:1.648114822430758,current_path_yaw:2.284794657 +[2026-10-05 17:29:07.466] [path_visualizer] [debug] current_cmd_angular_z:2.4033509597572844 +[2026-10-05 17:29:07.516] [path_visualizer] [debug] current_pose_x:6.752192096048788, current_pose_y:1.7348603396060716,current_pose_yaw:1.2379084825515747 +[2026-10-05 17:29:07.516] [path_visualizer] [debug] current_path_x:6.761685344969894, current_path_y:1.648114822430758,current_path_yaw:2.284794657 +[2026-10-05 17:29:07.516] [path_visualizer] [debug] current_cmd_angular_z:2.4033509597572844 +[2026-10-05 17:29:07.566] [path_visualizer] [debug] current_pose_x:6.691290331481625, current_pose_y:1.797143361260479,current_pose_yaw:1.3075976371765137 +[2026-10-05 17:29:07.566] [path_visualizer] [debug] current_path_x:6.654036435297827, current_path_y:1.7409311269251064,current_path_yaw:2.427594323 +[2026-10-05 17:29:07.566] [path_visualizer] [debug] current_cmd_angular_z:2.6564723486750546 +[2026-10-05 17:29:07.616] [path_visualizer] [debug] current_pose_x:6.691290331481625, current_pose_y:1.797143361260479,current_pose_yaw:1.3075976371765137 +[2026-10-05 17:29:07.616] [path_visualizer] [debug] current_path_x:6.654036435297827, current_path_y:1.7409311269251064,current_path_yaw:2.427594323 +[2026-10-05 17:29:07.616] [path_visualizer] [debug] current_cmd_angular_z:2.6564723486750546 +[2026-10-05 17:29:07.667] [path_visualizer] [debug] current_pose_x:6.691290331481625, current_pose_y:1.797143361260479,current_pose_yaw:1.3075976371765137 +[2026-10-05 17:29:07.667] [path_visualizer] [debug] current_path_x:6.654036435297827, current_path_y:1.7409311269251064,current_path_yaw:2.427594323 +[2026-10-05 17:29:07.667] [path_visualizer] [debug] current_cmd_angular_z:2.6564723486750546 +[2026-10-05 17:29:07.717] [path_visualizer] [debug] current_pose_x:6.627822187047002, current_pose_y:1.8565886114721197,current_pose_yaw:1.375903606414795 +[2026-10-05 17:29:07.717] [path_visualizer] [debug] current_path_x:6.546387525625759, current_path_y:1.8337474314194548,current_path_yaw:2.570393989 +[2026-10-05 17:29:07.717] [path_visualizer] [debug] current_cmd_angular_z:2.7829650089830706 +[2026-10-05 17:29:07.766] [path_visualizer] [debug] current_pose_x:6.627822187047002, current_pose_y:1.8565886114721197,current_pose_yaw:1.375903606414795 +[2026-10-05 17:29:07.767] [path_visualizer] [debug] current_path_x:6.546387525625759, current_path_y:1.8337474314194548,current_path_yaw:2.570393989 +[2026-10-05 17:29:07.767] [path_visualizer] [debug] current_cmd_angular_z:2.7829650089830706 +[2026-10-05 17:29:07.816] [path_visualizer] [debug] current_pose_x:6.557035978117726, current_pose_y:1.9081171463772986,current_pose_yaw:1.4473057985305786 +[2026-10-05 17:29:07.816] [path_visualizer] [debug] current_path_x:6.546387525625759, current_path_y:1.8337474314194548,current_path_yaw:2.570393989 +[2026-10-05 17:29:07.816] [path_visualizer] [debug] current_cmd_angular_z:2.6715701928826014 +[2026-10-05 17:29:07.866] [path_visualizer] [debug] current_pose_x:6.557035978117726, current_pose_y:1.9081171463772986,current_pose_yaw:1.4473057985305786 +[2026-10-05 17:29:07.866] [path_visualizer] [debug] current_path_x:6.546387525625759, current_path_y:1.8337474314194548,current_path_yaw:2.570393989 +[2026-10-05 17:29:07.866] [path_visualizer] [debug] current_cmd_angular_z:2.6715701928826014 +[2026-10-05 17:29:07.916] [path_visualizer] [debug] current_pose_x:6.557035978117726, current_pose_y:1.9081171463772986,current_pose_yaw:1.4473057985305786 +[2026-10-05 17:29:07.916] [path_visualizer] [debug] current_path_x:6.546387525625759, current_path_y:1.8337474314194548,current_path_yaw:2.570393989 +[2026-10-05 17:29:07.916] [path_visualizer] [debug] current_cmd_angular_z:2.6715701928826014 +[2026-10-05 17:29:07.966] [path_visualizer] [debug] current_pose_x:6.480493319028902, current_pose_y:1.9518186138920999,current_pose_yaw:1.5208346843719482 +[2026-10-05 17:29:07.966] [path_visualizer] [debug] current_path_x:6.416819591356274, current_path_y:1.8926260022366739,current_path_yaw:2.713193655 +[2026-10-05 17:29:07.966] [path_visualizer] [debug] current_cmd_angular_z:2.8839502220394997 +[2026-10-05 17:29:08.016] [path_visualizer] [debug] current_pose_x:6.480493319028902, current_pose_y:1.9518186138920999,current_pose_yaw:1.5208346843719482 +[2026-10-05 17:29:08.016] [path_visualizer] [debug] current_path_x:6.416819591356274, current_path_y:1.8926260022366739,current_path_yaw:2.713193655 +[2026-10-05 17:29:08.016] [path_visualizer] [debug] current_cmd_angular_z:2.8839502220394997 +[2026-10-05 17:29:08.066] [path_visualizer] [debug] current_pose_x:6.480493319028902, current_pose_y:1.9518186138920999,current_pose_yaw:1.5208346843719482 +[2026-10-05 17:29:08.067] [path_visualizer] [debug] current_path_x:6.416819591356274, current_path_y:1.8926260022366739,current_path_yaw:2.713193655 +[2026-10-05 17:29:08.067] [path_visualizer] [debug] current_cmd_angular_z:2.8839502220394997 +[2026-10-05 17:29:08.116] [path_visualizer] [debug] current_pose_x:6.402146513345061, current_pose_y:1.9912319144889354,current_pose_yaw:1.5931388139724734 +[2026-10-05 17:29:08.116] [path_visualizer] [debug] current_path_x:6.416819591356274, current_path_y:1.8926260022366739,current_path_yaw:2.713193655 +[2026-10-05 17:29:08.116] [path_visualizer] [debug] current_cmd_angular_z:2.759665961442975 +[2026-10-05 17:29:08.166] [path_visualizer] [debug] current_pose_x:6.402146513345061, current_pose_y:1.9912319144889354,current_pose_yaw:1.5931388139724734 +[2026-10-05 17:29:08.166] [path_visualizer] [debug] current_path_x:6.416819591356274, current_path_y:1.8926260022366739,current_path_yaw:2.713193655 +[2026-10-05 17:29:08.167] [path_visualizer] [debug] current_cmd_angular_z:2.759665961442975 +[2026-10-05 17:29:08.216] [path_visualizer] [debug] current_pose_x:6.318798911218593, current_pose_y:2.0212491660870673,current_pose_yaw:1.6681574583053589 +[2026-10-05 17:29:08.216] [path_visualizer] [debug] current_path_x:6.28725165708679, current_path_y:1.9515045730538931,current_path_yaw:2.855993321 +[2026-10-05 17:29:08.216] [path_visualizer] [debug] current_cmd_angular_z:2.847270230500366 +[2026-10-05 17:29:08.266] [path_visualizer] [debug] current_pose_x:6.318798911218593, current_pose_y:2.0212491660870673,current_pose_yaw:1.6681574583053589 +[2026-10-05 17:29:08.266] [path_visualizer] [debug] current_path_x:6.28725165708679, current_path_y:1.9515045730538931,current_path_yaw:2.855993321 +[2026-10-05 17:29:08.267] [path_visualizer] [debug] current_cmd_angular_z:2.847270230500366 +[2026-10-05 17:29:08.316] [path_visualizer] [debug] current_pose_x:6.318798911218593, current_pose_y:2.0212491660870673,current_pose_yaw:1.6681574583053589 +[2026-10-05 17:29:08.316] [path_visualizer] [debug] current_path_x:6.28725165708679, current_path_y:1.9515045730538931,current_path_yaw:2.855993321 +[2026-10-05 17:29:08.317] [path_visualizer] [debug] current_cmd_angular_z:2.847270230500366 +[2026-10-05 17:29:08.367] [path_visualizer] [debug] current_pose_x:6.234289957073685, current_pose_y:2.046342156819464,current_pose_yaw:1.7420631647109983 +[2026-10-05 17:29:08.367] [path_visualizer] [debug] current_path_x:6.28725165708679, current_path_y:1.9515045730538931,current_path_yaw:2.855993321 +[2026-10-05 17:29:08.367] [path_visualizer] [debug] current_cmd_angular_z:2.701108247440089 +[2026-10-05 17:29:08.416] [path_visualizer] [debug] current_pose_x:6.234289957073685, current_pose_y:2.046342156819464,current_pose_yaw:1.7420631647109983 +[2026-10-05 17:29:08.416] [path_visualizer] [debug] current_path_x:6.28725165708679, current_path_y:1.9515045730538931,current_path_yaw:2.855993321 +[2026-10-05 17:29:08.416] [path_visualizer] [debug] current_cmd_angular_z:2.701108247440089 +[2026-10-05 17:29:08.466] [path_visualizer] [debug] current_pose_x:6.14799788878246, current_pose_y:2.0636906045026278,current_pose_yaw:1.8165020942687986 +[2026-10-05 17:29:08.466] [path_visualizer] [debug] current_path_x:6.146261621227925, current_path_y:1.9716754289978446,current_path_yaw:2.9987929875000003 +[2026-10-05 17:29:08.466] [path_visualizer] [debug] current_cmd_angular_z:2.931539843968056 +[2026-10-05 17:29:08.516] [path_visualizer] [debug] current_pose_x:6.14799788878246, current_pose_y:2.0636906045026278,current_pose_yaw:1.8165020942687986 +[2026-10-05 17:29:08.516] [path_visualizer] [debug] current_path_x:6.146261621227925, current_path_y:1.9716754289978446,current_path_yaw:2.9987929875000003 +[2026-10-05 17:29:08.517] [path_visualizer] [debug] current_cmd_angular_z:2.931539843968056 +[2026-10-05 17:29:08.566] [path_visualizer] [debug] current_pose_x:6.14799788878246, current_pose_y:2.0636906045026278,current_pose_yaw:1.8165020942687986 +[2026-10-05 17:29:08.566] [path_visualizer] [debug] current_path_x:6.146261621227925, current_path_y:1.9716754289978446,current_path_yaw:2.9987929875000003 +[2026-10-05 17:29:08.566] [path_visualizer] [debug] current_cmd_angular_z:2.931539843968056 +[2026-10-05 17:29:08.616] [path_visualizer] [debug] current_pose_x:6.0622057673135545, current_pose_y:2.074478562806691,current_pose_yaw:1.8891297578811646 +[2026-10-05 17:29:08.616] [path_visualizer] [debug] current_path_x:6.00527158536906, current_path_y:1.9918462849417964,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.616] [path_visualizer] [debug] current_cmd_angular_z:3.018536119162754 +[2026-10-05 17:29:08.666] [path_visualizer] [debug] current_pose_x:6.0622057673135545, current_pose_y:2.074478562806691,current_pose_yaw:1.8891297578811646 +[2026-10-05 17:29:08.666] [path_visualizer] [debug] current_path_x:6.00527158536906, current_path_y:1.9918462849417964,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.666] [path_visualizer] [debug] current_cmd_angular_z:3.018536119162754 +[2026-10-05 17:29:08.716] [path_visualizer] [debug] current_pose_x:6.0622057673135545, current_pose_y:2.074478562806691,current_pose_yaw:1.8891297578811646 +[2026-10-05 17:29:08.716] [path_visualizer] [debug] current_path_x:6.00527158536906, current_path_y:1.9918462849417964,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.716] [path_visualizer] [debug] current_cmd_angular_z:3.018536119162754 +[2026-10-05 17:29:08.766] [path_visualizer] [debug] current_pose_x:5.975220642583841, current_pose_y:2.073382484672443,current_pose_yaw:1.9645415544509888 +[2026-10-05 17:29:08.766] [path_visualizer] [debug] current_path_x:6.00527158536906, current_path_y:1.9918462849417964,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.766] [path_visualizer] [debug] current_cmd_angular_z:2.8609729046117045 +[2026-10-05 17:29:08.816] [path_visualizer] [debug] current_pose_x:5.975220642583841, current_pose_y:2.073382484672443,current_pose_yaw:1.9645415544509888 +[2026-10-05 17:29:08.816] [path_visualizer] [debug] current_path_x:6.00527158536906, current_path_y:1.9918462849417964,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.816] [path_visualizer] [debug] current_cmd_angular_z:2.8609729046117045 +[2026-10-05 17:29:08.866] [path_visualizer] [debug] current_pose_x:5.888964244829401, current_pose_y:2.0626051111541464,current_pose_yaw:2.040980577468872 +[2026-10-05 17:29:08.866] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.866] [path_visualizer] [debug] current_cmd_angular_z:2.641678200984437 +[2026-10-05 17:29:08.916] [path_visualizer] [debug] current_pose_x:5.888964244829401, current_pose_y:2.0626051111541464,current_pose_yaw:2.040980577468872 +[2026-10-05 17:29:08.916] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.916] [path_visualizer] [debug] current_cmd_angular_z:2.641678200984437 +[2026-10-05 17:29:08.966] [path_visualizer] [debug] current_pose_x:5.888964244829401, current_pose_y:2.0626051111541464,current_pose_yaw:2.040980577468872 +[2026-10-05 17:29:08.966] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:08.966] [path_visualizer] [debug] current_cmd_angular_z:2.641678200984437 +[2026-10-05 17:29:09.016] [path_visualizer] [debug] current_pose_x:5.804780950693776, current_pose_y:2.0483256602599296,current_pose_yaw:2.115042209625244 +[2026-10-05 17:29:09.016] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.016] [path_visualizer] [debug] current_cmd_angular_z:2.405185103046041 +[2026-10-05 17:29:09.066] [path_visualizer] [debug] current_pose_x:5.804780950693776, current_pose_y:2.0483256602599296,current_pose_yaw:2.115042209625244 +[2026-10-05 17:29:09.066] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.067] [path_visualizer] [debug] current_cmd_angular_z:2.405185103046041 +[2026-10-05 17:29:09.116] [path_visualizer] [debug] current_pose_x:5.722654300355121, current_pose_y:2.032302003967823,current_pose_yaw:2.1863596439361572 +[2026-10-05 17:29:09.116] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.116] [path_visualizer] [debug] current_cmd_angular_z:2.1629785214325676 +[2026-10-05 17:29:09.167] [path_visualizer] [debug] current_pose_x:5.722654300355121, current_pose_y:2.032302003967823,current_pose_yaw:2.1863596439361572 +[2026-10-05 17:29:09.167] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.167] [path_visualizer] [debug] current_cmd_angular_z:2.1629785214325676 +[2026-10-05 17:29:09.216] [path_visualizer] [debug] current_pose_x:5.722654300355121, current_pose_y:2.032302003967823,current_pose_yaw:2.1863596439361572 +[2026-10-05 17:29:09.216] [path_visualizer] [debug] current_path_x:5.809978200496851, current_path_y:1.991846248622873,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.216] [path_visualizer] [debug] current_cmd_angular_z:2.1629785214325676 +[2026-10-05 17:29:09.266] [path_visualizer] [debug] current_pose_x:5.6420190553321135, current_pose_y:2.014743406686158,current_pose_yaw:2.2553555965423584 +[2026-10-05 17:29:09.266] [path_visualizer] [debug] current_path_x:5.614684815624641, current_path_y:1.9918462123039493,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.266] [path_visualizer] [debug] current_cmd_angular_z:1.9155205681543066 +[2026-10-05 17:29:09.316] [path_visualizer] [debug] current_pose_x:5.6420190553321135, current_pose_y:2.014743406686158,current_pose_yaw:2.2553555965423584 +[2026-10-05 17:29:09.316] [path_visualizer] [debug] current_path_x:5.614684815624641, current_path_y:1.9918462123039493,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.316] [path_visualizer] [debug] current_cmd_angular_z:1.9155205681543066 +[2026-10-05 17:29:09.366] [path_visualizer] [debug] current_pose_x:5.6420190553321135, current_pose_y:2.014743406686158,current_pose_yaw:2.2553555965423584 +[2026-10-05 17:29:09.367] [path_visualizer] [debug] current_path_x:5.614684815624641, current_path_y:1.9918462123039493,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.367] [path_visualizer] [debug] current_cmd_angular_z:1.9155205681543066 +[2026-10-05 17:29:09.416] [path_visualizer] [debug] current_pose_x:5.562386183550133, current_pose_y:1.9978672151491554,current_pose_yaw:2.3210365772247314 +[2026-10-05 17:29:09.416] [path_visualizer] [debug] current_path_x:5.614684815624641, current_path_y:1.9918462123039493,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.416] [path_visualizer] [debug] current_cmd_angular_z:1.678742311315647 +[2026-10-05 17:29:09.466] [path_visualizer] [debug] current_pose_x:5.562386183550133, current_pose_y:1.9978672151491554,current_pose_yaw:2.3210365772247314 +[2026-10-05 17:29:09.467] [path_visualizer] [debug] current_path_x:5.614684815624641, current_path_y:1.9918462123039493,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.467] [path_visualizer] [debug] current_cmd_angular_z:1.678742311315647 +[2026-10-05 17:29:09.516] [path_visualizer] [debug] current_pose_x:5.486154469250665, current_pose_y:1.9812429831930798,current_pose_yaw:2.3818776607513428 +[2026-10-05 17:29:09.516] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.517] [path_visualizer] [debug] current_cmd_angular_z:1.4531660936744264 +[2026-10-05 17:29:09.566] [path_visualizer] [debug] current_pose_x:5.486154469250665, current_pose_y:1.9812429831930798,current_pose_yaw:2.3818776607513428 +[2026-10-05 17:29:09.566] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.566] [path_visualizer] [debug] current_cmd_angular_z:1.4531660936744264 +[2026-10-05 17:29:09.616] [path_visualizer] [debug] current_pose_x:5.486154469250665, current_pose_y:1.9812429831930798,current_pose_yaw:2.3818776607513428 +[2026-10-05 17:29:09.616] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.616] [path_visualizer] [debug] current_cmd_angular_z:1.4531660936744264 +[2026-10-05 17:29:09.666] [path_visualizer] [debug] current_pose_x:5.4141187195739615, current_pose_y:1.9657406003887883,current_pose_yaw:2.436918020248413 +[2026-10-05 17:29:09.666] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.666] [path_visualizer] [debug] current_cmd_angular_z:1.2462798194052602 +[2026-10-05 17:29:09.717] [path_visualizer] [debug] current_pose_x:5.4141187195739615, current_pose_y:1.9657406003887883,current_pose_yaw:2.436918020248413 +[2026-10-05 17:29:09.717] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.717] [path_visualizer] [debug] current_cmd_angular_z:1.2462798194052602 +[2026-10-05 17:29:09.766] [path_visualizer] [debug] current_pose_x:5.348103419992742, current_pose_y:1.953902502367366,current_pose_yaw:2.484044313430786 +[2026-10-05 17:29:09.766] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.766] [path_visualizer] [debug] current_cmd_angular_z:1.07822599087678 +[2026-10-05 17:29:09.816] [path_visualizer] [debug] current_pose_x:5.348103419992742, current_pose_y:1.953902502367366,current_pose_yaw:2.484044313430786 +[2026-10-05 17:29:09.817] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.817] [path_visualizer] [debug] current_cmd_angular_z:1.07822599087678 +[2026-10-05 17:29:09.866] [path_visualizer] [debug] current_pose_x:5.348103419992742, current_pose_y:1.953902502367366,current_pose_yaw:2.484044313430786 +[2026-10-05 17:29:09.866] [path_visualizer] [debug] current_path_x:5.419391430752432, current_path_y:1.991846175985026,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.866] [path_visualizer] [debug] current_cmd_angular_z:1.07822599087678 +[2026-10-05 17:29:09.916] [path_visualizer] [debug] current_pose_x:5.286011132095689, current_pose_y:1.9454450743608325,current_pose_yaw:2.5244557857513428 +[2026-10-05 17:29:09.916] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.916] [path_visualizer] [debug] current_cmd_angular_z:0.9447736207211632 +[2026-10-05 17:29:09.966] [path_visualizer] [debug] current_pose_x:5.286011132095689, current_pose_y:1.9454450743608325,current_pose_yaw:2.5244557857513428 +[2026-10-05 17:29:09.967] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:09.967] [path_visualizer] [debug] current_cmd_angular_z:0.9447736207211632 +[2026-10-05 17:29:10.016] [path_visualizer] [debug] current_pose_x:5.227145515804455, current_pose_y:1.9405744740389728,current_pose_yaw:2.558682918548584 +[2026-10-05 17:29:10.016] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.016] [path_visualizer] [debug] current_cmd_angular_z:0.8460544702353163 +[2026-10-05 17:29:10.066] [path_visualizer] [debug] current_pose_x:5.227145515804455, current_pose_y:1.9405744740389728,current_pose_yaw:2.558682918548584 +[2026-10-05 17:29:10.067] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.067] [path_visualizer] [debug] current_cmd_angular_z:0.8460544702353163 +[2026-10-05 17:29:10.116] [path_visualizer] [debug] current_pose_x:5.227145515804455, current_pose_y:1.9405744740389728,current_pose_yaw:2.558682918548584 +[2026-10-05 17:29:10.116] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.116] [path_visualizer] [debug] current_cmd_angular_z:0.8460544702353163 +[2026-10-05 17:29:10.166] [path_visualizer] [debug] current_pose_x:5.170424136248345, current_pose_y:1.9381486713683544,current_pose_yaw:2.5884103775024414 +[2026-10-05 17:29:10.167] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.167] [path_visualizer] [debug] current_cmd_angular_z:0.771539584180774 +[2026-10-05 17:29:10.216] [path_visualizer] [debug] current_pose_x:5.170424136248345, current_pose_y:1.9381486713683544,current_pose_yaw:2.5884103775024414 +[2026-10-05 17:29:10.216] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.216] [path_visualizer] [debug] current_cmd_angular_z:0.771539584180774 +[2026-10-05 17:29:10.267] [path_visualizer] [debug] current_pose_x:5.170424136248345, current_pose_y:1.9381486713683544,current_pose_yaw:2.5884103775024414 +[2026-10-05 17:29:10.267] [path_visualizer] [debug] current_path_x:5.224098045880222, current_path_y:1.9918461396661022,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.267] [path_visualizer] [debug] current_cmd_angular_z:0.771539584180774 +[2026-10-05 17:29:10.316] [path_visualizer] [debug] current_pose_x:5.115562817823449, current_pose_y:1.9407919924633705,current_pose_yaw:2.614164113998413 +[2026-10-05 17:29:10.316] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.316] [path_visualizer] [debug] current_cmd_angular_z:0.7364431618566925 +[2026-10-05 17:29:10.366] [path_visualizer] [debug] current_pose_x:5.115562817823449, current_pose_y:1.9407919924633705,current_pose_yaw:2.614164113998413 +[2026-10-05 17:29:10.367] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.367] [path_visualizer] [debug] current_cmd_angular_z:0.7364431618566925 +[2026-10-05 17:29:10.416] [path_visualizer] [debug] current_pose_x:5.061432906841827, current_pose_y:1.944652645295562,current_pose_yaw:2.6379475593566895 +[2026-10-05 17:29:10.416] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.416] [path_visualizer] [debug] current_cmd_angular_z:0.7128639577040895 +[2026-10-05 17:29:10.467] [path_visualizer] [debug] current_pose_x:5.061432906841827, current_pose_y:1.944652645295562,current_pose_yaw:2.6379475593566895 +[2026-10-05 17:29:10.467] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.467] [path_visualizer] [debug] current_cmd_angular_z:0.7128639577040895 +[2026-10-05 17:29:10.516] [path_visualizer] [debug] current_pose_x:5.061432906841827, current_pose_y:1.944652645295562,current_pose_yaw:2.6379475593566895 +[2026-10-05 17:29:10.517] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.517] [path_visualizer] [debug] current_cmd_angular_z:0.7128639577040895 +[2026-10-05 17:29:10.566] [path_visualizer] [debug] current_pose_x:5.007532477999181, current_pose_y:1.9493838524377516,current_pose_yaw:2.660271644592285 +[2026-10-05 17:29:10.567] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.567] [path_visualizer] [debug] current_cmd_angular_z:0.6976413360803304 +[2026-10-05 17:29:10.616] [path_visualizer] [debug] current_pose_x:5.007532477999181, current_pose_y:1.9493838524377516,current_pose_yaw:2.660271644592285 +[2026-10-05 17:29:10.616] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.616] [path_visualizer] [debug] current_cmd_angular_z:0.6976413360803304 +[2026-10-05 17:29:10.666] [path_visualizer] [debug] current_pose_x:4.953721160165239, current_pose_y:1.9534764134997302,current_pose_yaw:2.681964635848999 +[2026-10-05 17:29:10.666] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.666] [path_visualizer] [debug] current_cmd_angular_z:0.6797321754646197 +[2026-10-05 17:29:10.716] [path_visualizer] [debug] current_pose_x:4.953721160165239, current_pose_y:1.9534764134997302,current_pose_yaw:2.681964635848999 +[2026-10-05 17:29:10.717] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.717] [path_visualizer] [debug] current_cmd_angular_z:0.6797321754646197 +[2026-10-05 17:29:10.766] [path_visualizer] [debug] current_pose_x:4.953721160165239, current_pose_y:1.9534764134997302,current_pose_yaw:2.681964635848999 +[2026-10-05 17:29:10.766] [path_visualizer] [debug] current_path_x:5.028804661008013, current_path_y:1.9918461033471788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.766] [path_visualizer] [debug] current_cmd_angular_z:0.6797321754646197 +[2026-10-05 17:29:10.816] [path_visualizer] [debug] current_pose_x:4.899937604487516, current_pose_y:1.9567955710680827,current_pose_yaw:2.703216552734375 +[2026-10-05 17:29:10.816] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.817] [path_visualizer] [debug] current_cmd_angular_z:0.6579052280641224 +[2026-10-05 17:29:10.866] [path_visualizer] [debug] current_pose_x:4.899937604487516, current_pose_y:1.9567955710680827,current_pose_yaw:2.703216552734375 +[2026-10-05 17:29:10.866] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.866] [path_visualizer] [debug] current_cmd_angular_z:0.6579052280641224 +[2026-10-05 17:29:10.917] [path_visualizer] [debug] current_pose_x:4.899937604487516, current_pose_y:1.9567955710680827,current_pose_yaw:2.703216552734375 +[2026-10-05 17:29:10.917] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.917] [path_visualizer] [debug] current_cmd_angular_z:0.6579052280641224 +[2026-10-05 17:29:10.966] [path_visualizer] [debug] current_pose_x:4.846224356920325, current_pose_y:1.9594545743199419,current_pose_yaw:2.7239367961883545 +[2026-10-05 17:29:10.966] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:10.966] [path_visualizer] [debug] current_cmd_angular_z:0.6330374798600746 +[2026-10-05 17:29:11.017] [path_visualizer] [debug] current_pose_x:4.846224356920325, current_pose_y:1.9594545743199419,current_pose_yaw:2.7239367961883545 +[2026-10-05 17:29:11.017] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.017] [path_visualizer] [debug] current_cmd_angular_z:0.6330374798600746 +[2026-10-05 17:29:11.066] [path_visualizer] [debug] current_pose_x:4.792402320027934, current_pose_y:1.961355716206623,current_pose_yaw:2.7440648078918457 +[2026-10-05 17:29:11.066] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.066] [path_visualizer] [debug] current_cmd_angular_z:0.6046349773784887 +[2026-10-05 17:29:11.116] [path_visualizer] [debug] current_pose_x:4.792402320027934, current_pose_y:1.961355716206623,current_pose_yaw:2.7440648078918457 +[2026-10-05 17:29:11.117] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.117] [path_visualizer] [debug] current_cmd_angular_z:0.6046349773784887 +[2026-10-05 17:29:11.166] [path_visualizer] [debug] current_pose_x:4.792402320027934, current_pose_y:1.961355716206623,current_pose_yaw:2.7440648078918457 +[2026-10-05 17:29:11.166] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.166] [path_visualizer] [debug] current_cmd_angular_z:0.6046349773784887 +[2026-10-05 17:29:11.217] [path_visualizer] [debug] current_pose_x:4.738305732432333, current_pose_y:1.9626687010560322,current_pose_yaw:2.763164520263672 +[2026-10-05 17:29:11.217] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.217] [path_visualizer] [debug] current_cmd_angular_z:0.5746239119643651 +[2026-10-05 17:29:11.266] [path_visualizer] [debug] current_pose_x:4.738305732432333, current_pose_y:1.9626687010560322,current_pose_yaw:2.763164520263672 +[2026-10-05 17:29:11.267] [path_visualizer] [debug] current_path_x:4.833511276135803, current_path_y:1.9918460670282552,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.267] [path_visualizer] [debug] current_cmd_angular_z:0.5746239119643651 +[2026-10-05 17:29:11.317] [path_visualizer] [debug] current_pose_x:4.684074573442482, current_pose_y:1.96326834971455,current_pose_yaw:2.781633138656616 +[2026-10-05 17:29:11.317] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.317] [path_visualizer] [debug] current_cmd_angular_z:0.5414270904814857 +[2026-10-05 17:29:11.367] [path_visualizer] [debug] current_pose_x:4.684074573442482, current_pose_y:1.96326834971455,current_pose_yaw:2.781633138656616 +[2026-10-05 17:29:11.367] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.367] [path_visualizer] [debug] current_cmd_angular_z:0.5414270904814857 +[2026-10-05 17:29:11.416] [path_visualizer] [debug] current_pose_x:4.684074573442482, current_pose_y:1.96326834971455,current_pose_yaw:2.781633138656616 +[2026-10-05 17:29:11.416] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.416] [path_visualizer] [debug] current_cmd_angular_z:0.5414270904814857 +[2026-10-05 17:29:11.467] [path_visualizer] [debug] current_pose_x:4.629880134508746, current_pose_y:1.9637113327259672,current_pose_yaw:2.7989609241485596 +[2026-10-05 17:29:11.467] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.467] [path_visualizer] [debug] current_cmd_angular_z:0.5095347389551528 +[2026-10-05 17:29:11.516] [path_visualizer] [debug] current_pose_x:4.629880134508746, current_pose_y:1.9637113327259672,current_pose_yaw:2.7989609241485596 +[2026-10-05 17:29:11.516] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.516] [path_visualizer] [debug] current_cmd_angular_z:0.5095347389551528 +[2026-10-05 17:29:11.567] [path_visualizer] [debug] current_pose_x:4.629880134508746, current_pose_y:1.9637113327259672,current_pose_yaw:2.7989609241485596 +[2026-10-05 17:29:11.567] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.567] [path_visualizer] [debug] current_cmd_angular_z:0.5095347389551528 +[2026-10-05 17:29:11.616] [path_visualizer] [debug] current_pose_x:4.575712384890155, current_pose_y:1.9639371849536147,current_pose_yaw:2.8154149055480957 +[2026-10-05 17:29:11.617] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.617] [path_visualizer] [debug] current_cmd_angular_z:0.47803565183182584 +[2026-10-05 17:29:11.666] [path_visualizer] [debug] current_pose_x:4.575712384890155, current_pose_y:1.9639371849536147,current_pose_yaw:2.8154149055480957 +[2026-10-05 17:29:11.666] [path_visualizer] [debug] current_path_x:4.638217891263594, current_path_y:1.9918460307093317,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.666] [path_visualizer] [debug] current_cmd_angular_z:0.47803565183182584 +[2026-10-05 17:29:11.716] [path_visualizer] [debug] current_pose_x:4.521572645146694, current_pose_y:1.9636991528596204,current_pose_yaw:2.831264019012451 +[2026-10-05 17:29:11.716] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.716] [path_visualizer] [debug] current_cmd_angular_z:0.44485279828655544 +[2026-10-05 17:29:11.766] [path_visualizer] [debug] current_pose_x:4.521572645146694, current_pose_y:1.9636991528596204,current_pose_yaw:2.831264019012451 +[2026-10-05 17:29:11.767] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.767] [path_visualizer] [debug] current_cmd_angular_z:0.44485279828655544 +[2026-10-05 17:29:11.816] [path_visualizer] [debug] current_pose_x:4.521572645146694, current_pose_y:1.9636991528596204,current_pose_yaw:2.831264019012451 +[2026-10-05 17:29:11.816] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.816] [path_visualizer] [debug] current_cmd_angular_z:0.44485279828655544 +[2026-10-05 17:29:11.867] [path_visualizer] [debug] current_pose_x:4.467696389393624, current_pose_y:1.9635673457649814,current_pose_yaw:2.846010208129883 +[2026-10-05 17:29:11.867] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.867] [path_visualizer] [debug] current_cmd_angular_z:0.41453822359207954 +[2026-10-05 17:29:11.916] [path_visualizer] [debug] current_pose_x:4.467696389393624, current_pose_y:1.9635673457649814,current_pose_yaw:2.846010208129883 +[2026-10-05 17:29:11.916] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.917] [path_visualizer] [debug] current_cmd_angular_z:0.41453822359207954 +[2026-10-05 17:29:11.966] [path_visualizer] [debug] current_pose_x:4.414047646362785, current_pose_y:1.9634004292669518,current_pose_yaw:2.8599135875701904 +[2026-10-05 17:29:11.966] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:11.966] [path_visualizer] [debug] current_cmd_angular_z:0.38569028151085094 +[2026-10-05 17:29:12.017] [path_visualizer] [debug] current_pose_x:4.414047646362785, current_pose_y:1.9634004292669518,current_pose_yaw:2.8599135875701904 +[2026-10-05 17:29:12.017] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.017] [path_visualizer] [debug] current_cmd_angular_z:0.38569028151085094 +[2026-10-05 17:29:12.066] [path_visualizer] [debug] current_pose_x:4.414047646362785, current_pose_y:1.9634004292669518,current_pose_yaw:2.8599135875701904 +[2026-10-05 17:29:12.066] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.067] [path_visualizer] [debug] current_cmd_angular_z:0.38569028151085094 +[2026-10-05 17:29:12.116] [path_visualizer] [debug] current_pose_x:4.360738106432511, current_pose_y:1.9632494841342707,current_pose_yaw:2.8729519844055176 +[2026-10-05 17:29:12.117] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.117] [path_visualizer] [debug] current_cmd_angular_z:0.35867195075778735 +[2026-10-05 17:29:12.166] [path_visualizer] [debug] current_pose_x:4.360738106432511, current_pose_y:1.9632494841342707,current_pose_yaw:2.8729519844055176 +[2026-10-05 17:29:12.166] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.166] [path_visualizer] [debug] current_cmd_angular_z:0.35867195075778735 +[2026-10-05 17:29:12.216] [path_visualizer] [debug] current_pose_x:4.360738106432511, current_pose_y:1.9632494841342707,current_pose_yaw:2.8729519844055176 +[2026-10-05 17:29:12.216] [path_visualizer] [debug] current_path_x:4.442924506391384, current_path_y:1.991845994390408,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.216] [path_visualizer] [debug] current_cmd_angular_z:0.35867195075778735 +[2026-10-05 17:29:12.266] [path_visualizer] [debug] current_pose_x:4.307733956248696, current_pose_y:1.9633358722222978,current_pose_yaw:2.8850831985473633 +[2026-10-05 17:29:12.266] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.267] [path_visualizer] [debug] current_cmd_angular_z:0.3349486016384981 +[2026-10-05 17:29:12.316] [path_visualizer] [debug] current_pose_x:4.307733956248696, current_pose_y:1.9633358722222978,current_pose_yaw:2.8850831985473633 +[2026-10-05 17:29:12.316] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.316] [path_visualizer] [debug] current_cmd_angular_z:0.3349486016384981 +[2026-10-05 17:29:12.366] [path_visualizer] [debug] current_pose_x:4.25494829810453, current_pose_y:1.9634252527953882,current_pose_yaw:2.896580219268799 +[2026-10-05 17:29:12.366] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.366] [path_visualizer] [debug] current_cmd_angular_z:0.31251208600339786 +[2026-10-05 17:29:12.416] [path_visualizer] [debug] current_pose_x:4.25494829810453, current_pose_y:1.9634252527953882,current_pose_yaw:2.896580219268799 +[2026-10-05 17:29:12.416] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.416] [path_visualizer] [debug] current_cmd_angular_z:0.31251208600339786 +[2026-10-05 17:29:12.466] [path_visualizer] [debug] current_pose_x:4.25494829810453, current_pose_y:1.9634252527953882,current_pose_yaw:2.896580219268799 +[2026-10-05 17:29:12.466] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.467] [path_visualizer] [debug] current_cmd_angular_z:0.31251208600339786 +[2026-10-05 17:29:12.516] [path_visualizer] [debug] current_pose_x:4.202456951714825, current_pose_y:1.9638355417102198,current_pose_yaw:2.9071524143218994 +[2026-10-05 17:29:12.516] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.516] [path_visualizer] [debug] current_cmd_angular_z:0.2939270272254616 +[2026-10-05 17:29:12.566] [path_visualizer] [debug] current_pose_x:4.202456951714825, current_pose_y:1.9638355417102198,current_pose_yaw:2.9071524143218994 +[2026-10-05 17:29:12.566] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.567] [path_visualizer] [debug] current_cmd_angular_z:0.2939270272254616 +[2026-10-05 17:29:12.616] [path_visualizer] [debug] current_pose_x:4.1501482437186334, current_pose_y:1.9641863412873106,current_pose_yaw:2.917207956314087 +[2026-10-05 17:29:12.616] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.617] [path_visualizer] [debug] current_cmd_angular_z:0.27600430123956055 +[2026-10-05 17:29:12.666] [path_visualizer] [debug] current_pose_x:4.1501482437186334, current_pose_y:1.9641863412873106,current_pose_yaw:2.917207956314087 +[2026-10-05 17:29:12.667] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.667] [path_visualizer] [debug] current_cmd_angular_z:0.27600430123956055 +[2026-10-05 17:29:12.716] [path_visualizer] [debug] current_pose_x:4.1501482437186334, current_pose_y:1.9641863412873106,current_pose_yaw:2.917207956314087 +[2026-10-05 17:29:12.716] [path_visualizer] [debug] current_path_x:4.247631121519174, current_path_y:1.9918459580714847,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.716] [path_visualizer] [debug] current_cmd_angular_z:0.27600430123956055 +[2026-10-05 17:29:12.766] [path_visualizer] [debug] current_pose_x:4.098060074980023, current_pose_y:1.9647296630608002,current_pose_yaw:2.926539182662964 +[2026-10-05 17:29:12.767] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.767] [path_visualizer] [debug] current_cmd_angular_z:0.26073162835748787 +[2026-10-05 17:29:12.816] [path_visualizer] [debug] current_pose_x:4.098060074980023, current_pose_y:1.9647296630608002,current_pose_yaw:2.926539182662964 +[2026-10-05 17:29:12.816] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.816] [path_visualizer] [debug] current_cmd_angular_z:0.26073162835748787 +[2026-10-05 17:29:12.866] [path_visualizer] [debug] current_pose_x:4.098060074980023, current_pose_y:1.9647296630608002,current_pose_yaw:2.926539182662964 +[2026-10-05 17:29:12.867] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.867] [path_visualizer] [debug] current_cmd_angular_z:0.26073162835748787 +[2026-10-05 17:29:12.916] [path_visualizer] [debug] current_pose_x:4.046138182739863, current_pose_y:1.9653082829069144,current_pose_yaw:2.9353365898132324 +[2026-10-05 17:29:12.916] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.916] [path_visualizer] [debug] current_cmd_angular_z:0.24674684500126512 +[2026-10-05 17:29:12.967] [path_visualizer] [debug] current_pose_x:4.046138182739863, current_pose_y:1.9653082829069144,current_pose_yaw:2.9353365898132324 +[2026-10-05 17:29:12.967] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:12.967] [path_visualizer] [debug] current_cmd_angular_z:0.24674684500126512 +[2026-10-05 17:29:13.016] [path_visualizer] [debug] current_pose_x:3.9943405087704322, current_pose_y:1.965739638495275,current_pose_yaw:2.9437930583953857 +[2026-10-05 17:29:13.016] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.017] [path_visualizer] [debug] current_cmd_angular_z:0.2325253277115696 +[2026-10-05 17:29:13.066] [path_visualizer] [debug] current_pose_x:3.9943405087704322, current_pose_y:1.965739638495275,current_pose_yaw:2.9437930583953857 +[2026-10-05 17:29:13.066] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.066] [path_visualizer] [debug] current_cmd_angular_z:0.2325253277115696 +[2026-10-05 17:29:13.116] [path_visualizer] [debug] current_pose_x:3.9943405087704322, current_pose_y:1.965739638495275,current_pose_yaw:2.9437930583953857 +[2026-10-05 17:29:13.117] [path_visualizer] [debug] current_path_x:4.052337736646965, current_path_y:1.9918459217525613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.117] [path_visualizer] [debug] current_cmd_angular_z:0.2325253277115696 +[2026-10-05 17:29:13.166] [path_visualizer] [debug] current_pose_x:3.9426999219874586, current_pose_y:1.966268024413428,current_pose_yaw:2.951704740524292 +[2026-10-05 17:29:13.166] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.166] [path_visualizer] [debug] current_cmd_angular_z:0.2199992260173462 +[2026-10-05 17:29:13.216] [path_visualizer] [debug] current_pose_x:3.9426999219874586, current_pose_y:1.966268024413428,current_pose_yaw:2.951704740524292 +[2026-10-05 17:29:13.216] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.217] [path_visualizer] [debug] current_cmd_angular_z:0.2199992260173462 +[2026-10-05 17:29:13.266] [path_visualizer] [debug] current_pose_x:3.891165119582066, current_pose_y:1.9666855103880634,current_pose_yaw:2.959296226501465 +[2026-10-05 17:29:13.266] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.266] [path_visualizer] [debug] current_cmd_angular_z:0.2074214479820061 +[2026-10-05 17:29:13.316] [path_visualizer] [debug] current_pose_x:3.891165119582066, current_pose_y:1.9666855103880634,current_pose_yaw:2.959296226501465 +[2026-10-05 17:29:13.317] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.317] [path_visualizer] [debug] current_cmd_angular_z:0.2074214479820061 +[2026-10-05 17:29:13.366] [path_visualizer] [debug] current_pose_x:3.891165119582066, current_pose_y:1.9666855103880634,current_pose_yaw:2.959296226501465 +[2026-10-05 17:29:13.366] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.366] [path_visualizer] [debug] current_cmd_angular_z:0.2074214479820061 +[2026-10-05 17:29:13.417] [path_visualizer] [debug] current_pose_x:3.839766644544525, current_pose_y:1.9671919667820723,current_pose_yaw:2.966399908065796 +[2026-10-05 17:29:13.417] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.417] [path_visualizer] [debug] current_cmd_angular_z:0.19637465040069865 +[2026-10-05 17:29:13.466] [path_visualizer] [debug] current_pose_x:3.839766644544525, current_pose_y:1.9671919667820723,current_pose_yaw:2.966399908065796 +[2026-10-05 17:29:13.466] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.466] [path_visualizer] [debug] current_cmd_angular_z:0.19637465040069865 +[2026-10-05 17:29:13.517] [path_visualizer] [debug] current_pose_x:3.7884706651500473, current_pose_y:1.967710526300581,current_pose_yaw:2.9731240272521973 +[2026-10-05 17:29:13.517] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.517] [path_visualizer] [debug] current_cmd_angular_z:0.1861627070355852 +[2026-10-05 17:29:13.566] [path_visualizer] [debug] current_pose_x:3.7884706651500473, current_pose_y:1.967710526300581,current_pose_yaw:2.9731240272521973 +[2026-10-05 17:29:13.567] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.567] [path_visualizer] [debug] current_cmd_angular_z:0.1861627070355852 +[2026-10-05 17:29:13.616] [path_visualizer] [debug] current_pose_x:3.7884706651500473, current_pose_y:1.967710526300581,current_pose_yaw:2.9731240272521973 +[2026-10-05 17:29:13.616] [path_visualizer] [debug] current_path_x:3.8570443517747552, current_path_y:1.9918458854336376,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.617] [path_visualizer] [debug] current_cmd_angular_z:0.1861627070355852 +[2026-10-05 17:29:13.666] [path_visualizer] [debug] current_pose_x:3.7372578826557143, current_pose_y:1.9682330128979357,current_pose_yaw:2.9795072078704834 +[2026-10-05 17:29:13.667] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.667] [path_visualizer] [debug] current_cmd_angular_z:0.17665757536269114 +[2026-10-05 17:29:13.716] [path_visualizer] [debug] current_pose_x:3.7372578826557143, current_pose_y:1.9682330128979357,current_pose_yaw:2.9795072078704834 +[2026-10-05 17:29:13.716] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.716] [path_visualizer] [debug] current_cmd_angular_z:0.17665757536269114 +[2026-10-05 17:29:13.766] [path_visualizer] [debug] current_pose_x:3.7372578826557143, current_pose_y:1.9682330128979357,current_pose_yaw:2.9795072078704834 +[2026-10-05 17:29:13.767] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.767] [path_visualizer] [debug] current_cmd_angular_z:0.17665757536269114 +[2026-10-05 17:29:13.816] [path_visualizer] [debug] current_pose_x:3.68612000587962, current_pose_y:1.9687512455183074,current_pose_yaw:2.985574245452881 +[2026-10-05 17:29:13.816] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.816] [path_visualizer] [debug] current_cmd_angular_z:0.16775814698907182 +[2026-10-05 17:29:13.867] [path_visualizer] [debug] current_pose_x:3.68612000587962, current_pose_y:1.9687512455183074,current_pose_yaw:2.985574245452881 +[2026-10-05 17:29:13.867] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.867] [path_visualizer] [debug] current_cmd_angular_z:0.16775814698907182 +[2026-10-05 17:29:13.916] [path_visualizer] [debug] current_pose_x:3.6350385384998347, current_pose_y:1.9691756453886398,current_pose_yaw:2.991422176361084 +[2026-10-05 17:29:13.916] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.916] [path_visualizer] [debug] current_cmd_angular_z:0.15871139795350794 +[2026-10-05 17:29:13.967] [path_visualizer] [debug] current_pose_x:3.6350385384998347, current_pose_y:1.9691756453886398,current_pose_yaw:2.991422176361084 +[2026-10-05 17:29:13.967] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:13.967] [path_visualizer] [debug] current_cmd_angular_z:0.15871139795350794 +[2026-10-05 17:29:14.016] [path_visualizer] [debug] current_pose_x:3.6350385384998347, current_pose_y:1.9691756453886398,current_pose_yaw:2.991422176361084 +[2026-10-05 17:29:14.016] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.017] [path_visualizer] [debug] current_cmd_angular_z:0.15871139795350794 +[2026-10-05 17:29:14.066] [path_visualizer] [debug] current_pose_x:3.584035294158064, current_pose_y:1.9696686088645028,current_pose_yaw:2.9969146251678467 +[2026-10-05 17:29:14.066] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.066] [path_visualizer] [debug] current_cmd_angular_z:0.1508037444310657 +[2026-10-05 17:29:14.116] [path_visualizer] [debug] current_pose_x:3.584035294158064, current_pose_y:1.9696686088645028,current_pose_yaw:2.9969146251678467 +[2026-10-05 17:29:14.116] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.117] [path_visualizer] [debug] current_cmd_angular_z:0.1508037444310657 +[2026-10-05 17:29:14.167] [path_visualizer] [debug] current_pose_x:3.584035294158064, current_pose_y:1.9696686088645028,current_pose_yaw:2.9969146251678467 +[2026-10-05 17:29:14.167] [path_visualizer] [debug] current_path_x:3.6617509669025456, current_path_y:1.9918458491147142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.167] [path_visualizer] [debug] current_cmd_angular_z:0.1508037444310657 +[2026-10-05 17:29:14.216] [path_visualizer] [debug] current_pose_x:3.5330930038376307, current_pose_y:1.9701653326274053,current_pose_yaw:3.0021300315856934 +[2026-10-05 17:29:14.216] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.216] [path_visualizer] [debug] current_cmd_angular_z:0.14347404084533202 +[2026-10-05 17:29:14.266] [path_visualizer] [debug] current_pose_x:3.5330930038376307, current_pose_y:1.9701653326274053,current_pose_yaw:3.0021300315856934 +[2026-10-05 17:29:14.266] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.266] [path_visualizer] [debug] current_cmd_angular_z:0.14347404084533202 +[2026-10-05 17:29:14.316] [path_visualizer] [debug] current_pose_x:3.482196736138242, current_pose_y:1.970573098358748,current_pose_yaw:3.0071651935577393 +[2026-10-05 17:29:14.316] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.317] [path_visualizer] [debug] current_cmd_angular_z:0.1359493861281004 +[2026-10-05 17:29:14.366] [path_visualizer] [debug] current_pose_x:3.482196736138242, current_pose_y:1.970573098358748,current_pose_yaw:3.0071651935577393 +[2026-10-05 17:29:14.366] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.366] [path_visualizer] [debug] current_cmd_angular_z:0.1359493861281004 +[2026-10-05 17:29:14.416] [path_visualizer] [debug] current_pose_x:3.482196736138242, current_pose_y:1.970573098358748,current_pose_yaw:3.0071651935577393 +[2026-10-05 17:29:14.417] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.417] [path_visualizer] [debug] current_cmd_angular_z:0.1359493861281004 +[2026-10-05 17:29:14.466] [path_visualizer] [debug] current_pose_x:3.431359634745263, current_pose_y:1.971027450146063,current_pose_yaw:3.0119071006774902 +[2026-10-05 17:29:14.466] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.467] [path_visualizer] [debug] current_cmd_angular_z:0.12930220322314276 +[2026-10-05 17:29:14.516] [path_visualizer] [debug] current_pose_x:3.431359634745263, current_pose_y:1.971027450146063,current_pose_yaw:3.0119071006774902 +[2026-10-05 17:29:14.516] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.516] [path_visualizer] [debug] current_cmd_angular_z:0.12930220322314276 +[2026-10-05 17:29:14.566] [path_visualizer] [debug] current_pose_x:3.3805636801585006, current_pose_y:1.9714134337066178,current_pose_yaw:3.0164756774902344 +[2026-10-05 17:29:14.566] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.567] [path_visualizer] [debug] current_cmd_angular_z:0.1225749440195486 +[2026-10-05 17:29:14.616] [path_visualizer] [debug] current_pose_x:3.3805636801585006, current_pose_y:1.9714134337066178,current_pose_yaw:3.0164756774902344 +[2026-10-05 17:29:14.616] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.616] [path_visualizer] [debug] current_cmd_angular_z:0.1225749440195486 +[2026-10-05 17:29:14.666] [path_visualizer] [debug] current_pose_x:3.3805636801585006, current_pose_y:1.9714134337066178,current_pose_yaw:3.0164756774902344 +[2026-10-05 17:29:14.666] [path_visualizer] [debug] current_path_x:3.466457582030336, current_path_y:1.9918458127957905,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.666] [path_visualizer] [debug] current_cmd_angular_z:0.1225749440195486 +[2026-10-05 17:29:14.717] [path_visualizer] [debug] current_pose_x:3.3298079542060925, current_pose_y:1.971866806025373,current_pose_yaw:3.020770311355591 +[2026-10-05 17:29:14.717] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.717] [path_visualizer] [debug] current_cmd_angular_z:0.1168166580014001 +[2026-10-05 17:29:14.767] [path_visualizer] [debug] current_pose_x:3.3298079542060925, current_pose_y:1.971866806025373,current_pose_yaw:3.020770311355591 +[2026-10-05 17:29:14.767] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.767] [path_visualizer] [debug] current_cmd_angular_z:0.1168166580014001 +[2026-10-05 17:29:14.816] [path_visualizer] [debug] current_pose_x:3.2790698489648564, current_pose_y:1.9722962533545532,current_pose_yaw:3.0248968601226807 +[2026-10-05 17:29:14.816] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.816] [path_visualizer] [debug] current_cmd_angular_z:0.11124504903471583 +[2026-10-05 17:29:14.866] [path_visualizer] [debug] current_pose_x:3.2790698489648564, current_pose_y:1.9722962533545532,current_pose_yaw:3.0248968601226807 +[2026-10-05 17:29:14.866] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.866] [path_visualizer] [debug] current_cmd_angular_z:0.11124504903471583 +[2026-10-05 17:29:14.916] [path_visualizer] [debug] current_pose_x:3.2790698489648564, current_pose_y:1.9722962533545532,current_pose_yaw:3.0248968601226807 +[2026-10-05 17:29:14.916] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.916] [path_visualizer] [debug] current_cmd_angular_z:0.11124504903471583 +[2026-10-05 17:29:14.967] [path_visualizer] [debug] current_pose_x:3.2283564285997537, current_pose_y:1.972789101196208,current_pose_yaw:3.0287833213806152 +[2026-10-05 17:29:14.967] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:14.967] [path_visualizer] [debug] current_cmd_angular_z:0.10654962593261859 +[2026-10-05 17:29:15.016] [path_visualizer] [debug] current_pose_x:3.2283564285997537, current_pose_y:1.972789101196208,current_pose_yaw:3.0287833213806152 +[2026-10-05 17:29:15.016] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.016] [path_visualizer] [debug] current_cmd_angular_z:0.10654962593261859 +[2026-10-05 17:29:15.066] [path_visualizer] [debug] current_pose_x:3.2283564285997537, current_pose_y:1.972789101196208,current_pose_yaw:3.0287833213806152 +[2026-10-05 17:29:15.066] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.066] [path_visualizer] [debug] current_cmd_angular_z:0.10654962593261859 +[2026-10-05 17:29:15.116] [path_visualizer] [debug] current_pose_x:3.1776601495595234, current_pose_y:1.9732886493157178,current_pose_yaw:3.0324909687042236 +[2026-10-05 17:29:15.116] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.117] [path_visualizer] [debug] current_cmd_angular_z:0.10225381325615433 +[2026-10-05 17:29:15.167] [path_visualizer] [debug] current_pose_x:3.1776601495595234, current_pose_y:1.9732886493157178,current_pose_yaw:3.0324909687042236 +[2026-10-05 17:29:15.167] [path_visualizer] [debug] current_path_x:3.2711641971581265, current_path_y:1.9918457764768671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.167] [path_visualizer] [debug] current_cmd_angular_z:0.10225381325615433 +[2026-10-05 17:29:15.216] [path_visualizer] [debug] current_pose_x:3.1269742163021768, current_pose_y:1.9737341969178575,current_pose_yaw:3.0360822677612305 +[2026-10-05 17:29:15.216] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.216] [path_visualizer] [debug] current_cmd_angular_z:0.09785383054741312 +[2026-10-05 17:29:15.266] [path_visualizer] [debug] current_pose_x:3.1269742163021768, current_pose_y:1.9737341969178575,current_pose_yaw:3.0360822677612305 +[2026-10-05 17:29:15.267] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.267] [path_visualizer] [debug] current_cmd_angular_z:0.09785383054741312 +[2026-10-05 17:29:15.316] [path_visualizer] [debug] current_pose_x:3.1269742163021768, current_pose_y:1.9737341969178575,current_pose_yaw:3.0360822677612305 +[2026-10-05 17:29:15.316] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.316] [path_visualizer] [debug] current_cmd_angular_z:0.09785383054741312 +[2026-10-05 17:29:15.366] [path_visualizer] [debug] current_pose_x:3.076305123628103, current_pose_y:1.9742027844618242,current_pose_yaw:3.039492130279541 +[2026-10-05 17:29:15.366] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.366] [path_visualizer] [debug] current_cmd_angular_z:0.09396049430495237 +[2026-10-05 17:29:15.416] [path_visualizer] [debug] current_pose_x:3.076305123628103, current_pose_y:1.9742027844618242,current_pose_yaw:3.039492130279541 +[2026-10-05 17:29:15.416] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.416] [path_visualizer] [debug] current_cmd_angular_z:0.09396049430495237 +[2026-10-05 17:29:15.466] [path_visualizer] [debug] current_pose_x:3.0256344684805905, current_pose_y:1.9746316989696768,current_pose_yaw:3.0427932739257812 +[2026-10-05 17:29:15.466] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.466] [path_visualizer] [debug] current_cmd_angular_z:0.09003693621540688 +[2026-10-05 17:29:15.516] [path_visualizer] [debug] current_pose_x:3.0256344684805905, current_pose_y:1.9746316989696768,current_pose_yaw:3.0427932739257812 +[2026-10-05 17:29:15.516] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.516] [path_visualizer] [debug] current_cmd_angular_z:0.09003693621540688 +[2026-10-05 17:29:15.566] [path_visualizer] [debug] current_pose_x:3.0256344684805905, current_pose_y:1.9746316989696768,current_pose_yaw:3.0427932739257812 +[2026-10-05 17:29:15.566] [path_visualizer] [debug] current_path_x:3.075870812285917, current_path_y:1.9918457401579435,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.567] [path_visualizer] [debug] current_cmd_angular_z:0.09003693621540688 +[2026-10-05 17:29:15.616] [path_visualizer] [debug] current_pose_x:2.974968325689254, current_pose_y:1.9750805750652716,current_pose_yaw:3.0459344387054443 +[2026-10-05 17:29:15.616] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.617] [path_visualizer] [debug] current_cmd_angular_z:0.0865583329694524 +[2026-10-05 17:29:15.666] [path_visualizer] [debug] current_pose_x:2.974968325689254, current_pose_y:1.9750805750652716,current_pose_yaw:3.0459344387054443 +[2026-10-05 17:29:15.667] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.667] [path_visualizer] [debug] current_cmd_angular_z:0.0865583329694524 +[2026-10-05 17:29:15.716] [path_visualizer] [debug] current_pose_x:2.9243128452499487, current_pose_y:1.975514438778655,current_pose_yaw:3.048948049545288 +[2026-10-05 17:29:15.716] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.716] [path_visualizer] [debug] current_cmd_angular_z:0.08324094783218627 +[2026-10-05 17:29:15.767] [path_visualizer] [debug] current_pose_x:2.9243128452499487, current_pose_y:1.975514438778655,current_pose_yaw:3.048948049545288 +[2026-10-05 17:29:15.767] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.767] [path_visualizer] [debug] current_cmd_angular_z:0.08324094783218627 +[2026-10-05 17:29:15.816] [path_visualizer] [debug] current_pose_x:2.9243128452499487, current_pose_y:1.975514438778655,current_pose_yaw:3.048948049545288 +[2026-10-05 17:29:15.816] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.816] [path_visualizer] [debug] current_cmd_angular_z:0.08324094783218627 +[2026-10-05 17:29:15.866] [path_visualizer] [debug] current_pose_x:2.8736681801491093, current_pose_y:1.975925745541553,current_pose_yaw:3.051846981048584 +[2026-10-05 17:29:15.866] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.866] [path_visualizer] [debug] current_cmd_angular_z:0.08001212117765541 +[2026-10-05 17:29:15.916] [path_visualizer] [debug] current_pose_x:2.8736681801491093, current_pose_y:1.975925745541553,current_pose_yaw:3.051846981048584 +[2026-10-05 17:29:15.916] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.916] [path_visualizer] [debug] current_cmd_angular_z:0.08001212117765541 +[2026-10-05 17:29:15.966] [path_visualizer] [debug] current_pose_x:2.8736681801491093, current_pose_y:1.975925745541553,current_pose_yaw:3.051846981048584 +[2026-10-05 17:29:15.966] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:15.966] [path_visualizer] [debug] current_cmd_angular_z:0.08001212117765541 +[2026-10-05 17:29:16.016] [path_visualizer] [debug] current_pose_x:2.823031663426008, current_pose_y:1.9763158950709498,current_pose_yaw:3.054635763168335 +[2026-10-05 17:29:16.016] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.016] [path_visualizer] [debug] current_cmd_angular_z:0.07687152037775968 +[2026-10-05 17:29:16.067] [path_visualizer] [debug] current_pose_x:2.823031663426008, current_pose_y:1.9763158950709498,current_pose_yaw:3.054635763168335 +[2026-10-05 17:29:16.067] [path_visualizer] [debug] current_path_x:2.8805774274137073, current_path_y:1.99184570383902,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.067] [path_visualizer] [debug] current_cmd_angular_z:0.07687152037775968 +[2026-10-05 17:29:16.116] [path_visualizer] [debug] current_pose_x:2.7724006876921163, current_pose_y:1.9766599582209534,current_pose_yaw:3.0573418140411377 +[2026-10-05 17:29:16.116] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.116] [path_visualizer] [debug] current_cmd_angular_z:0.07360880220669097 +[2026-10-05 17:29:16.166] [path_visualizer] [debug] current_pose_x:2.7724006876921163, current_pose_y:1.9766599582209534,current_pose_yaw:3.0573418140411377 +[2026-10-05 17:29:16.167] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.167] [path_visualizer] [debug] current_cmd_angular_z:0.07360880220669097 +[2026-10-05 17:29:16.216] [path_visualizer] [debug] current_pose_x:2.7724006876921163, current_pose_y:1.9766599582209534,current_pose_yaw:3.0573418140411377 +[2026-10-05 17:29:16.216] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.216] [path_visualizer] [debug] current_cmd_angular_z:0.07360880220669097 +[2026-10-05 17:29:16.267] [path_visualizer] [debug] current_pose_x:2.7217773758946127, current_pose_y:1.9770165267866713,current_pose_yaw:3.0599160194396973 +[2026-10-05 17:29:16.267] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.267] [path_visualizer] [debug] current_cmd_angular_z:0.07068772029772855 +[2026-10-05 17:29:16.316] [path_visualizer] [debug] current_pose_x:2.7217773758946127, current_pose_y:1.9770165267866713,current_pose_yaw:3.0599160194396973 +[2026-10-05 17:29:16.316] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.316] [path_visualizer] [debug] current_cmd_angular_z:0.07068772029772855 +[2026-10-05 17:29:16.367] [path_visualizer] [debug] current_pose_x:2.7217773758946127, current_pose_y:1.9770165267866713,current_pose_yaw:3.0599160194396973 +[2026-10-05 17:29:16.367] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.367] [path_visualizer] [debug] current_cmd_angular_z:0.07068772029772855 +[2026-10-05 17:29:16.416] [path_visualizer] [debug] current_pose_x:2.6711624612562543, current_pose_y:1.9773638860935094,current_pose_yaw:3.0623843669891357 +[2026-10-05 17:29:16.416] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.417] [path_visualizer] [debug] current_cmd_angular_z:0.06792088313168515 +[2026-10-05 17:29:16.466] [path_visualizer] [debug] current_pose_x:2.6711624612562543, current_pose_y:1.9773638860935094,current_pose_yaw:3.0623843669891357 +[2026-10-05 17:29:16.466] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.466] [path_visualizer] [debug] current_cmd_angular_z:0.06792088313168515 +[2026-10-05 17:29:16.516] [path_visualizer] [debug] current_pose_x:2.6205518297264474, current_pose_y:1.9776717821656882,current_pose_yaw:3.0647783279418945 +[2026-10-05 17:29:16.517] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.517] [path_visualizer] [debug] current_cmd_angular_z:0.06505634779079233 +[2026-10-05 17:29:16.566] [path_visualizer] [debug] current_pose_x:2.6205518297264474, current_pose_y:1.9776717821656882,current_pose_yaw:3.0647783279418945 +[2026-10-05 17:29:16.566] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.566] [path_visualizer] [debug] current_cmd_angular_z:0.06505634779079233 +[2026-10-05 17:29:16.616] [path_visualizer] [debug] current_pose_x:2.6205518297264474, current_pose_y:1.9776717821656882,current_pose_yaw:3.0647783279418945 +[2026-10-05 17:29:16.616] [path_visualizer] [debug] current_path_x:2.685284042541498, current_path_y:1.9918456675200966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.617] [path_visualizer] [debug] current_cmd_angular_z:0.06505634779079233 +[2026-10-05 17:29:16.666] [path_visualizer] [debug] current_pose_x:2.5699478991212237, current_pose_y:1.9779897507703725,current_pose_yaw:3.067056894302368 +[2026-10-05 17:29:16.666] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.666] [path_visualizer] [debug] current_cmd_angular_z:0.06248579279997317 +[2026-10-05 17:29:16.716] [path_visualizer] [debug] current_pose_x:2.5699478991212237, current_pose_y:1.9779897507703725,current_pose_yaw:3.067056894302368 +[2026-10-05 17:29:16.717] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.717] [path_visualizer] [debug] current_cmd_angular_z:0.06248579279997317 +[2026-10-05 17:29:16.766] [path_visualizer] [debug] current_pose_x:2.519346264969018, current_pose_y:1.9782764027585313,current_pose_yaw:3.0692625045776367 +[2026-10-05 17:29:16.766] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.766] [path_visualizer] [debug] current_cmd_angular_z:0.059865325198354566 +[2026-10-05 17:29:16.816] [path_visualizer] [debug] current_pose_x:2.519346264969018, current_pose_y:1.9782764027585313,current_pose_yaw:3.0692625045776367 +[2026-10-05 17:29:16.816] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.816] [path_visualizer] [debug] current_cmd_angular_z:0.059865325198354566 +[2026-10-05 17:29:16.866] [path_visualizer] [debug] current_pose_x:2.519346264969018, current_pose_y:1.9782764027585313,current_pose_yaw:3.0692625045776367 +[2026-10-05 17:29:16.866] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.866] [path_visualizer] [debug] current_cmd_angular_z:0.059865325198354566 +[2026-10-05 17:29:16.916] [path_visualizer] [debug] current_pose_x:2.468752969230027, current_pose_y:1.9785734364468728,current_pose_yaw:3.0713608264923096 +[2026-10-05 17:29:16.916] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.916] [path_visualizer] [debug] current_cmd_angular_z:0.05752432602550128 +[2026-10-05 17:29:16.967] [path_visualizer] [debug] current_pose_x:2.468752969230027, current_pose_y:1.9785734364468728,current_pose_yaw:3.0713608264923096 +[2026-10-05 17:29:16.967] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:16.967] [path_visualizer] [debug] current_cmd_angular_z:0.05752432602550128 +[2026-10-05 17:29:17.016] [path_visualizer] [debug] current_pose_x:2.418164176023036, current_pose_y:1.9788622869168977,current_pose_yaw:3.073373317718506 +[2026-10-05 17:29:17.016] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.016] [path_visualizer] [debug] current_cmd_angular_z:0.055303899846655 +[2026-10-05 17:29:17.066] [path_visualizer] [debug] current_pose_x:2.418164176023036, current_pose_y:1.9788622869168977,current_pose_yaw:3.073373317718506 +[2026-10-05 17:29:17.067] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.067] [path_visualizer] [debug] current_cmd_angular_z:0.055303899846655 +[2026-10-05 17:29:17.116] [path_visualizer] [debug] current_pose_x:2.418164176023036, current_pose_y:1.9788622869168977,current_pose_yaw:3.073373317718506 +[2026-10-05 17:29:17.116] [path_visualizer] [debug] current_path_x:2.489990657669288, current_path_y:1.991845631201173,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.116] [path_visualizer] [debug] current_cmd_angular_z:0.055303899846655 +[2026-10-05 17:29:17.167] [path_visualizer] [debug] current_pose_x:2.3675640259915562, current_pose_y:1.9791290581283902,current_pose_yaw:3.0753068923950195 +[2026-10-05 17:29:17.167] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.167] [path_visualizer] [debug] current_cmd_angular_z:0.05310362520084226 +[2026-10-05 17:29:17.216] [path_visualizer] [debug] current_pose_x:2.3675640259915562, current_pose_y:1.9791290581283902,current_pose_yaw:3.0753068923950195 +[2026-10-05 17:29:17.216] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.216] [path_visualizer] [debug] current_cmd_angular_z:0.05310362520084226 +[2026-10-05 17:29:17.266] [path_visualizer] [debug] current_pose_x:2.3675640259915562, current_pose_y:1.9791290581283902,current_pose_yaw:3.0753068923950195 +[2026-10-05 17:29:17.266] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.266] [path_visualizer] [debug] current_cmd_angular_z:0.05310362520084226 +[2026-10-05 17:29:17.316] [path_visualizer] [debug] current_pose_x:2.316969868299756, current_pose_y:1.9793744663326407,current_pose_yaw:3.0771660804748535 +[2026-10-05 17:29:17.316] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.316] [path_visualizer] [debug] current_cmd_angular_z:0.05091845674259464 +[2026-10-05 17:29:17.366] [path_visualizer] [debug] current_pose_x:2.316969868299756, current_pose_y:1.9793744663326407,current_pose_yaw:3.0771660804748535 +[2026-10-05 17:29:17.366] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.366] [path_visualizer] [debug] current_cmd_angular_z:0.05091845674259464 +[2026-10-05 17:29:17.416] [path_visualizer] [debug] current_pose_x:2.2663857500822093, current_pose_y:1.979587440794456,current_pose_yaw:3.078967332839966 +[2026-10-05 17:29:17.416] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.416] [path_visualizer] [debug] current_cmd_angular_z:0.048646545868234164 +[2026-10-05 17:29:17.466] [path_visualizer] [debug] current_pose_x:2.2663857500822093, current_pose_y:1.979587440794456,current_pose_yaw:3.078967332839966 +[2026-10-05 17:29:17.466] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.467] [path_visualizer] [debug] current_cmd_angular_z:0.048646545868234164 +[2026-10-05 17:29:17.516] [path_visualizer] [debug] current_pose_x:2.2663857500822093, current_pose_y:1.979587440794456,current_pose_yaw:3.078967332839966 +[2026-10-05 17:29:17.516] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.516] [path_visualizer] [debug] current_cmd_angular_z:0.048646545868234164 +[2026-10-05 17:29:17.567] [path_visualizer] [debug] current_pose_x:2.215806160772914, current_pose_y:1.9798127802203749,current_pose_yaw:3.0806779861450195 +[2026-10-05 17:29:17.567] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.567] [path_visualizer] [debug] current_cmd_angular_z:0.04663310375885414 +[2026-10-05 17:29:17.616] [path_visualizer] [debug] current_pose_x:2.215806160772914, current_pose_y:1.9798127802203749,current_pose_yaw:3.0806779861450195 +[2026-10-05 17:29:17.616] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.617] [path_visualizer] [debug] current_cmd_angular_z:0.04663310375885414 +[2026-10-05 17:29:17.666] [path_visualizer] [debug] current_pose_x:2.215806160772914, current_pose_y:1.9798127802203749,current_pose_yaw:3.0806779861450195 +[2026-10-05 17:29:17.667] [path_visualizer] [debug] current_path_x:2.2946972727970785, current_path_y:1.9918455948822495,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.667] [path_visualizer] [debug] current_cmd_angular_z:0.04663310375885414 +[2026-10-05 17:29:17.716] [path_visualizer] [debug] current_pose_x:2.165230031302188, current_pose_y:1.9800360912871537,current_pose_yaw:3.082314968109131 +[2026-10-05 17:29:17.717] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.717] [path_visualizer] [debug] current_cmd_angular_z:0.04475457644955114 +[2026-10-05 17:29:17.766] [path_visualizer] [debug] current_pose_x:2.165230031302188, current_pose_y:1.9800360912871537,current_pose_yaw:3.082314968109131 +[2026-10-05 17:29:17.766] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.766] [path_visualizer] [debug] current_cmd_angular_z:0.04475457644955114 +[2026-10-05 17:29:17.816] [path_visualizer] [debug] current_pose_x:2.1146615896158503, current_pose_y:1.9802405209370564,current_pose_yaw:3.083900213241577 +[2026-10-05 17:29:17.816] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.817] [path_visualizer] [debug] current_cmd_angular_z:0.04286134422111258 +[2026-10-05 17:29:17.866] [path_visualizer] [debug] current_pose_x:2.1146615896158503, current_pose_y:1.9802405209370564,current_pose_yaw:3.083900213241577 +[2026-10-05 17:29:17.866] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.866] [path_visualizer] [debug] current_cmd_angular_z:0.04286134422111258 +[2026-10-05 17:29:17.916] [path_visualizer] [debug] current_pose_x:2.1146615896158503, current_pose_y:1.9802405209370564,current_pose_yaw:3.083900213241577 +[2026-10-05 17:29:17.917] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.917] [path_visualizer] [debug] current_cmd_angular_z:0.04286134422111258 +[2026-10-05 17:29:17.966] [path_visualizer] [debug] current_pose_x:2.0641106718371596, current_pose_y:1.9804663168892807,current_pose_yaw:3.085407257080078 +[2026-10-05 17:29:17.966] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:17.966] [path_visualizer] [debug] current_cmd_angular_z:0.041258026479248394 +[2026-10-05 17:29:18.016] [path_visualizer] [debug] current_pose_x:2.0641106718371596, current_pose_y:1.9804663168892807,current_pose_yaw:3.085407257080078 +[2026-10-05 17:29:18.017] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.017] [path_visualizer] [debug] current_cmd_angular_z:0.041258026479248394 +[2026-10-05 17:29:18.066] [path_visualizer] [debug] current_pose_x:2.013559224740065, current_pose_y:1.9806700801469805,current_pose_yaw:3.0868656635284424 +[2026-10-05 17:29:18.066] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.066] [path_visualizer] [debug] current_cmd_angular_z:0.03961433876270233 +[2026-10-05 17:29:18.116] [path_visualizer] [debug] current_pose_x:2.013559224740065, current_pose_y:1.9806700801469805,current_pose_yaw:3.0868656635284424 +[2026-10-05 17:29:18.117] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.117] [path_visualizer] [debug] current_cmd_angular_z:0.03961433876270233 +[2026-10-05 17:29:18.166] [path_visualizer] [debug] current_pose_x:2.013559224740065, current_pose_y:1.9806700801469805,current_pose_yaw:3.0868656635284424 +[2026-10-05 17:29:18.166] [path_visualizer] [debug] current_path_x:2.0994038879248693, current_path_y:1.991845558563326,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.167] [path_visualizer] [debug] current_cmd_angular_z:0.03961433876270233 +[2026-10-05 17:29:18.216] [path_visualizer] [debug] current_pose_x:1.9630093528608463, current_pose_y:1.9808759373188225,current_pose_yaw:3.0882568359375 +[2026-10-05 17:29:18.216] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.216] [path_visualizer] [debug] current_cmd_angular_z:0.03811844282143434 +[2026-10-05 17:29:18.266] [path_visualizer] [debug] current_pose_x:1.9630093528608463, current_pose_y:1.9808759373188225,current_pose_yaw:3.0882568359375 +[2026-10-05 17:29:18.266] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.266] [path_visualizer] [debug] current_cmd_angular_z:0.03811844282143434 +[2026-10-05 17:29:18.317] [path_visualizer] [debug] current_pose_x:1.9630093528608463, current_pose_y:1.9808759373188225,current_pose_yaw:3.0882568359375 +[2026-10-05 17:29:18.317] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.317] [path_visualizer] [debug] current_cmd_angular_z:0.03811844282143434 +[2026-10-05 17:29:18.366] [path_visualizer] [debug] current_pose_x:1.9124609237830157, current_pose_y:1.9810741758731703,current_pose_yaw:3.0895931720733643 +[2026-10-05 17:29:18.367] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.367] [path_visualizer] [debug] current_cmd_angular_z:0.036684404296038114 +[2026-10-05 17:29:18.416] [path_visualizer] [debug] current_pose_x:1.9124609237830157, current_pose_y:1.9810741758731703,current_pose_yaw:3.0895931720733643 +[2026-10-05 17:29:18.416] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.416] [path_visualizer] [debug] current_cmd_angular_z:0.036684404296038114 +[2026-10-05 17:29:18.466] [path_visualizer] [debug] current_pose_x:1.8619151439588086, current_pose_y:1.9812529085226354,current_pose_yaw:3.0908966064453125 +[2026-10-05 17:29:18.466] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.466] [path_visualizer] [debug] current_cmd_angular_z:0.03519430362894101 +[2026-10-05 17:29:18.516] [path_visualizer] [debug] current_pose_x:1.8619151439588086, current_pose_y:1.9812529085226354,current_pose_yaw:3.0908966064453125 +[2026-10-05 17:29:18.516] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.516] [path_visualizer] [debug] current_cmd_angular_z:0.03519430362894101 +[2026-10-05 17:29:18.566] [path_visualizer] [debug] current_pose_x:1.8619151439588086, current_pose_y:1.9812529085226354,current_pose_yaw:3.0908966064453125 +[2026-10-05 17:29:18.567] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.567] [path_visualizer] [debug] current_cmd_angular_z:0.03519430362894101 +[2026-10-05 17:29:18.616] [path_visualizer] [debug] current_pose_x:1.811372360467899, current_pose_y:1.9814377000874703,current_pose_yaw:3.0921456813812256 +[2026-10-05 17:29:18.616] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.616] [path_visualizer] [debug] current_cmd_angular_z:0.03385079035819577 +[2026-10-05 17:29:18.666] [path_visualizer] [debug] current_pose_x:1.811372360467899, current_pose_y:1.9814377000874703,current_pose_yaw:3.0921456813812256 +[2026-10-05 17:29:18.667] [path_visualizer] [debug] current_path_x:1.9041105030526593, current_path_y:1.9918455222444025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.667] [path_visualizer] [debug] current_cmd_angular_z:0.03385079035819577 +[2026-10-05 17:29:18.716] [path_visualizer] [debug] current_pose_x:1.7608287357395818, current_pose_y:1.9816041440080419,current_pose_yaw:3.093356132507324 +[2026-10-05 17:29:18.716] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.716] [path_visualizer] [debug] current_cmd_angular_z:0.032470118509483226 +[2026-10-05 17:29:18.767] [path_visualizer] [debug] current_pose_x:1.7608287357395818, current_pose_y:1.9816041440080419,current_pose_yaw:3.093356132507324 +[2026-10-05 17:29:18.767] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.767] [path_visualizer] [debug] current_cmd_angular_z:0.032470118509483226 +[2026-10-05 17:29:18.816] [path_visualizer] [debug] current_pose_x:1.7608287357395818, current_pose_y:1.9816041440080419,current_pose_yaw:3.093356132507324 +[2026-10-05 17:29:18.816] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.816] [path_visualizer] [debug] current_cmd_angular_z:0.032470118509483226 +[2026-10-05 17:29:18.866] [path_visualizer] [debug] current_pose_x:1.7102881430992487, current_pose_y:1.9817728808909303,current_pose_yaw:3.094510555267334 +[2026-10-05 17:29:18.866] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.866] [path_visualizer] [debug] current_cmd_angular_z:0.031215613079092777 +[2026-10-05 17:29:18.916] [path_visualizer] [debug] current_pose_x:1.7102881430992487, current_pose_y:1.9817728808909303,current_pose_yaw:3.094510555267334 +[2026-10-05 17:29:18.916] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.917] [path_visualizer] [debug] current_cmd_angular_z:0.031215613079092777 +[2026-10-05 17:29:18.966] [path_visualizer] [debug] current_pose_x:1.6597464378265836, current_pose_y:1.98192476367573,current_pose_yaw:3.0956289768218994 +[2026-10-05 17:29:18.966] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:18.966] [path_visualizer] [debug] current_cmd_angular_z:0.02992780595643038 +[2026-10-05 17:29:19.016] [path_visualizer] [debug] current_pose_x:1.6597464378265836, current_pose_y:1.98192476367573,current_pose_yaw:3.0956289768218994 +[2026-10-05 17:29:19.016] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.016] [path_visualizer] [debug] current_cmd_angular_z:0.02992780595643038 +[2026-10-05 17:29:19.066] [path_visualizer] [debug] current_pose_x:1.6597464378265836, current_pose_y:1.98192476367573,current_pose_yaw:3.0956289768218994 +[2026-10-05 17:29:19.066] [path_visualizer] [debug] current_path_x:1.7088171181804501, current_path_y:1.9918454859254788,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.066] [path_visualizer] [debug] current_cmd_angular_z:0.02992780595643038 +[2026-10-05 17:29:19.116] [path_visualizer] [debug] current_pose_x:1.6092064183715586, current_pose_y:1.9820803874024993,current_pose_yaw:3.0966947078704834 +[2026-10-05 17:29:19.116] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.117] [path_visualizer] [debug] current_cmd_angular_z:0.02876898870962802 +[2026-10-05 17:29:19.166] [path_visualizer] [debug] current_pose_x:1.6092064183715586, current_pose_y:1.9820803874024993,current_pose_yaw:3.0966947078704834 +[2026-10-05 17:29:19.166] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.167] [path_visualizer] [debug] current_cmd_angular_z:0.02876898870962802 +[2026-10-05 17:29:19.216] [path_visualizer] [debug] current_pose_x:1.6092064183715586, current_pose_y:1.9820803874024993,current_pose_yaw:3.0966947078704834 +[2026-10-05 17:29:19.217] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.217] [path_visualizer] [debug] current_cmd_angular_z:0.02876898870962802 +[2026-10-05 17:29:19.266] [path_visualizer] [debug] current_pose_x:1.5586686975037494, current_pose_y:1.982230880817767,current_pose_yaw:3.097717523574829 +[2026-10-05 17:29:19.266] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.266] [path_visualizer] [debug] current_cmd_angular_z:0.027663725711140008 +[2026-10-05 17:29:19.317] [path_visualizer] [debug] current_pose_x:1.5586686975037494, current_pose_y:1.982230880817767,current_pose_yaw:3.097717523574829 +[2026-10-05 17:29:19.317] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.317] [path_visualizer] [debug] current_cmd_angular_z:0.027663725711140008 +[2026-10-05 17:29:19.366] [path_visualizer] [debug] current_pose_x:1.5081311715409882, current_pose_y:1.9823629065638628,current_pose_yaw:3.0987117290496826 +[2026-10-05 17:29:19.367] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.367] [path_visualizer] [debug] current_cmd_angular_z:0.02650029216531425 +[2026-10-05 17:29:19.416] [path_visualizer] [debug] current_pose_x:1.5081311715409882, current_pose_y:1.9823629065638628,current_pose_yaw:3.0987117290496826 +[2026-10-05 17:29:19.417] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.417] [path_visualizer] [debug] current_cmd_angular_z:0.02650029216531425 +[2026-10-05 17:29:19.466] [path_visualizer] [debug] current_pose_x:1.5081311715409882, current_pose_y:1.9823629065638628,current_pose_yaw:3.0987117290496826 +[2026-10-05 17:29:19.466] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.466] [path_visualizer] [debug] current_cmd_angular_z:0.02650029216531425 +[2026-10-05 17:29:19.516] [path_visualizer] [debug] current_pose_x:1.457594537799455, current_pose_y:1.982499037932985,current_pose_yaw:3.099658250808716 +[2026-10-05 17:29:19.516] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.516] [path_visualizer] [debug] current_cmd_angular_z:0.025457885763251295 +[2026-10-05 17:29:19.566] [path_visualizer] [debug] current_pose_x:1.457594537799455, current_pose_y:1.982499037932985,current_pose_yaw:3.099658250808716 +[2026-10-05 17:29:19.566] [path_visualizer] [debug] current_path_x:1.51352373330824, current_path_y:1.9918454496065554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.566] [path_visualizer] [debug] current_cmd_angular_z:0.025457885763251295 +[2026-10-05 17:29:19.616] [path_visualizer] [debug] current_pose_x:1.4070580845778908, current_pose_y:1.9826205873700804,current_pose_yaw:3.1005756855010986 +[2026-10-05 17:29:19.616] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.616] [path_visualizer] [debug] current_cmd_angular_z:0.024382767049123587 +[2026-10-05 17:29:19.666] [path_visualizer] [debug] current_pose_x:1.4070580845778908, current_pose_y:1.9826205873700804,current_pose_yaw:3.1005756855010986 +[2026-10-05 17:29:19.666] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.667] [path_visualizer] [debug] current_cmd_angular_z:0.024382767049123587 +[2026-10-05 17:29:19.716] [path_visualizer] [debug] current_pose_x:1.4070580845778908, current_pose_y:1.9826205873700804,current_pose_yaw:3.1005756855010986 +[2026-10-05 17:29:19.716] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.716] [path_visualizer] [debug] current_cmd_angular_z:0.024382767049123587 +[2026-10-05 17:29:19.766] [path_visualizer] [debug] current_pose_x:1.3565223384000238, current_pose_y:1.982745792668994,current_pose_yaw:3.1014492511749268 +[2026-10-05 17:29:19.766] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.766] [path_visualizer] [debug] current_cmd_angular_z:0.023418008601683457 +[2026-10-05 17:29:19.816] [path_visualizer] [debug] current_pose_x:1.3565223384000238, current_pose_y:1.982745792668994,current_pose_yaw:3.1014492511749268 +[2026-10-05 17:29:19.816] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.816] [path_visualizer] [debug] current_cmd_angular_z:0.023418008601683457 +[2026-10-05 17:29:19.866] [path_visualizer] [debug] current_pose_x:1.3565223384000238, current_pose_y:1.982745792668994,current_pose_yaw:3.1014492511749268 +[2026-10-05 17:29:19.866] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.867] [path_visualizer] [debug] current_cmd_angular_z:0.023418008601683457 +[2026-10-05 17:29:19.917] [path_visualizer] [debug] current_pose_x:1.305986989230808, current_pose_y:1.982868564807843,current_pose_yaw:3.1022865772247314 +[2026-10-05 17:29:19.917] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.917] [path_visualizer] [debug] current_cmd_angular_z:0.022510529493871438 +[2026-10-05 17:29:19.966] [path_visualizer] [debug] current_pose_x:1.305986989230808, current_pose_y:1.982868564807843,current_pose_yaw:3.1022865772247314 +[2026-10-05 17:29:19.966] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:19.966] [path_visualizer] [debug] current_cmd_angular_z:0.022510529493871438 +[2026-10-05 17:29:20.016] [path_visualizer] [debug] current_pose_x:1.2554516402659315, current_pose_y:1.9829757068428857,current_pose_yaw:3.103100538253784 +[2026-10-05 17:29:20.016] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.017] [path_visualizer] [debug] current_cmd_angular_z:0.021552115132708695 +[2026-10-05 17:29:20.066] [path_visualizer] [debug] current_pose_x:1.2554516402659315, current_pose_y:1.9829757068428857,current_pose_yaw:3.103100538253784 +[2026-10-05 17:29:20.066] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.066] [path_visualizer] [debug] current_cmd_angular_z:0.021552115132708695 +[2026-10-05 17:29:20.116] [path_visualizer] [debug] current_pose_x:1.2554516402659315, current_pose_y:1.9829757068428857,current_pose_yaw:3.103100538253784 +[2026-10-05 17:29:20.116] [path_visualizer] [debug] current_path_x:1.318230348436031, current_path_y:1.9918454132876318,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.116] [path_visualizer] [debug] current_cmd_angular_z:0.021552115132708695 +[2026-10-05 17:29:20.166] [path_visualizer] [debug] current_pose_x:1.2049209834239416, current_pose_y:1.9830788854670733,current_pose_yaw:3.103874683380127 +[2026-10-05 17:29:20.166] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.166] [path_visualizer] [debug] current_cmd_angular_z:0.020648795460074948 +[2026-10-05 17:29:20.216] [path_visualizer] [debug] current_pose_x:1.2049209834239416, current_pose_y:1.9830788854670733,current_pose_yaw:3.103874683380127 +[2026-10-05 17:29:20.216] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.216] [path_visualizer] [debug] current_cmd_angular_z:0.020648795460074948 +[2026-10-05 17:29:20.266] [path_visualizer] [debug] current_pose_x:1.154396567476001, current_pose_y:1.9831406983705304,current_pose_yaw:3.104618549346924 +[2026-10-05 17:29:20.266] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.267] [path_visualizer] [debug] current_cmd_angular_z:0.019547322340450583 +[2026-10-05 17:29:20.316] [path_visualizer] [debug] current_pose_x:1.154396567476001, current_pose_y:1.9831406983705304,current_pose_yaw:3.104618549346924 +[2026-10-05 17:29:20.317] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.317] [path_visualizer] [debug] current_cmd_angular_z:0.019547322340450583 +[2026-10-05 17:29:20.366] [path_visualizer] [debug] current_pose_x:1.154396567476001, current_pose_y:1.9831406983705304,current_pose_yaw:3.104618549346924 +[2026-10-05 17:29:20.366] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.367] [path_visualizer] [debug] current_cmd_angular_z:0.019547322340450583 +[2026-10-05 17:29:20.416] [path_visualizer] [debug] current_pose_x:1.103869145657478, current_pose_y:1.9832053557135754,current_pose_yaw:3.105323314666748 +[2026-10-05 17:29:20.417] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.417] [path_visualizer] [debug] current_cmd_angular_z:0.018541826036330693 +[2026-10-05 17:29:20.466] [path_visualizer] [debug] current_pose_x:1.103869145657478, current_pose_y:1.9832053557135754,current_pose_yaw:3.105323314666748 +[2026-10-05 17:29:20.466] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.466] [path_visualizer] [debug] current_cmd_angular_z:0.018541826036330693 +[2026-10-05 17:29:20.516] [path_visualizer] [debug] current_pose_x:1.103869145657478, current_pose_y:1.9832053557135754,current_pose_yaw:3.105323314666748 +[2026-10-05 17:29:20.517] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.517] [path_visualizer] [debug] current_cmd_angular_z:0.018541826036330693 +[2026-10-05 17:29:20.566] [path_visualizer] [debug] current_pose_x:1.0533418988033678, current_pose_y:1.9832735562568913,current_pose_yaw:3.105994701385498 +[2026-10-05 17:29:20.567] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.567] [path_visualizer] [debug] current_cmd_angular_z:0.017625229064542197 +[2026-10-05 17:29:20.616] [path_visualizer] [debug] current_pose_x:1.0533418988033678, current_pose_y:1.9832735562568913,current_pose_yaw:3.105994701385498 +[2026-10-05 17:29:20.616] [path_visualizer] [debug] current_path_x:1.1229369635638218, current_path_y:1.9918453769687083,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.617] [path_visualizer] [debug] current_cmd_angular_z:0.017625229064542197 +[2026-10-05 17:29:20.666] [path_visualizer] [debug] current_pose_x:1.0028147862461323, current_pose_y:1.9833367926196943,current_pose_yaw:3.1066412925720215 +[2026-10-05 17:29:20.667] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.667] [path_visualizer] [debug] current_cmd_angular_z:0.016727430177503944 +[2026-10-05 17:29:20.716] [path_visualizer] [debug] current_pose_x:1.0028147862461323, current_pose_y:1.9833367926196943,current_pose_yaw:3.1066412925720215 +[2026-10-05 17:29:20.716] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.716] [path_visualizer] [debug] current_cmd_angular_z:0.016727430177503944 +[2026-10-05 17:29:20.766] [path_visualizer] [debug] current_pose_x:1.0028147862461323, current_pose_y:1.9833367926196943,current_pose_yaw:3.1066412925720215 +[2026-10-05 17:29:20.766] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.767] [path_visualizer] [debug] current_cmd_angular_z:0.016727430177503944 +[2026-10-05 17:29:20.816] [path_visualizer] [debug] current_pose_x:0.9522882566414562, current_pose_y:1.9834096980271447,current_pose_yaw:3.107250690460205 +[2026-10-05 17:29:20.816] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.816] [path_visualizer] [debug] current_cmd_angular_z:0.015964213493187315 +[2026-10-05 17:29:20.867] [path_visualizer] [debug] current_pose_x:0.9522882566414562, current_pose_y:1.9834096980271447,current_pose_yaw:3.107250690460205 +[2026-10-05 17:29:20.867] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.867] [path_visualizer] [debug] current_cmd_angular_z:0.015964213493187315 +[2026-10-05 17:29:20.916] [path_visualizer] [debug] current_pose_x:0.9017433305493323, current_pose_y:1.9835053369614815,current_pose_yaw:3.1078338623046875 +[2026-10-05 17:29:20.916] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.916] [path_visualizer] [debug] current_cmd_angular_z:0.015395510617604108 +[2026-10-05 17:29:20.967] [path_visualizer] [debug] current_pose_x:0.9017433305493323, current_pose_y:1.9835053369614815,current_pose_yaw:3.1078338623046875 +[2026-10-05 17:29:20.967] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:20.967] [path_visualizer] [debug] current_cmd_angular_z:0.015395510617604108 +[2026-10-05 17:29:21.016] [path_visualizer] [debug] current_pose_x:0.9017433305493323, current_pose_y:1.9835053369614815,current_pose_yaw:3.1078338623046875 +[2026-10-05 17:29:21.016] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.016] [path_visualizer] [debug] current_cmd_angular_z:0.015395510617604108 +[2026-10-05 17:29:21.066] [path_visualizer] [debug] current_pose_x:0.851193176140645, current_pose_y:1.9836161396946803,current_pose_yaw:3.108384609222412 +[2026-10-05 17:29:21.066] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.066] [path_visualizer] [debug] current_cmd_angular_z:0.014986417970295436 +[2026-10-05 17:29:21.116] [path_visualizer] [debug] current_pose_x:0.851193176140645, current_pose_y:1.9836161396946803,current_pose_yaw:3.108384609222412 +[2026-10-05 17:29:21.116] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.117] [path_visualizer] [debug] current_cmd_angular_z:0.014986417970295436 +[2026-10-05 17:29:21.167] [path_visualizer] [debug] current_pose_x:0.851193176140645, current_pose_y:1.9836161396946803,current_pose_yaw:3.108384609222412 +[2026-10-05 17:29:21.167] [path_visualizer] [debug] current_path_x:0.9276435786916117, current_path_y:1.991845340649785,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.167] [path_visualizer] [debug] current_cmd_angular_z:0.014986417970295436 +[2026-10-05 17:29:21.216] [path_visualizer] [debug] current_pose_x:0.8006429400920233, current_pose_y:1.9837188762926314,current_pose_yaw:3.108917474746704 +[2026-10-05 17:29:21.216] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.216] [path_visualizer] [debug] current_cmd_angular_z:0.014562912421578249 +[2026-10-05 17:29:21.267] [path_visualizer] [debug] current_pose_x:0.8006429400920233, current_pose_y:1.9837188762926314,current_pose_yaw:3.108917474746704 +[2026-10-05 17:29:21.267] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.267] [path_visualizer] [debug] current_cmd_angular_z:0.014562912421578249 +[2026-10-05 17:29:21.316] [path_visualizer] [debug] current_pose_x:0.7500912424811368, current_pose_y:1.9838059881977648,current_pose_yaw:3.109440803527832 +[2026-10-05 17:29:21.316] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.316] [path_visualizer] [debug] current_cmd_angular_z:0.014060617567163147 +[2026-10-05 17:29:21.366] [path_visualizer] [debug] current_pose_x:0.7500912424811368, current_pose_y:1.9838059881977648,current_pose_yaw:3.109440803527832 +[2026-10-05 17:29:21.366] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.366] [path_visualizer] [debug] current_cmd_angular_z:0.014060617567163147 +[2026-10-05 17:29:21.417] [path_visualizer] [debug] current_pose_x:0.7500912424811368, current_pose_y:1.9838059881977648,current_pose_yaw:3.109440803527832 +[2026-10-05 17:29:21.417] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.417] [path_visualizer] [debug] current_cmd_angular_z:0.014060617567163147 +[2026-10-05 17:29:21.466] [path_visualizer] [debug] current_pose_x:0.6995419849046848, current_pose_y:1.9838870070217165,current_pose_yaw:3.1099460124969482 +[2026-10-05 17:29:21.466] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.466] [path_visualizer] [debug] current_cmd_angular_z:0.013556488323540353 +[2026-10-05 17:29:21.517] [path_visualizer] [debug] current_pose_x:0.6995419849046848, current_pose_y:1.9838870070217165,current_pose_yaw:3.1099460124969482 +[2026-10-05 17:29:21.517] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.517] [path_visualizer] [debug] current_cmd_angular_z:0.013556488323540353 +[2026-10-05 17:29:21.566] [path_visualizer] [debug] current_pose_x:0.6489929215642563, current_pose_y:1.9839588024708052,current_pose_yaw:3.1104369163513184 +[2026-10-05 17:29:21.566] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.566] [path_visualizer] [debug] current_cmd_angular_z:0.013023333552101495 +[2026-10-05 17:29:21.616] [path_visualizer] [debug] current_pose_x:0.6489929215642563, current_pose_y:1.9839588024708052,current_pose_yaw:3.1104369163513184 +[2026-10-05 17:29:21.616] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.616] [path_visualizer] [debug] current_cmd_angular_z:0.013023333552101495 +[2026-10-05 17:29:21.667] [path_visualizer] [debug] current_pose_x:0.6489929215642563, current_pose_y:1.9839588024708052,current_pose_yaw:3.1104369163513184 +[2026-10-05 17:29:21.667] [path_visualizer] [debug] current_path_x:0.7323501938194017, current_path_y:1.9918453043308613,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.667] [path_visualizer] [debug] current_cmd_angular_z:0.013023333552101495 +[2026-10-05 17:29:21.717] [path_visualizer] [debug] current_pose_x:0.5984441707894994, current_pose_y:1.9840283663564018,current_pose_yaw:3.110908031463623 +[2026-10-05 17:29:21.717] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.717] [path_visualizer] [debug] current_cmd_angular_z:0.01251603877173979 +[2026-10-05 17:29:21.766] [path_visualizer] [debug] current_pose_x:0.5984441707894994, current_pose_y:1.9840283663564018,current_pose_yaw:3.110908031463623 +[2026-10-05 17:29:21.767] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.767] [path_visualizer] [debug] current_cmd_angular_z:0.01251603877173979 +[2026-10-05 17:29:21.816] [path_visualizer] [debug] current_pose_x:0.5984441707894994, current_pose_y:1.9840283663564018,current_pose_yaw:3.110908031463623 +[2026-10-05 17:29:21.817] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.817] [path_visualizer] [debug] current_cmd_angular_z:0.01251603877173979 +[2026-10-05 17:29:21.866] [path_visualizer] [debug] current_pose_x:0.5478956442218457, current_pose_y:1.9840947027865363,current_pose_yaw:3.111361026763916 +[2026-10-05 17:29:21.866] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.867] [path_visualizer] [debug] current_cmd_angular_z:0.012024589671285037 +[2026-10-05 17:29:21.916] [path_visualizer] [debug] current_pose_x:0.5478956442218457, current_pose_y:1.9840947027865363,current_pose_yaw:3.111361026763916 +[2026-10-05 17:29:21.916] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.916] [path_visualizer] [debug] current_cmd_angular_z:0.012024589671285037 +[2026-10-05 17:29:21.966] [path_visualizer] [debug] current_pose_x:0.49734721048253316, current_pose_y:1.9841511925085293,current_pose_yaw:3.111802816390991 +[2026-10-05 17:29:21.967] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:21.967] [path_visualizer] [debug] current_cmd_angular_z:0.011494019913815823 +[2026-10-05 17:29:22.016] [path_visualizer] [debug] current_pose_x:0.49734721048253316, current_pose_y:1.9841511925085293,current_pose_yaw:3.111802816390991 +[2026-10-05 17:29:22.016] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.016] [path_visualizer] [debug] current_cmd_angular_z:0.011494019913815823 +[2026-10-05 17:29:22.066] [path_visualizer] [debug] current_pose_x:0.49734721048253316, current_pose_y:1.9841511925085293,current_pose_yaw:3.111802816390991 +[2026-10-05 17:29:22.066] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.067] [path_visualizer] [debug] current_cmd_angular_z:0.011494019913815823 +[2026-10-05 17:29:22.116] [path_visualizer] [debug] current_pose_x:0.4467991152658032, current_pose_y:1.9842112182671245,current_pose_yaw:3.1122219562530518 +[2026-10-05 17:29:22.116] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.116] [path_visualizer] [debug] current_cmd_angular_z:0.01103084751873075 +[2026-10-05 17:29:22.166] [path_visualizer] [debug] current_pose_x:0.4467991152658032, current_pose_y:1.9842112182671245,current_pose_yaw:3.1122219562530518 +[2026-10-05 17:29:22.166] [path_visualizer] [debug] current_path_x:0.5370568089471925, current_path_y:1.9918452680119378,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.166] [path_visualizer] [debug] current_cmd_angular_z:0.01103084751873075 +[2026-10-05 17:29:22.216] [path_visualizer] [debug] current_pose_x:0.39625109816537063, current_pose_y:1.984263137092126,current_pose_yaw:3.1126296520233154 +[2026-10-05 17:29:22.216] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.216] [path_visualizer] [debug] current_cmd_angular_z:0.010540129375129097 +[2026-10-05 17:29:22.266] [path_visualizer] [debug] current_pose_x:0.39625109816537063, current_pose_y:1.984263137092126,current_pose_yaw:3.1126296520233154 +[2026-10-05 17:29:22.266] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.266] [path_visualizer] [debug] current_cmd_angular_z:0.010540129375129097 +[2026-10-05 17:29:22.316] [path_visualizer] [debug] current_pose_x:0.39625109816537063, current_pose_y:1.984263137092126,current_pose_yaw:3.1126296520233154 +[2026-10-05 17:29:22.316] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.316] [path_visualizer] [debug] current_cmd_angular_z:0.010540129375129097 +[2026-10-05 17:29:22.367] [path_visualizer] [debug] current_pose_x:0.3457033464346452, current_pose_y:1.984317045592051,current_pose_yaw:3.1130173206329346 +[2026-10-05 17:29:22.367] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.367] [path_visualizer] [debug] current_cmd_angular_z:0.010101673463444052 +[2026-10-05 17:29:22.416] [path_visualizer] [debug] current_pose_x:0.3457033464346452, current_pose_y:1.984317045592051,current_pose_yaw:3.1130173206329346 +[2026-10-05 17:29:22.416] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.416] [path_visualizer] [debug] current_cmd_angular_z:0.010101673463444052 +[2026-10-05 17:29:22.467] [path_visualizer] [debug] current_pose_x:0.3457033464346452, current_pose_y:1.984317045592051,current_pose_yaw:3.1130173206329346 +[2026-10-05 17:29:22.467] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.467] [path_visualizer] [debug] current_cmd_angular_z:0.010101673463444052 +[2026-10-05 17:29:22.517] [path_visualizer] [debug] current_pose_x:0.2951552635754704, current_pose_y:1.9843714098669225,current_pose_yaw:3.1133875846862793 +[2026-10-05 17:29:22.517] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.517] [path_visualizer] [debug] current_cmd_angular_z:0.009700875536761085 +[2026-10-05 17:29:22.566] [path_visualizer] [debug] current_pose_x:0.2951552635754704, current_pose_y:1.9843714098669225,current_pose_yaw:3.1133875846862793 +[2026-10-05 17:29:22.566] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.566] [path_visualizer] [debug] current_cmd_angular_z:0.009700875536761085 +[2026-10-05 17:29:22.616] [path_visualizer] [debug] current_pose_x:0.24460560854958713, current_pose_y:1.9844184944345964,current_pose_yaw:3.113748073577881 +[2026-10-05 17:29:22.616] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.616] [path_visualizer] [debug] current_cmd_angular_z:0.00927413655741506 +[2026-10-05 17:29:22.666] [path_visualizer] [debug] current_pose_x:0.24460560854958713, current_pose_y:1.9844184944345964,current_pose_yaw:3.113748073577881 +[2026-10-05 17:29:22.666] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.666] [path_visualizer] [debug] current_cmd_angular_z:0.00927413655741506 +[2026-10-05 17:29:22.717] [path_visualizer] [debug] current_pose_x:0.24460560854958713, current_pose_y:1.9844184944345964,current_pose_yaw:3.113748073577881 +[2026-10-05 17:29:22.717] [path_visualizer] [debug] current_path_x:0.3417634240749834, current_path_y:1.9918452316930142,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.717] [path_visualizer] [debug] current_cmd_angular_z:0.00927413655741506 +[2026-10-05 17:29:22.766] [path_visualizer] [debug] current_pose_x:0.1940582935835718, current_pose_y:1.9844667096581632,current_pose_yaw:3.114091396331787 +[2026-10-05 17:29:22.766] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.766] [path_visualizer] [debug] current_cmd_angular_z:0.008889022478306252 +[2026-10-05 17:29:22.817] [path_visualizer] [debug] current_pose_x:0.1940582935835718, current_pose_y:1.9844667096581632,current_pose_yaw:3.114091396331787 +[2026-10-05 17:29:22.817] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.817] [path_visualizer] [debug] current_cmd_angular_z:0.008889022478306252 +[2026-10-05 17:29:22.866] [path_visualizer] [debug] current_pose_x:0.14351107595620322, current_pose_y:1.9845106302660607,current_pose_yaw:3.1144232749938965 +[2026-10-05 17:29:22.866] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.866] [path_visualizer] [debug] current_cmd_angular_z:0.00849973281884718 +[2026-10-05 17:29:22.916] [path_visualizer] [debug] current_pose_x:0.14351107595620322, current_pose_y:1.9845106302660607,current_pose_yaw:3.1144232749938965 +[2026-10-05 17:29:22.916] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.916] [path_visualizer] [debug] current_cmd_angular_z:0.00849973281884718 +[2026-10-05 17:29:22.966] [path_visualizer] [debug] current_pose_x:0.14351107595620322, current_pose_y:1.9845106302660607,current_pose_yaw:3.1144232749938965 +[2026-10-05 17:29:22.966] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:22.967] [path_visualizer] [debug] current_cmd_angular_z:0.00849973281884718 +[2026-10-05 17:29:23.016] [path_visualizer] [debug] current_pose_x:0.09296402660098219, current_pose_y:1.9845549747899218,current_pose_yaw:3.1147401332855225 +[2026-10-05 17:29:23.016] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.016] [path_visualizer] [debug] current_cmd_angular_z:0.008143133463037168 +[2026-10-05 17:29:23.066] [path_visualizer] [debug] current_pose_x:0.09296402660098219, current_pose_y:1.9845549747899218,current_pose_yaw:3.1147401332855225 +[2026-10-05 17:29:23.067] [path_visualizer] [debug] current_path_x:0.14647003920277335, current_path_y:1.9918451953740908,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.067] [path_visualizer] [debug] current_cmd_angular_z:0.008143133463037168 +[2026-10-05 17:29:23.116] [path_visualizer] [debug] current_pose_x:0.042417061934161004, current_pose_y:1.9845963548970107,current_pose_yaw:3.1150455474853516 +[2026-10-05 17:29:23.116] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.116] [path_visualizer] [debug] current_cmd_angular_z:0.007791123962446508 +[2026-10-05 17:29:23.166] [path_visualizer] [debug] current_pose_x:0.042417061934161004, current_pose_y:1.9845963548970107,current_pose_yaw:3.1150455474853516 +[2026-10-05 17:29:23.166] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.167] [path_visualizer] [debug] current_cmd_angular_z:0.007791123962446508 +[2026-10-05 17:29:23.216] [path_visualizer] [debug] current_pose_x:0.042417061934161004, current_pose_y:1.9845963548970107,current_pose_yaw:3.1150455474853516 +[2026-10-05 17:29:23.217] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.217] [path_visualizer] [debug] current_cmd_angular_z:0.007791123962446508 +[2026-10-05 17:29:23.267] [path_visualizer] [debug] current_pose_x:-0.008129757794206383, current_pose_y:1.984638429683186,current_pose_yaw:3.1153368949890137 +[2026-10-05 17:29:23.267] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.267] [path_visualizer] [debug] current_cmd_angular_z:0.007471362963464928 +[2026-10-05 17:29:23.316] [path_visualizer] [debug] current_pose_x:-0.008129757794206383, current_pose_y:1.984638429683186,current_pose_yaw:3.1153368949890137 +[2026-10-05 17:29:23.316] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.316] [path_visualizer] [debug] current_cmd_angular_z:0.007471362963464928 +[2026-10-05 17:29:23.366] [path_visualizer] [debug] current_pose_x:-0.008129757794206383, current_pose_y:1.984638429683186,current_pose_yaw:3.1153368949890137 +[2026-10-05 17:29:23.366] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.367] [path_visualizer] [debug] current_cmd_angular_z:0.007471362963464928 +[2026-10-05 17:29:23.416] [path_visualizer] [debug] current_pose_x:-0.0586764827764672, current_pose_y:1.9846787471555598,current_pose_yaw:3.115616798400879 +[2026-10-05 17:29:23.416] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.417] [path_visualizer] [debug] current_cmd_angular_z:0.007163508702674744 +[2026-10-05 17:29:23.466] [path_visualizer] [debug] current_pose_x:-0.0586764827764672, current_pose_y:1.9846787471555598,current_pose_yaw:3.115616798400879 +[2026-10-05 17:29:23.466] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.466] [path_visualizer] [debug] current_cmd_angular_z:0.007163508702674744 +[2026-10-05 17:29:23.516] [path_visualizer] [debug] current_pose_x:-0.10922316408046157, current_pose_y:1.9847146826935234,current_pose_yaw:3.1158883571624756 +[2026-10-05 17:29:23.516] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.517] [path_visualizer] [debug] current_cmd_angular_z:0.006844960404820334 +[2026-10-05 17:29:23.566] [path_visualizer] [debug] current_pose_x:-0.10922316408046157, current_pose_y:1.9847146826935234,current_pose_yaw:3.1158883571624756 +[2026-10-05 17:29:23.566] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.566] [path_visualizer] [debug] current_cmd_angular_z:0.006844960404820334 +[2026-10-05 17:29:23.617] [path_visualizer] [debug] current_pose_x:-0.10922316408046157, current_pose_y:1.9847146826935234,current_pose_yaw:3.1158883571624756 +[2026-10-05 17:29:23.617] [path_visualizer] [debug] current_path_x:-0.0488233456694358, current_path_y:1.9918451590551671,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.617] [path_visualizer] [debug] current_cmd_angular_z:0.006844960404820334 +[2026-10-05 17:29:23.667] [path_visualizer] [debug] current_pose_x:-0.1597697382643189, current_pose_y:1.9847486943416952,current_pose_yaw:3.116149425506592 +[2026-10-05 17:29:23.667] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.667] [path_visualizer] [debug] current_cmd_angular_z:0.006535596854193505 +[2026-10-05 17:29:23.717] [path_visualizer] [debug] current_pose_x:-0.1597697382643189, current_pose_y:1.9847486943416952,current_pose_yaw:3.116149425506592 +[2026-10-05 17:29:23.717] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.717] [path_visualizer] [debug] current_cmd_angular_z:0.006535596854193505 +[2026-10-05 17:29:23.766] [path_visualizer] [debug] current_pose_x:-0.21031620760879255, current_pose_y:1.9847824621551662,current_pose_yaw:3.116399049758911 +[2026-10-05 17:29:23.766] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.766] [path_visualizer] [debug] current_cmd_angular_z:0.006247371491831646 +[2026-10-05 17:29:23.817] [path_visualizer] [debug] current_pose_x:-0.21031620760879255, current_pose_y:1.9847824621551662,current_pose_yaw:3.116399049758911 +[2026-10-05 17:29:23.817] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.817] [path_visualizer] [debug] current_cmd_angular_z:0.006247371491831646 +[2026-10-05 17:29:23.866] [path_visualizer] [debug] current_pose_x:-0.21031620760879255, current_pose_y:1.9847824621551662,current_pose_yaw:3.116399049758911 +[2026-10-05 17:29:23.866] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.866] [path_visualizer] [debug] current_cmd_angular_z:0.006247371491831646 +[2026-10-05 17:29:23.917] [path_visualizer] [debug] current_pose_x:-0.26086310306401617, current_pose_y:1.984816031736508,current_pose_yaw:3.116637945175171 +[2026-10-05 17:29:23.917] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.917] [path_visualizer] [debug] current_cmd_angular_z:0.005979365245917211 +[2026-10-05 17:29:23.966] [path_visualizer] [debug] current_pose_x:-0.26086310306401617, current_pose_y:1.984816031736508,current_pose_yaw:3.116637945175171 +[2026-10-05 17:29:23.966] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:23.966] [path_visualizer] [debug] current_cmd_angular_z:0.005979365245917211 +[2026-10-05 17:29:24.017] [path_visualizer] [debug] current_pose_x:-0.26086310306401617, current_pose_y:1.984816031736508,current_pose_yaw:3.116637945175171 +[2026-10-05 17:29:24.017] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.017] [path_visualizer] [debug] current_cmd_angular_z:0.005979365245917211 +[2026-10-05 17:29:24.067] [path_visualizer] [debug] current_pose_x:-0.3114110349481021, current_pose_y:1.984848314467269,current_pose_yaw:3.1168675422668457 +[2026-10-05 17:29:24.067] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.067] [path_visualizer] [debug] current_cmd_angular_z:0.00572191403570791 +[2026-10-05 17:29:24.116] [path_visualizer] [debug] current_pose_x:-0.3114110349481021, current_pose_y:1.984848314467269,current_pose_yaw:3.1168675422668457 +[2026-10-05 17:29:24.117] [path_visualizer] [debug] current_path_x:-0.24411673054164584, current_path_y:1.9918451227362437,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.117] [path_visualizer] [debug] current_cmd_angular_z:0.00572191403570791 +[2026-10-05 17:29:24.166] [path_visualizer] [debug] current_pose_x:-0.3619573028311631, current_pose_y:1.984877120361307,current_pose_yaw:3.1170897483825684 +[2026-10-05 17:29:24.167] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.167] [path_visualizer] [debug] current_cmd_angular_z:0.005457743810353667 +[2026-10-05 17:29:24.217] [path_visualizer] [debug] current_pose_x:-0.3619573028311631, current_pose_y:1.984877120361307,current_pose_yaw:3.1170897483825684 +[2026-10-05 17:29:24.217] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.217] [path_visualizer] [debug] current_cmd_angular_z:0.005457743810353667 +[2026-10-05 17:29:24.266] [path_visualizer] [debug] current_pose_x:-0.3619573028311631, current_pose_y:1.984877120361307,current_pose_yaw:3.1170897483825684 +[2026-10-05 17:29:24.266] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.266] [path_visualizer] [debug] current_cmd_angular_z:0.005457743810353667 +[2026-10-05 17:29:24.316] [path_visualizer] [debug] current_pose_x:-0.41250398792613124, current_pose_y:1.9849059462375476,current_pose_yaw:3.117302417755127 +[2026-10-05 17:29:24.316] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.316] [path_visualizer] [debug] current_cmd_angular_z:0.00521254565631097 +[2026-10-05 17:29:24.366] [path_visualizer] [debug] current_pose_x:-0.41250398792613124, current_pose_y:1.9849059462375476,current_pose_yaw:3.117302417755127 +[2026-10-05 17:29:24.366] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.366] [path_visualizer] [debug] current_cmd_angular_z:0.00521254565631097 +[2026-10-05 17:29:24.416] [path_visualizer] [debug] current_pose_x:-0.4630522588700427, current_pose_y:1.9849321703153575,current_pose_yaw:3.1175076961517334 +[2026-10-05 17:29:24.416] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.416] [path_visualizer] [debug] current_cmd_angular_z:0.004965870286185142 +[2026-10-05 17:29:24.466] [path_visualizer] [debug] current_pose_x:-0.4630522588700427, current_pose_y:1.9849321703153575,current_pose_yaw:3.1175076961517334 +[2026-10-05 17:29:24.467] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.467] [path_visualizer] [debug] current_cmd_angular_z:0.004965870286185142 +[2026-10-05 17:29:24.516] [path_visualizer] [debug] current_pose_x:-0.4630522588700427, current_pose_y:1.9849321703153575,current_pose_yaw:3.1175076961517334 +[2026-10-05 17:29:24.516] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.516] [path_visualizer] [debug] current_cmd_angular_z:0.004965870286185142 +[2026-10-05 17:29:24.566] [path_visualizer] [debug] current_pose_x:-0.5136009292524729, current_pose_y:1.9849618971362044,current_pose_yaw:3.1177024841308594 +[2026-10-05 17:29:24.566] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.566] [path_visualizer] [debug] current_cmd_angular_z:0.004762065506797426 +[2026-10-05 17:29:24.616] [path_visualizer] [debug] current_pose_x:-0.5136009292524729, current_pose_y:1.9849618971362044,current_pose_yaw:3.1177024841308594 +[2026-10-05 17:29:24.617] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.617] [path_visualizer] [debug] current_cmd_angular_z:0.004762065506797426 +[2026-10-05 17:29:24.667] [path_visualizer] [debug] current_pose_x:-0.5136009292524729, current_pose_y:1.9849618971362044,current_pose_yaw:3.1177024841308594 +[2026-10-05 17:29:24.667] [path_visualizer] [debug] current_path_x:-0.4394101154138559, current_path_y:1.9918450864173203,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.667] [path_visualizer] [debug] current_cmd_angular_z:0.004762065506797426 +[2026-10-05 17:29:24.716] [path_visualizer] [debug] current_pose_x:-0.5641567807190915, current_pose_y:1.984992440088587,current_pose_yaw:3.117891311645508 +[2026-10-05 17:29:24.716] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.716] [path_visualizer] [debug] current_cmd_angular_z:0.004575508545892698 +[2026-10-05 17:29:24.767] [path_visualizer] [debug] current_pose_x:-0.5641567807190915, current_pose_y:1.984992440088587,current_pose_yaw:3.117891311645508 +[2026-10-05 17:29:24.767] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.767] [path_visualizer] [debug] current_cmd_angular_z:0.004575508545892698 +[2026-10-05 17:29:24.816] [path_visualizer] [debug] current_pose_x:-0.614715106655984, current_pose_y:1.9850186746395617,current_pose_yaw:3.1180763244628906 +[2026-10-05 17:29:24.816] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.816] [path_visualizer] [debug] current_cmd_angular_z:0.00436943026059293 +[2026-10-05 17:29:24.866] [path_visualizer] [debug] current_pose_x:-0.614715106655984, current_pose_y:1.9850186746395617,current_pose_yaw:3.1180763244628906 +[2026-10-05 17:29:24.866] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.866] [path_visualizer] [debug] current_cmd_angular_z:0.00436943026059293 +[2026-10-05 17:29:24.917] [path_visualizer] [debug] current_pose_x:-0.614715106655984, current_pose_y:1.9850186746395617,current_pose_yaw:3.1180763244628906 +[2026-10-05 17:29:24.917] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.917] [path_visualizer] [debug] current_cmd_angular_z:0.00436943026059293 +[2026-10-05 17:29:24.966] [path_visualizer] [debug] current_pose_x:-0.6652708460727809, current_pose_y:1.98504413173816,current_pose_yaw:3.118253707885742 +[2026-10-05 17:29:24.966] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:24.966] [path_visualizer] [debug] current_cmd_angular_z:0.004173752378911107 +[2026-10-05 17:29:25.016] [path_visualizer] [debug] current_pose_x:-0.6652708460727809, current_pose_y:1.98504413173816,current_pose_yaw:3.118253707885742 +[2026-10-05 17:29:25.017] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.017] [path_visualizer] [debug] current_cmd_angular_z:0.004173752378911107 +[2026-10-05 17:29:25.066] [path_visualizer] [debug] current_pose_x:-0.7158263070850654, current_pose_y:1.9850672509984446,current_pose_yaw:3.118424892425537 +[2026-10-05 17:29:25.066] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.066] [path_visualizer] [debug] current_cmd_angular_z:0.003975862546353959 +[2026-10-05 17:29:25.117] [path_visualizer] [debug] current_pose_x:-0.7158263070850654, current_pose_y:1.9850672509984446,current_pose_yaw:3.118424892425537 +[2026-10-05 17:29:25.117] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.117] [path_visualizer] [debug] current_cmd_angular_z:0.003975862546353959 +[2026-10-05 17:29:25.166] [path_visualizer] [debug] current_pose_x:-0.7158263070850654, current_pose_y:1.9850672509984446,current_pose_yaw:3.118424892425537 +[2026-10-05 17:29:25.166] [path_visualizer] [debug] current_path_x:-0.6347035002860641, current_path_y:1.9918450500983966,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.166] [path_visualizer] [debug] current_cmd_angular_z:0.003975862546353959 +[2026-10-05 17:29:25.217] [path_visualizer] [debug] current_pose_x:-0.7663820320166917, current_pose_y:1.985092071223343,current_pose_yaw:3.1185872554779053 +[2026-10-05 17:29:25.217] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.217] [path_visualizer] [debug] current_cmd_angular_z:0.003806472111616166 +[2026-10-05 17:29:25.266] [path_visualizer] [debug] current_pose_x:-0.7663820320166917, current_pose_y:1.985092071223343,current_pose_yaw:3.1185872554779053 +[2026-10-05 17:29:25.266] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.266] [path_visualizer] [debug] current_cmd_angular_z:0.003806472111616166 +[2026-10-05 17:29:25.317] [path_visualizer] [debug] current_pose_x:-0.7663820320166917, current_pose_y:1.985092071223343,current_pose_yaw:3.1185872554779053 +[2026-10-05 17:29:25.317] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.317] [path_visualizer] [debug] current_cmd_angular_z:0.003806472111616166 +[2026-10-05 17:29:25.366] [path_visualizer] [debug] current_pose_x:-0.8169386959373586, current_pose_y:1.9851153318302217,current_pose_yaw:3.118743658065796 +[2026-10-05 17:29:25.366] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.366] [path_visualizer] [debug] current_cmd_angular_z:0.0036390297303644653 +[2026-10-05 17:29:25.416] [path_visualizer] [debug] current_pose_x:-0.8169386959373586, current_pose_y:1.9851153318302217,current_pose_yaw:3.118743658065796 +[2026-10-05 17:29:25.416] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.416] [path_visualizer] [debug] current_cmd_angular_z:0.0036390297303644653 +[2026-10-05 17:29:25.466] [path_visualizer] [debug] current_pose_x:-0.8674935816577667, current_pose_y:1.9851357226167403,current_pose_yaw:3.1188957691192627 +[2026-10-05 17:29:25.466] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.466] [path_visualizer] [debug] current_cmd_angular_z:0.003462236121928551 +[2026-10-05 17:29:25.517] [path_visualizer] [debug] current_pose_x:-0.8674935816577667, current_pose_y:1.9851357226167403,current_pose_yaw:3.1188957691192627 +[2026-10-05 17:29:25.517] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.517] [path_visualizer] [debug] current_cmd_angular_z:0.003462236121928551 +[2026-10-05 17:29:25.567] [path_visualizer] [debug] current_pose_x:-0.8674935816577667, current_pose_y:1.9851357226167403,current_pose_yaw:3.1188957691192627 +[2026-10-05 17:29:25.567] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.567] [path_visualizer] [debug] current_cmd_angular_z:0.003462236121928551 +[2026-10-05 17:29:25.616] [path_visualizer] [debug] current_pose_x:-0.9180498772639072, current_pose_y:1.9851566573804016,current_pose_yaw:3.1190407276153564 +[2026-10-05 17:29:25.616] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.616] [path_visualizer] [debug] current_cmd_angular_z:0.003303147199195708 +[2026-10-05 17:29:25.666] [path_visualizer] [debug] current_pose_x:-0.9180498772639072, current_pose_y:1.9851566573804016,current_pose_yaw:3.1190407276153564 +[2026-10-05 17:29:25.666] [path_visualizer] [debug] current_path_x:-0.8299968851582742, current_path_y:1.9918450137794732,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.666] [path_visualizer] [debug] current_cmd_angular_z:0.003303147199195708 +[2026-10-05 17:29:25.717] [path_visualizer] [debug] current_pose_x:-0.968604419420778, current_pose_y:1.9851753190036991,current_pose_yaw:3.1191811561584473 +[2026-10-05 17:29:25.717] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.717] [path_visualizer] [debug] current_cmd_angular_z:0.0031391391548914183 +[2026-10-05 17:29:25.766] [path_visualizer] [debug] current_pose_x:-0.968604419420778, current_pose_y:1.9851753190036991,current_pose_yaw:3.1191811561584473 +[2026-10-05 17:29:25.766] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.767] [path_visualizer] [debug] current_cmd_angular_z:0.0031391391548914183 +[2026-10-05 17:29:25.816] [path_visualizer] [debug] current_pose_x:-0.968604419420778, current_pose_y:1.9851753190036991,current_pose_yaw:3.1191811561584473 +[2026-10-05 17:29:25.816] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.816] [path_visualizer] [debug] current_cmd_angular_z:0.0031391391548914183 +[2026-10-05 17:29:25.866] [path_visualizer] [debug] current_pose_x:-1.0191587860511486, current_pose_y:1.985193469894825,current_pose_yaw:3.1193156242370605 +[2026-10-05 17:29:25.866] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.866] [path_visualizer] [debug] current_cmd_angular_z:0.0029836339112163032 +[2026-10-05 17:29:25.916] [path_visualizer] [debug] current_pose_x:-1.0191587860511486, current_pose_y:1.985193469894825,current_pose_yaw:3.1193156242370605 +[2026-10-05 17:29:25.916] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.916] [path_visualizer] [debug] current_cmd_angular_z:0.0029836339112163032 +[2026-10-05 17:29:25.967] [path_visualizer] [debug] current_pose_x:-1.0191587860511486, current_pose_y:1.985193469894825,current_pose_yaw:3.1193156242370605 +[2026-10-05 17:29:25.967] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:25.967] [path_visualizer] [debug] current_cmd_angular_z:0.0029836339112163032 +[2026-10-05 17:29:26.016] [path_visualizer] [debug] current_pose_x:-1.069712980096106, current_pose_y:1.9852125590661567,current_pose_yaw:3.119443655014038 +[2026-10-05 17:29:26.016] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.016] [path_visualizer] [debug] current_cmd_angular_z:0.0028468669591467932 +[2026-10-05 17:29:26.066] [path_visualizer] [debug] current_pose_x:-1.069712980096106, current_pose_y:1.9852125590661567,current_pose_yaw:3.119443655014038 +[2026-10-05 17:29:26.066] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.066] [path_visualizer] [debug] current_cmd_angular_z:0.0028468669591467932 +[2026-10-05 17:29:26.116] [path_visualizer] [debug] current_pose_x:-1.1202670400216113, current_pose_y:1.985228598427497,current_pose_yaw:3.119568347930908 +[2026-10-05 17:29:26.116] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.117] [path_visualizer] [debug] current_cmd_angular_z:0.0026977165246300644 +[2026-10-05 17:29:26.166] [path_visualizer] [debug] current_pose_x:-1.1202670400216113, current_pose_y:1.985228598427497,current_pose_yaw:3.119568347930908 +[2026-10-05 17:29:26.166] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.166] [path_visualizer] [debug] current_cmd_angular_z:0.0026977165246300644 +[2026-10-05 17:29:26.216] [path_visualizer] [debug] current_pose_x:-1.1202670400216113, current_pose_y:1.985228598427497,current_pose_yaw:3.119568347930908 +[2026-10-05 17:29:26.217] [path_visualizer] [debug] current_path_x:-1.0252902700304842, current_path_y:1.9918449774605496,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.217] [path_visualizer] [debug] current_cmd_angular_z:0.0026977165246300644 +[2026-10-05 17:29:26.266] [path_visualizer] [debug] current_pose_x:-1.1708225090973627, current_pose_y:1.9852465454461163,current_pose_yaw:3.1196861267089844 +[2026-10-05 17:29:26.266] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.266] [path_visualizer] [debug] current_cmd_angular_z:0.0025745424785407825 +[2026-10-05 17:29:26.317] [path_visualizer] [debug] current_pose_x:-1.1708225090973627, current_pose_y:1.9852465454461163,current_pose_yaw:3.1196861267089844 +[2026-10-05 17:29:26.317] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.317] [path_visualizer] [debug] current_cmd_angular_z:0.0025745424785407825 +[2026-10-05 17:29:26.366] [path_visualizer] [debug] current_pose_x:-1.2213762225650993, current_pose_y:1.985263590992756,current_pose_yaw:3.1197993755340576 +[2026-10-05 17:29:26.366] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.366] [path_visualizer] [debug] current_cmd_angular_z:0.002454568330709221 +[2026-10-05 17:29:26.416] [path_visualizer] [debug] current_pose_x:-1.2213762225650993, current_pose_y:1.985263590992756,current_pose_yaw:3.1197993755340576 +[2026-10-05 17:29:26.416] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.416] [path_visualizer] [debug] current_cmd_angular_z:0.002454568330709221 +[2026-10-05 17:29:26.466] [path_visualizer] [debug] current_pose_x:-1.2213762225650993, current_pose_y:1.985263590992756,current_pose_yaw:3.1197993755340576 +[2026-10-05 17:29:26.466] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.466] [path_visualizer] [debug] current_cmd_angular_z:0.002454568330709221 +[2026-10-05 17:29:26.517] [path_visualizer] [debug] current_pose_x:-1.271929773252448, current_pose_y:1.9852804365162944,current_pose_yaw:3.119907855987549 +[2026-10-05 17:29:26.517] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.517] [path_visualizer] [debug] current_cmd_angular_z:0.0023428809715073384 +[2026-10-05 17:29:26.566] [path_visualizer] [debug] current_pose_x:-1.271929773252448, current_pose_y:1.9852804365162944,current_pose_yaw:3.119907855987549 +[2026-10-05 17:29:26.566] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.566] [path_visualizer] [debug] current_cmd_angular_z:0.0023428809715073384 +[2026-10-05 17:29:26.616] [path_visualizer] [debug] current_pose_x:-1.271929773252448, current_pose_y:1.9852804365162944,current_pose_yaw:3.119907855987549 +[2026-10-05 17:29:26.616] [path_visualizer] [debug] current_path_x:-1.2205836549026934, current_path_y:1.9918449411416261,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.617] [path_visualizer] [debug] current_cmd_angular_z:0.0023428809715073384 +[2026-10-05 17:29:26.666] [path_visualizer] [debug] current_pose_x:-1.3224831727814652, current_pose_y:1.9852962693505511,current_pose_yaw:3.1200122833251953 +[2026-10-05 17:29:26.666] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.666] [path_visualizer] [debug] current_cmd_angular_z:0.002233197724197819 +[2026-10-05 17:29:26.716] [path_visualizer] [debug] current_pose_x:-1.3224831727814652, current_pose_y:1.9852962693505511,current_pose_yaw:3.1200122833251953 +[2026-10-05 17:29:26.716] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.716] [path_visualizer] [debug] current_cmd_angular_z:0.002233197724197819 +[2026-10-05 17:29:26.766] [path_visualizer] [debug] current_pose_x:-1.3730529206247544, current_pose_y:1.9852929219875983,current_pose_yaw:3.1201114654541016 +[2026-10-05 17:29:26.767] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.767] [path_visualizer] [debug] current_cmd_angular_z:0.0020139147688627776 +[2026-10-05 17:29:26.816] [path_visualizer] [debug] current_pose_x:-1.3730529206247544, current_pose_y:1.9852929219875983,current_pose_yaw:3.1201114654541016 +[2026-10-05 17:29:26.816] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.816] [path_visualizer] [debug] current_cmd_angular_z:0.0020139147688627776 +[2026-10-05 17:29:26.866] [path_visualizer] [debug] current_pose_x:-1.3730529206247544, current_pose_y:1.9852929219875983,current_pose_yaw:3.1201114654541016 +[2026-10-05 17:29:26.866] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.866] [path_visualizer] [debug] current_cmd_angular_z:0.0020139147688627776 +[2026-10-05 17:29:26.916] [path_visualizer] [debug] current_pose_x:-1.4236181080433132, current_pose_y:1.9852900967275111,current_pose_yaw:3.1202046871185303 +[2026-10-05 17:29:26.916] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.916] [path_visualizer] [debug] current_cmd_angular_z:0.0018098155453382253 +[2026-10-05 17:29:26.966] [path_visualizer] [debug] current_pose_x:-1.4236181080433132, current_pose_y:1.9852900967275111,current_pose_yaw:3.1202046871185303 +[2026-10-05 17:29:26.967] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:26.967] [path_visualizer] [debug] current_cmd_angular_z:0.0018098155453382253 +[2026-10-05 17:29:27.016] [path_visualizer] [debug] current_pose_x:-1.4741824279337188, current_pose_y:1.9852894129758825,current_pose_yaw:3.1202921867370605 +[2026-10-05 17:29:27.016] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.016] [path_visualizer] [debug] current_cmd_angular_z:0.0016305434384899647 +[2026-10-05 17:29:27.066] [path_visualizer] [debug] current_pose_x:-1.4741824279337188, current_pose_y:1.9852894129758825,current_pose_yaw:3.1202921867370605 +[2026-10-05 17:29:27.067] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.067] [path_visualizer] [debug] current_cmd_angular_z:0.0016305434384899647 +[2026-10-05 17:29:27.116] [path_visualizer] [debug] current_pose_x:-1.4741824279337188, current_pose_y:1.9852894129758825,current_pose_yaw:3.1202921867370605 +[2026-10-05 17:29:27.116] [path_visualizer] [debug] current_path_x:-1.4158770397749034, current_path_y:1.9918449048227025,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.116] [path_visualizer] [debug] current_cmd_angular_z:0.0016305434384899647 +[2026-10-05 17:29:27.166] [path_visualizer] [debug] current_pose_x:-1.5247389718609137, current_pose_y:1.985301686014528,current_pose_yaw:3.1203718185424805 +[2026-10-05 17:29:27.166] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.167] [path_visualizer] [debug] current_cmd_angular_z:0.0015482048856916217 +[2026-10-05 17:29:27.216] [path_visualizer] [debug] current_pose_x:-1.5247389718609137, current_pose_y:1.985301686014528,current_pose_yaw:3.1203718185424805 +[2026-10-05 17:29:27.216] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.216] [path_visualizer] [debug] current_cmd_angular_z:0.0015482048856916217 +[2026-10-05 17:29:27.266] [path_visualizer] [debug] current_pose_x:-1.5247389718609137, current_pose_y:1.985301686014528,current_pose_yaw:3.1203718185424805 +[2026-10-05 17:29:27.266] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.266] [path_visualizer] [debug] current_cmd_angular_z:0.0015482048856916217 +[2026-10-05 17:29:27.316] [path_visualizer] [debug] current_pose_x:-1.5752856796092778, current_pose_y:1.9853248734198319,current_pose_yaw:3.1204450130462646 +[2026-10-05 17:29:27.316] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.316] [path_visualizer] [debug] current_cmd_angular_z:0.0015467221982132726 +[2026-10-05 17:29:27.366] [path_visualizer] [debug] current_pose_x:-1.5752856796092778, current_pose_y:1.9853248734198319,current_pose_yaw:3.1204450130462646 +[2026-10-05 17:29:27.366] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.366] [path_visualizer] [debug] current_cmd_angular_z:0.0015467221982132726 +[2026-10-05 17:29:27.416] [path_visualizer] [debug] current_pose_x:-1.6258329142710475, current_pose_y:1.985347193509551,current_pose_yaw:3.1205153465270996 +[2026-10-05 17:29:27.416] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.417] [path_visualizer] [debug] current_cmd_angular_z:0.0015455414998004416 +[2026-10-05 17:29:27.466] [path_visualizer] [debug] current_pose_x:-1.6258329142710475, current_pose_y:1.985347193509551,current_pose_yaw:3.1205153465270996 +[2026-10-05 17:29:27.466] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.466] [path_visualizer] [debug] current_cmd_angular_z:0.0015455414998004416 +[2026-10-05 17:29:27.516] [path_visualizer] [debug] current_pose_x:-1.6258329142710475, current_pose_y:1.985347193509551,current_pose_yaw:3.1205153465270996 +[2026-10-05 17:29:27.516] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.516] [path_visualizer] [debug] current_cmd_angular_z:0.0015455414998004416 +[2026-10-05 17:29:27.566] [path_visualizer] [debug] current_pose_x:-1.6763799077679515, current_pose_y:1.9853668599307095,current_pose_yaw:3.120586395263672 +[2026-10-05 17:29:27.566] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.566] [path_visualizer] [debug] current_cmd_angular_z:0.0015263466585258081 +[2026-10-05 17:29:27.616] [path_visualizer] [debug] current_pose_x:-1.6763799077679515, current_pose_y:1.9853668599307095,current_pose_yaw:3.120586395263672 +[2026-10-05 17:29:27.616] [path_visualizer] [debug] current_path_x:-1.6111704246471126, current_path_y:1.991844868503779,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.616] [path_visualizer] [debug] current_cmd_angular_z:0.0015263466585258081 +[2026-10-05 17:29:27.666] [path_visualizer] [debug] current_pose_x:-1.7269249120151757, current_pose_y:1.985388755244821,current_pose_yaw:3.1206607818603516 +[2026-10-05 17:29:27.666] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.667] [path_visualizer] [debug] current_cmd_angular_z:0.0015146318060308694 +[2026-10-05 17:29:27.716] [path_visualizer] [debug] current_pose_x:-1.7269249120151757, current_pose_y:1.985388755244821,current_pose_yaw:3.1206607818603516 +[2026-10-05 17:29:27.716] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.716] [path_visualizer] [debug] current_cmd_angular_z:0.0015146318060308694 +[2026-10-05 17:29:27.766] [path_visualizer] [debug] current_pose_x:-1.7269249120151757, current_pose_y:1.985388755244821,current_pose_yaw:3.1206607818603516 +[2026-10-05 17:29:27.766] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.767] [path_visualizer] [debug] current_cmd_angular_z:0.0015146318060308694 +[2026-10-05 17:29:27.816] [path_visualizer] [debug] current_pose_x:-1.7774701892904219, current_pose_y:1.985407362268951,current_pose_yaw:3.1207356452941895 +[2026-10-05 17:29:27.816] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.817] [path_visualizer] [debug] current_cmd_angular_z:0.001481187169936088 +[2026-10-05 17:29:27.866] [path_visualizer] [debug] current_pose_x:-1.7774701892904219, current_pose_y:1.985407362268951,current_pose_yaw:3.1207356452941895 +[2026-10-05 17:29:27.866] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.866] [path_visualizer] [debug] current_cmd_angular_z:0.001481187169936088 +[2026-10-05 17:29:27.916] [path_visualizer] [debug] current_pose_x:-1.828016399606274, current_pose_y:1.9854225618778618,current_pose_yaw:3.120810031890869 +[2026-10-05 17:29:27.916] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.916] [path_visualizer] [debug] current_cmd_angular_z:0.001427402074172586 +[2026-10-05 17:29:27.966] [path_visualizer] [debug] current_pose_x:-1.828016399606274, current_pose_y:1.9854225618778618,current_pose_yaw:3.120810031890869 +[2026-10-05 17:29:27.966] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:27.967] [path_visualizer] [debug] current_cmd_angular_z:0.001427402074172586 +[2026-10-05 17:29:28.016] [path_visualizer] [debug] current_pose_x:-1.828016399606274, current_pose_y:1.9854225618778618,current_pose_yaw:3.120810031890869 +[2026-10-05 17:29:28.016] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.016] [path_visualizer] [debug] current_cmd_angular_z:0.001427402074172586 +[2026-10-05 17:29:28.066] [path_visualizer] [debug] current_pose_x:-1.878564017600198, current_pose_y:1.9854361874060271,current_pose_yaw:3.120882272720337 +[2026-10-05 17:29:28.066] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.067] [path_visualizer] [debug] current_cmd_angular_z:0.0013680715395665288 +[2026-10-05 17:29:28.116] [path_visualizer] [debug] current_pose_x:-1.878564017600198, current_pose_y:1.9854361874060271,current_pose_yaw:3.120882272720337 +[2026-10-05 17:29:28.116] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.116] [path_visualizer] [debug] current_cmd_angular_z:0.0013680715395665288 +[2026-10-05 17:29:28.166] [path_visualizer] [debug] current_pose_x:-1.878564017600198, current_pose_y:1.9854361874060271,current_pose_yaw:3.120882272720337 +[2026-10-05 17:29:28.167] [path_visualizer] [debug] current_path_x:-1.8064638095193217, current_path_y:1.9918448321848554,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.167] [path_visualizer] [debug] current_cmd_angular_z:0.0013680715395665288 +[2026-10-05 17:29:28.216] [path_visualizer] [debug] current_pose_x:-1.9291107913665797, current_pose_y:1.985448411151802,current_pose_yaw:3.120952606201172 +[2026-10-05 17:29:28.216] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.216] [path_visualizer] [debug] current_cmd_angular_z:0.001304021943399597 +[2026-10-05 17:29:28.266] [path_visualizer] [debug] current_pose_x:-1.9291107913665797, current_pose_y:1.985448411151802,current_pose_yaw:3.120952606201172 +[2026-10-05 17:29:28.266] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.266] [path_visualizer] [debug] current_cmd_angular_z:0.001304021943399597 +[2026-10-05 17:29:28.316] [path_visualizer] [debug] current_pose_x:-1.979659439791588, current_pose_y:1.985458843315587,current_pose_yaw:3.121021270751953 +[2026-10-05 17:29:28.316] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.316] [path_visualizer] [debug] current_cmd_angular_z:0.0012318874936033397 +[2026-10-05 17:29:28.367] [path_visualizer] [debug] current_pose_x:-1.979659439791588, current_pose_y:1.985458843315587,current_pose_yaw:3.121021270751953 +[2026-10-05 17:29:28.367] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.367] [path_visualizer] [debug] current_cmd_angular_z:0.0012318874936033397 +[2026-10-05 17:29:28.416] [path_visualizer] [debug] current_pose_x:-1.979659439791588, current_pose_y:1.985458843315587,current_pose_yaw:3.121021270751953 +[2026-10-05 17:29:28.416] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.416] [path_visualizer] [debug] current_cmd_angular_z:0.0012318874936033397 +[2026-10-05 17:29:28.466] [path_visualizer] [debug] current_pose_x:-2.0302061920583307, current_pose_y:1.9854691536344253,current_pose_yaw:3.121087074279785 +[2026-10-05 17:29:28.466] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.466] [path_visualizer] [debug] current_cmd_angular_z:0.0011647136555538243 +[2026-10-05 17:29:28.516] [path_visualizer] [debug] current_pose_x:-2.0302061920583307, current_pose_y:1.9854691536344253,current_pose_yaw:3.121087074279785 +[2026-10-05 17:29:28.516] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.516] [path_visualizer] [debug] current_cmd_angular_z:0.0011647136555538243 +[2026-10-05 17:29:28.566] [path_visualizer] [debug] current_pose_x:-2.0302061920583307, current_pose_y:1.9854691536344253,current_pose_yaw:3.121087074279785 +[2026-10-05 17:29:28.566] [path_visualizer] [debug] current_path_x:-2.0017571943915318, current_path_y:1.991844795865932,current_path_yaw:-3.141592653179586 +[2026-10-05 17:29:28.567] [path_visualizer] [debug] current_cmd_angular_z:0.0011647136555538243 +[2026-10-05 17:29:28.616] [path_visualizer] [debug] current_pose_x:-2.0807531630665466, current_pose_y:1.9854795539452494,current_pose_yaw:3.121149778366089 +[2026-10-05 17:29:28.616] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.616] [path_visualizer] [debug] current_cmd_angular_z:-0.324253829880783 +[2026-10-05 17:29:28.666] [path_visualizer] [debug] current_pose_x:-2.0807531630665466, current_pose_y:1.9854795539452494,current_pose_yaw:3.121149778366089 +[2026-10-05 17:29:28.666] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.666] [path_visualizer] [debug] current_cmd_angular_z:-0.324253829880783 +[2026-10-05 17:29:28.716] [path_visualizer] [debug] current_pose_x:-2.131300387782176, current_pose_y:1.9854869286378685,current_pose_yaw:3.1212124824523926 +[2026-10-05 17:29:28.716] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.717] [path_visualizer] [debug] current_cmd_angular_z:-0.36552951422462404 +[2026-10-05 17:29:28.766] [path_visualizer] [debug] current_pose_x:-2.131300387782176, current_pose_y:1.9854869286378685,current_pose_yaw:3.1212124824523926 +[2026-10-05 17:29:28.766] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.766] [path_visualizer] [debug] current_cmd_angular_z:-0.36552951422462404 +[2026-10-05 17:29:28.816] [path_visualizer] [debug] current_pose_x:-2.131300387782176, current_pose_y:1.9854869286378685,current_pose_yaw:3.1212124824523926 +[2026-10-05 17:29:28.817] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.817] [path_visualizer] [debug] current_cmd_angular_z:-0.36552951422462404 +[2026-10-05 17:29:28.866] [path_visualizer] [debug] current_pose_x:-2.181785755720532, current_pose_y:1.9918355523212878,current_pose_yaw:3.1156415939331055 +[2026-10-05 17:29:28.866] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.866] [path_visualizer] [debug] current_cmd_angular_z:-0.35623125182025683 +[2026-10-05 17:29:28.916] [path_visualizer] [debug] current_pose_x:-2.181785755720532, current_pose_y:1.9918355523212878,current_pose_yaw:3.1156415939331055 +[2026-10-05 17:29:28.916] [path_visualizer] [debug] current_path_x:-2.1312803952008412, current_path_y:2.0088124074589726,current_path_yaw:3.01069296 +[2026-10-05 17:29:28.916] [path_visualizer] [debug] current_cmd_angular_z:-0.35623125182025683 +[2026-10-05 17:29:28.966] [path_visualizer] [debug] current_pose_x:-2.232107390745661, current_pose_y:2.0058055531364785,current_pose_yaw:3.1036338806152344 +[2026-10-05 17:29:28.966] [path_visualizer] [debug] current_path_x:-2.2608035960101502, current_path_y:2.025780019052013,current_path_yaw:2.879793266 +[2026-10-05 17:29:28.966] [path_visualizer] [debug] current_cmd_angular_z:-0.5218397818670428 +[2026-10-05 17:29:29.016] [path_visualizer] [debug] current_pose_x:-2.232107390745661, current_pose_y:2.0058055531364785,current_pose_yaw:3.1036338806152344 +[2026-10-05 17:29:29.016] [path_visualizer] [debug] current_path_x:-2.2608035960101502, current_path_y:2.025780019052013,current_path_yaw:2.879793266 +[2026-10-05 17:29:29.016] [path_visualizer] [debug] current_cmd_angular_z:-0.5218397818670428 +[2026-10-05 17:29:29.066] [path_visualizer] [debug] current_pose_x:-2.232107390745661, current_pose_y:2.0058055531364785,current_pose_yaw:3.1036338806152344 +[2026-10-05 17:29:29.066] [path_visualizer] [debug] current_path_x:-2.2608035960101502, current_path_y:2.025780019052013,current_path_yaw:2.879793266 +[2026-10-05 17:29:29.066] [path_visualizer] [debug] current_cmd_angular_z:-0.5218397818670428 +[2026-10-05 17:29:29.116] [path_visualizer] [debug] current_pose_x:-2.2822685513921095, current_pose_y:2.0209810998401445,current_pose_yaw:3.0911097526550293 +[2026-10-05 17:29:29.116] [path_visualizer] [debug] current_path_x:-2.2608035960101502, current_path_y:2.025780019052013,current_path_yaw:2.879793266 +[2026-10-05 17:29:29.116] [path_visualizer] [debug] current_cmd_angular_z:-0.4863209612676428 +[2026-10-05 17:29:29.166] [path_visualizer] [debug] current_pose_x:-2.2822685513921095, current_pose_y:2.0209810998401445,current_pose_yaw:3.0911097526550293 +[2026-10-05 17:29:29.166] [path_visualizer] [debug] current_path_x:-2.2608035960101502, current_path_y:2.025780019052013,current_path_yaw:2.879793266 +[2026-10-05 17:29:29.166] [path_visualizer] [debug] current_cmd_angular_z:-0.4863209612676428 +[2026-10-05 17:29:29.217] [path_visualizer] [debug] current_pose_x:-2.331974523064212, current_pose_y:2.042165225542796,current_pose_yaw:3.0738425254821777 +[2026-10-05 17:29:29.217] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.217] [path_visualizer] [debug] current_cmd_angular_z:-0.7240724897794147 +[2026-10-05 17:29:29.267] [path_visualizer] [debug] current_pose_x:-2.331974523064212, current_pose_y:2.042165225542796,current_pose_yaw:3.0738425254821777 +[2026-10-05 17:29:29.267] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.267] [path_visualizer] [debug] current_cmd_angular_z:-0.7240724897794147 +[2026-10-05 17:29:29.316] [path_visualizer] [debug] current_pose_x:-2.331974523064212, current_pose_y:2.042165225542796,current_pose_yaw:3.0738425254821777 +[2026-10-05 17:29:29.316] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.316] [path_visualizer] [debug] current_cmd_angular_z:-0.7240724897794147 +[2026-10-05 17:29:29.366] [path_visualizer] [debug] current_pose_x:-2.3813623306535106, current_pose_y:2.063802954356942,current_pose_yaw:3.0569403171539307 +[2026-10-05 17:29:29.366] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.366] [path_visualizer] [debug] current_cmd_angular_z:-0.6834529641983742 +[2026-10-05 17:29:29.416] [path_visualizer] [debug] current_pose_x:-2.3813623306535106, current_pose_y:2.063802954356942,current_pose_yaw:3.0569403171539307 +[2026-10-05 17:29:29.416] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.416] [path_visualizer] [debug] current_cmd_angular_z:-0.6834529641983742 +[2026-10-05 17:29:29.467] [path_visualizer] [debug] current_pose_x:-2.3813623306535106, current_pose_y:2.063802954356942,current_pose_yaw:3.0569403171539307 +[2026-10-05 17:29:29.467] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.467] [path_visualizer] [debug] current_cmd_angular_z:-0.6834529641983742 +[2026-10-05 17:29:29.516] [path_visualizer] [debug] current_pose_x:-2.429778380679969, current_pose_y:2.092942331692417,current_pose_yaw:3.0341267585754395 +[2026-10-05 17:29:29.516] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.516] [path_visualizer] [debug] current_cmd_angular_z:-0.5853743078380783 +[2026-10-05 17:29:29.566] [path_visualizer] [debug] current_pose_x:-2.429778380679969, current_pose_y:2.092942331692417,current_pose_yaw:3.0341267585754395 +[2026-10-05 17:29:29.566] [path_visualizer] [debug] current_path_x:-2.381500016989178, current_path_y:2.075526587799156,current_path_yaw:2.748893572 +[2026-10-05 17:29:29.566] [path_visualizer] [debug] current_cmd_angular_z:-0.5853743078380783 +[2026-10-05 17:29:29.616] [path_visualizer] [debug] current_pose_x:-2.477511906069947, current_pose_y:2.123361479594655,current_pose_yaw:3.0111536979675293 +[2026-10-05 17:29:29.616] [path_visualizer] [debug] current_path_x:-2.5021964379682053, current_path_y:2.1252731565462994,current_path_yaw:2.617993878 +[2026-10-05 17:29:29.616] [path_visualizer] [debug] current_cmd_angular_z:-0.7195339394345223 +[2026-10-05 17:29:29.666] [path_visualizer] [debug] current_pose_x:-2.477511906069947, current_pose_y:2.123361479594655,current_pose_yaw:3.0111536979675293 +[2026-10-05 17:29:29.666] [path_visualizer] [debug] current_path_x:-2.5021964379682053, current_path_y:2.1252731565462994,current_path_yaw:2.617993878 +[2026-10-05 17:29:29.666] [path_visualizer] [debug] current_cmd_angular_z:-0.7195339394345223 +[2026-10-05 17:29:29.716] [path_visualizer] [debug] current_pose_x:-2.477511906069947, current_pose_y:2.123361479594655,current_pose_yaw:3.0111536979675293 +[2026-10-05 17:29:29.717] [path_visualizer] [debug] current_path_x:-2.5021964379682053, current_path_y:2.1252731565462994,current_path_yaw:2.617993878 +[2026-10-05 17:29:29.717] [path_visualizer] [debug] current_cmd_angular_z:-0.7195339394345223 +[2026-10-05 17:29:29.766] [path_visualizer] [debug] current_pose_x:-2.5249292048307983, current_pose_y:2.1520830072507753,current_pose_yaw:2.990654945373535 +[2026-10-05 17:29:29.766] [path_visualizer] [debug] current_path_x:-2.5021964379682053, current_path_y:2.1252731565462994,current_path_yaw:2.617993878 +[2026-10-05 17:29:29.766] [path_visualizer] [debug] current_cmd_angular_z:-0.6712579228781834 +[2026-10-05 17:29:29.816] [path_visualizer] [debug] current_pose_x:-2.5249292048307983, current_pose_y:2.1520830072507753,current_pose_yaw:2.990654945373535 +[2026-10-05 17:29:29.816] [path_visualizer] [debug] current_path_x:-2.5021964379682053, current_path_y:2.1252731565462994,current_path_yaw:2.617993878 +[2026-10-05 17:29:29.816] [path_visualizer] [debug] current_cmd_angular_z:-0.6712579228781834 +[2026-10-05 17:29:29.866] [path_visualizer] [debug] current_pose_x:-2.5711956677319767, current_pose_y:2.1854219353324127,current_pose_yaw:2.9668712615966797 +[2026-10-05 17:29:29.866] [path_visualizer] [debug] current_path_x:-2.605840791925444, current_path_y:2.204408465434311,current_path_yaw:2.487094184 +[2026-10-05 17:29:29.866] [path_visualizer] [debug] current_cmd_angular_z:-0.9218828424981842 +[2026-10-05 17:29:29.916] [path_visualizer] [debug] current_pose_x:-2.5711956677319767, current_pose_y:2.1854219353324127,current_pose_yaw:2.9668712615966797 +[2026-10-05 17:29:29.916] [path_visualizer] [debug] current_path_x:-2.605840791925444, current_path_y:2.204408465434311,current_path_yaw:2.487094184 +[2026-10-05 17:29:29.917] [path_visualizer] [debug] current_cmd_angular_z:-0.9218828424981842 +[2026-10-05 17:29:29.966] [path_visualizer] [debug] current_pose_x:-2.5711956677319767, current_pose_y:2.1854219353324127,current_pose_yaw:2.9668712615966797 +[2026-10-05 17:29:29.966] [path_visualizer] [debug] current_path_x:-2.605840791925444, current_path_y:2.204408465434311,current_path_yaw:2.487094184 +[2026-10-05 17:29:29.966] [path_visualizer] [debug] current_cmd_angular_z:-0.9218828424981842 +[2026-10-05 17:29:30.016] [path_visualizer] [debug] current_pose_x:-2.616841008026924, current_pose_y:2.219136127496262,current_pose_yaw:2.9437341690063477 +[2026-10-05 17:29:30.016] [path_visualizer] [debug] current_path_x:-2.605840791925444, current_path_y:2.204408465434311,current_path_yaw:2.487094184 +[2026-10-05 17:29:30.016] [path_visualizer] [debug] current_cmd_angular_z:-0.8821072722509021 +[2026-10-05 17:29:30.066] [path_visualizer] [debug] current_pose_x:-2.616841008026924, current_pose_y:2.219136127496262,current_pose_yaw:2.9437341690063477 +[2026-10-05 17:29:30.066] [path_visualizer] [debug] current_path_x:-2.605840791925444, current_path_y:2.204408465434311,current_path_yaw:2.487094184 +[2026-10-05 17:29:30.066] [path_visualizer] [debug] current_cmd_angular_z:-0.8821072722509021 +[2026-10-05 17:29:30.116] [path_visualizer] [debug] current_pose_x:-2.616841008026924, current_pose_y:2.219136127496262,current_pose_yaw:2.9437341690063477 +[2026-10-05 17:29:30.117] [path_visualizer] [debug] current_path_x:-2.605840791925444, current_path_y:2.204408465434311,current_path_yaw:2.487094184 +[2026-10-05 17:29:30.117] [path_visualizer] [debug] current_cmd_angular_z:-0.8821072722509021 +[2026-10-05 17:29:30.166] [path_visualizer] [debug] current_pose_x:-2.66026087646474, current_pose_y:2.2607407285491434,current_pose_yaw:2.9144668579101562 +[2026-10-05 17:29:30.166] [path_visualizer] [debug] current_path_x:-2.709485145882683, current_path_y:2.2835437743223226,current_path_yaw:2.35619449 +[2026-10-05 17:29:30.166] [path_visualizer] [debug] current_cmd_angular_z:-0.9998114712605701 +[2026-10-05 17:29:30.217] [path_visualizer] [debug] current_pose_x:-2.66026087646474, current_pose_y:2.2607407285491434,current_pose_yaw:2.9144668579101562 +[2026-10-05 17:29:30.217] [path_visualizer] [debug] current_path_x:-2.709485145882683, current_path_y:2.2835437743223226,current_path_yaw:2.35619449 +[2026-10-05 17:29:30.217] [path_visualizer] [debug] current_cmd_angular_z:-0.9998114712605701 +[2026-10-05 17:29:30.266] [path_visualizer] [debug] current_pose_x:-2.702291444256727, current_pose_y:2.304080722349515,current_pose_yaw:2.8847923278808594 +[2026-10-05 17:29:30.266] [path_visualizer] [debug] current_path_x:-2.709485145882683, current_path_y:2.2835437743223226,current_path_yaw:2.35619449 +[2026-10-05 17:29:30.266] [path_visualizer] [debug] current_cmd_angular_z:-0.9346806863126423 +[2026-10-05 17:29:30.316] [path_visualizer] [debug] current_pose_x:-2.702291444256727, current_pose_y:2.304080722349515,current_pose_yaw:2.8847923278808594 +[2026-10-05 17:29:30.316] [path_visualizer] [debug] current_path_x:-2.709485145882683, current_path_y:2.2835437743223226,current_path_yaw:2.35619449 +[2026-10-05 17:29:30.317] [path_visualizer] [debug] current_cmd_angular_z:-0.9346806863126423 +[2026-10-05 17:29:30.366] [path_visualizer] [debug] current_pose_x:-2.702291444256727, current_pose_y:2.304080722349515,current_pose_yaw:2.8847923278808594 +[2026-10-05 17:29:30.366] [path_visualizer] [debug] current_path_x:-2.709485145882683, current_path_y:2.2835437743223226,current_path_yaw:2.35619449 +[2026-10-05 17:29:30.366] [path_visualizer] [debug] current_cmd_angular_z:-0.9346806863126423 +[2026-10-05 17:29:30.416] [path_visualizer] [debug] current_pose_x:-2.74235192891101, current_pose_y:2.3517719695356716,current_pose_yaw:2.8523056507110596 +[2026-10-05 17:29:30.417] [path_visualizer] [debug] current_path_x:-2.789014264038932, current_path_y:2.386674931612669,current_path_yaw:2.225294796 +[2026-10-05 17:29:30.417] [path_visualizer] [debug] current_cmd_angular_z:-1.1554657681251146 +[2026-10-05 17:29:30.467] [path_visualizer] [debug] current_pose_x:-2.74235192891101, current_pose_y:2.3517719695356716,current_pose_yaw:2.8523056507110596 +[2026-10-05 17:29:30.467] [path_visualizer] [debug] current_path_x:-2.789014264038932, current_path_y:2.386674931612669,current_path_yaw:2.225294796 +[2026-10-05 17:29:30.467] [path_visualizer] [debug] current_cmd_angular_z:-1.1554657681251146 +[2026-10-05 17:29:30.516] [path_visualizer] [debug] current_pose_x:-2.7810644725899505, current_pose_y:2.399542582213325,current_pose_yaw:2.8209035396575928 +[2026-10-05 17:29:30.516] [path_visualizer] [debug] current_path_x:-2.789014264038932, current_path_y:2.386674931612669,current_path_yaw:2.225294796 +[2026-10-05 17:29:30.516] [path_visualizer] [debug] current_cmd_angular_z:-1.1028548451557767 +[2026-10-05 17:29:30.566] [path_visualizer] [debug] current_pose_x:-2.7810644725899505, current_pose_y:2.399542582213325,current_pose_yaw:2.8209035396575928 +[2026-10-05 17:29:30.566] [path_visualizer] [debug] current_path_x:-2.789014264038932, current_path_y:2.386674931612669,current_path_yaw:2.225294796 +[2026-10-05 17:29:30.566] [path_visualizer] [debug] current_cmd_angular_z:-1.1028548451557767 +[2026-10-05 17:29:30.616] [path_visualizer] [debug] current_pose_x:-2.7810644725899505, current_pose_y:2.399542582213325,current_pose_yaw:2.8209035396575928 +[2026-10-05 17:29:30.616] [path_visualizer] [debug] current_path_x:-2.789014264038932, current_path_y:2.386674931612669,current_path_yaw:2.225294796 +[2026-10-05 17:29:30.616] [path_visualizer] [debug] current_cmd_angular_z:-1.1028548451557767 +[2026-10-05 17:29:30.666] [path_visualizer] [debug] current_pose_x:-2.8172018480261434, current_pose_y:2.453234570017512,current_pose_yaw:2.7852118015289307 +[2026-10-05 17:29:30.666] [path_visualizer] [debug] current_path_x:-2.868543382195181, current_path_y:2.489806088903016,current_path_yaw:2.094395102 +[2026-10-05 17:29:30.667] [path_visualizer] [debug] current_cmd_angular_z:-1.2181163362255907 +[2026-10-05 17:29:30.716] [path_visualizer] [debug] current_pose_x:-2.8172018480261434, current_pose_y:2.453234570017512,current_pose_yaw:2.7852118015289307 +[2026-10-05 17:29:30.716] [path_visualizer] [debug] current_path_x:-2.868543382195181, current_path_y:2.489806088903016,current_path_yaw:2.094395102 +[2026-10-05 17:29:30.716] [path_visualizer] [debug] current_cmd_angular_z:-1.2181163362255907 +[2026-10-05 17:29:30.766] [path_visualizer] [debug] current_pose_x:-2.8172018480261434, current_pose_y:2.453234570017512,current_pose_yaw:2.7852118015289307 +[2026-10-05 17:29:30.766] [path_visualizer] [debug] current_path_x:-2.868543382195181, current_path_y:2.489806088903016,current_path_yaw:2.094395102 +[2026-10-05 17:29:30.766] [path_visualizer] [debug] current_cmd_angular_z:-1.2181163362255907 +[2026-10-05 17:29:30.816] [path_visualizer] [debug] current_pose_x:-2.8510055882936345, current_pose_y:2.509599161579006,current_pose_yaw:2.748243808746338 +[2026-10-05 17:29:30.816] [path_visualizer] [debug] current_path_x:-2.868543382195181, current_path_y:2.489806088903016,current_path_yaw:2.094395102 +[2026-10-05 17:29:30.816] [path_visualizer] [debug] current_cmd_angular_z:-1.1509981769203934 +[2026-10-05 17:29:30.866] [path_visualizer] [debug] current_pose_x:-2.8510055882936345, current_pose_y:2.509599161579006,current_pose_yaw:2.748243808746338 +[2026-10-05 17:29:30.866] [path_visualizer] [debug] current_path_x:-2.868543382195181, current_path_y:2.489806088903016,current_path_yaw:2.094395102 +[2026-10-05 17:29:30.866] [path_visualizer] [debug] current_cmd_angular_z:-1.1509981769203934 +[2026-10-05 17:29:30.916] [path_visualizer] [debug] current_pose_x:-2.8816576873257658, current_pose_y:2.570231344030991,current_pose_yaw:2.708435535430908 +[2026-10-05 17:29:30.916] [path_visualizer] [debug] current_path_x:-2.9185374027903777, current_path_y:2.6099048809637786,current_path_yaw:1.9634954085 +[2026-10-05 17:29:30.916] [path_visualizer] [debug] current_cmd_angular_z:-1.371851964036869 +[2026-10-05 17:29:30.966] [path_visualizer] [debug] current_pose_x:-2.8816576873257658, current_pose_y:2.570231344030991,current_pose_yaw:2.708435535430908 +[2026-10-05 17:29:30.966] [path_visualizer] [debug] current_path_x:-2.9185374027903777, current_path_y:2.6099048809637786,current_path_yaw:1.9634954085 +[2026-10-05 17:29:30.966] [path_visualizer] [debug] current_cmd_angular_z:-1.371851964036869 +[2026-10-05 17:29:31.016] [path_visualizer] [debug] current_pose_x:-2.8816576873257658, current_pose_y:2.570231344030991,current_pose_yaw:2.708435535430908 +[2026-10-05 17:29:31.016] [path_visualizer] [debug] current_path_x:-2.9185374027903777, current_path_y:2.6099048809637786,current_path_yaw:1.9634954085 +[2026-10-05 17:29:31.016] [path_visualizer] [debug] current_cmd_angular_z:-1.371851964036869 +[2026-10-05 17:29:31.066] [path_visualizer] [debug] current_pose_x:-2.9103466125514528, current_pose_y:2.6305477213400903,current_pose_yaw:2.670004367828369 +[2026-10-05 17:29:31.066] [path_visualizer] [debug] current_path_x:-2.9185374027903777, current_path_y:2.6099048809637786,current_path_yaw:1.9634954085 +[2026-10-05 17:29:31.066] [path_visualizer] [debug] current_cmd_angular_z:-1.3163681289562017 +[2026-10-05 17:29:31.116] [path_visualizer] [debug] current_pose_x:-2.9103466125514528, current_pose_y:2.6305477213400903,current_pose_yaw:2.670004367828369 +[2026-10-05 17:29:31.116] [path_visualizer] [debug] current_path_x:-2.9185374027903777, current_path_y:2.6099048809637786,current_path_yaw:1.9634954085 +[2026-10-05 17:29:31.116] [path_visualizer] [debug] current_cmd_angular_z:-1.3163681289562017 +[2026-10-05 17:29:31.166] [path_visualizer] [debug] current_pose_x:-2.9344350931383576, current_pose_y:2.6964755640304823,current_pose_yaw:2.6270716190338135 +[2026-10-05 17:29:31.166] [path_visualizer] [debug] current_path_x:-2.9685314233855746, current_path_y:2.730003673024541,current_path_yaw:1.832595715 +[2026-10-05 17:29:31.166] [path_visualizer] [debug] current_cmd_angular_z:-1.4374192594653084 +[2026-10-05 17:29:31.216] [path_visualizer] [debug] current_pose_x:-2.9344350931383576, current_pose_y:2.6964755640304823,current_pose_yaw:2.6270716190338135 +[2026-10-05 17:29:31.217] [path_visualizer] [debug] current_path_x:-2.9685314233855746, current_path_y:2.730003673024541,current_path_yaw:1.832595715 +[2026-10-05 17:29:31.217] [path_visualizer] [debug] current_cmd_angular_z:-1.4374192594653084 +[2026-10-05 17:29:31.266] [path_visualizer] [debug] current_pose_x:-2.9344350931383576, current_pose_y:2.6964755640304823,current_pose_yaw:2.6270716190338135 +[2026-10-05 17:29:31.266] [path_visualizer] [debug] current_path_x:-2.9685314233855746, current_path_y:2.730003673024541,current_path_yaw:1.832595715 +[2026-10-05 17:29:31.266] [path_visualizer] [debug] current_cmd_angular_z:-1.4374192594653084 +[2026-10-05 17:29:31.316] [path_visualizer] [debug] current_pose_x:-2.955481584349538, current_pose_y:2.7633447441500225,current_pose_yaw:2.584092378616333 +[2026-10-05 17:29:31.316] [path_visualizer] [debug] current_path_x:-2.9685314233855746, current_path_y:2.730003673024541,current_path_yaw:1.832595715 +[2026-10-05 17:29:31.317] [path_visualizer] [debug] current_cmd_angular_z:-1.3703264897769492 +[2026-10-05 17:29:31.366] [path_visualizer] [debug] current_pose_x:-2.955481584349538, current_pose_y:2.7633447441500225,current_pose_yaw:2.584092378616333 +[2026-10-05 17:29:31.366] [path_visualizer] [debug] current_path_x:-2.9685314233855746, current_path_y:2.730003673024541,current_path_yaw:1.832595715 +[2026-10-05 17:29:31.366] [path_visualizer] [debug] current_cmd_angular_z:-1.3703264897769492 +[2026-10-05 17:29:31.416] [path_visualizer] [debug] current_pose_x:-2.955481584349538, current_pose_y:2.7633447441500225,current_pose_yaw:2.584092378616333 +[2026-10-05 17:29:31.416] [path_visualizer] [debug] current_path_x:-2.9685314233855746, current_path_y:2.730003673024541,current_path_yaw:1.832595715 +[2026-10-05 17:29:31.416] [path_visualizer] [debug] current_cmd_angular_z:-1.3703264897769492 +[2026-10-05 17:29:31.466] [path_visualizer] [debug] current_pose_x:-2.972037001422895, current_pose_y:2.8331398307991873,current_pose_yaw:2.5388195514678955 +[2026-10-05 17:29:31.466] [path_visualizer] [debug] current_path_x:-2.9855834437227182, current_path_y:2.858885503564773,current_path_yaw:1.701696021 +[2026-10-05 17:29:31.466] [path_visualizer] [debug] current_cmd_angular_z:-1.611314341793678 +[2026-10-05 17:29:31.516] [path_visualizer] [debug] current_pose_x:-2.972037001422895, current_pose_y:2.8331398307991873,current_pose_yaw:2.5388195514678955 +[2026-10-05 17:29:31.516] [path_visualizer] [debug] current_path_x:-2.9855834437227182, current_path_y:2.858885503564773,current_path_yaw:1.701696021 +[2026-10-05 17:29:31.516] [path_visualizer] [debug] current_cmd_angular_z:-1.611314341793678 +[2026-10-05 17:29:31.566] [path_visualizer] [debug] current_pose_x:-2.9861011703338307, current_pose_y:2.902273058255452,current_pose_yaw:2.494868278503418 +[2026-10-05 17:29:31.567] [path_visualizer] [debug] current_path_x:-2.9855834437227182, current_path_y:2.858885503564773,current_path_yaw:1.701696021 +[2026-10-05 17:29:31.567] [path_visualizer] [debug] current_cmd_angular_z:-1.554158241379455 +[2026-10-05 17:29:31.616] [path_visualizer] [debug] current_pose_x:-2.9861011703338307, current_pose_y:2.902273058255452,current_pose_yaw:2.494868278503418 +[2026-10-05 17:29:31.617] [path_visualizer] [debug] current_path_x:-2.9855834437227182, current_path_y:2.858885503564773,current_path_yaw:1.701696021 +[2026-10-05 17:29:31.617] [path_visualizer] [debug] current_cmd_angular_z:-1.554158241379455 +[2026-10-05 17:29:31.666] [path_visualizer] [debug] current_pose_x:-2.9861011703338307, current_pose_y:2.902273058255452,current_pose_yaw:2.494868278503418 +[2026-10-05 17:29:31.666] [path_visualizer] [debug] current_path_x:-2.9855834437227182, current_path_y:2.858885503564773,current_path_yaw:1.701696021 +[2026-10-05 17:29:31.667] [path_visualizer] [debug] current_cmd_angular_z:-1.554158241379455 +[2026-10-05 17:29:31.716] [path_visualizer] [debug] current_pose_x:-2.994262240041636, current_pose_y:2.9752418343821843,current_pose_yaw:2.447084903717041 +[2026-10-05 17:29:31.716] [path_visualizer] [debug] current_path_x:-3.0026354640598623, current_path_y:2.987767334105005,current_path_yaw:1.570796327 +[2026-10-05 17:29:31.716] [path_visualizer] [debug] current_cmd_angular_z:-1.7002474889412025 +[2026-10-05 17:29:31.766] [path_visualizer] [debug] current_pose_x:-2.994262240041636, current_pose_y:2.9752418343821843,current_pose_yaw:2.447084903717041 +[2026-10-05 17:29:31.767] [path_visualizer] [debug] current_path_x:-3.0026354640598623, current_path_y:2.987767334105005,current_path_yaw:1.570796327 +[2026-10-05 17:29:31.767] [path_visualizer] [debug] current_cmd_angular_z:-1.7002474889412025 +[2026-10-05 17:29:31.816] [path_visualizer] [debug] current_pose_x:-2.9982142633893236, current_pose_y:3.049533221757378,current_pose_yaw:2.3983547687530518 +[2026-10-05 17:29:31.816] [path_visualizer] [debug] current_path_x:-3.0026354640598623, current_path_y:2.987767334105005,current_path_yaw:1.570796327 +[2026-10-05 17:29:31.816] [path_visualizer] [debug] current_cmd_angular_z:-1.6274848187848252 +[2026-10-05 17:29:31.866] [path_visualizer] [debug] current_pose_x:-2.9982142633893236, current_pose_y:3.049533221757378,current_pose_yaw:2.3983547687530518 +[2026-10-05 17:29:31.866] [path_visualizer] [debug] current_path_x:-3.0026354640598623, current_path_y:2.987767334105005,current_path_yaw:1.570796327 +[2026-10-05 17:29:31.867] [path_visualizer] [debug] current_cmd_angular_z:-1.6274848187848252 +[2026-10-05 17:29:31.916] [path_visualizer] [debug] current_pose_x:-2.9982142633893236, current_pose_y:3.049533221757378,current_pose_yaw:2.3983547687530518 +[2026-10-05 17:29:31.916] [path_visualizer] [debug] current_path_x:-3.0026354640598623, current_path_y:2.987767334105005,current_path_yaw:1.570796327 +[2026-10-05 17:29:31.916] [path_visualizer] [debug] current_cmd_angular_z:-1.6274848187848252 +[2026-10-05 17:29:31.967] [path_visualizer] [debug] current_pose_x:-2.9964224089590497, current_pose_y:3.126217720233567,current_pose_yaw:2.3468568325042725 +[2026-10-05 17:29:31.967] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:31.967] [path_visualizer] [debug] current_cmd_angular_z:-1.5132909855341439 +[2026-10-05 17:29:32.016] [path_visualizer] [debug] current_pose_x:-2.9964224089590497, current_pose_y:3.126217720233567,current_pose_yaw:2.3468568325042725 +[2026-10-05 17:29:32.016] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.016] [path_visualizer] [debug] current_cmd_angular_z:-1.5132909855341439 +[2026-10-05 17:29:32.066] [path_visualizer] [debug] current_pose_x:-2.9964224089590497, current_pose_y:3.126217720233567,current_pose_yaw:2.3468568325042725 +[2026-10-05 17:29:32.066] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.067] [path_visualizer] [debug] current_cmd_angular_z:-1.5132909855341439 +[2026-10-05 17:29:32.116] [path_visualizer] [debug] current_pose_x:-2.9917824005929643, current_pose_y:3.2016531195846545,current_pose_yaw:2.296666383743286 +[2026-10-05 17:29:32.116] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.117] [path_visualizer] [debug] current_cmd_angular_z:-1.3839153167677458 +[2026-10-05 17:29:32.167] [path_visualizer] [debug] current_pose_x:-2.9917824005929643, current_pose_y:3.2016531195846545,current_pose_yaw:2.296666383743286 +[2026-10-05 17:29:32.167] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.167] [path_visualizer] [debug] current_cmd_angular_z:-1.3839153167677458 +[2026-10-05 17:29:32.216] [path_visualizer] [debug] current_pose_x:-2.985579310078819, current_pose_y:3.274853845574631,current_pose_yaw:2.2490270137786865 +[2026-10-05 17:29:32.216] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.216] [path_visualizer] [debug] current_cmd_angular_z:-1.2498859863799059 +[2026-10-05 17:29:32.267] [path_visualizer] [debug] current_pose_x:-2.985579310078819, current_pose_y:3.274853845574631,current_pose_yaw:2.2490270137786865 +[2026-10-05 17:29:32.267] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.267] [path_visualizer] [debug] current_cmd_angular_z:-1.2498859863799059 +[2026-10-05 17:29:32.316] [path_visualizer] [debug] current_pose_x:-2.985579310078819, current_pose_y:3.274853845574631,current_pose_yaw:2.2490270137786865 +[2026-10-05 17:29:32.317] [path_visualizer] [debug] current_path_x:-3.002635408210706, current_path_y:3.1869517914241525,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.317] [path_visualizer] [debug] current_cmd_angular_z:-1.2498859863799059 +[2026-10-05 17:29:32.366] [path_visualizer] [debug] current_pose_x:-2.9789514055562463, current_pose_y:3.345304370106306,current_pose_yaw:2.204801321029663 +[2026-10-05 17:29:32.366] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.366] [path_visualizer] [debug] current_cmd_angular_z:-1.12005283622011 +[2026-10-05 17:29:32.416] [path_visualizer] [debug] current_pose_x:-2.9789514055562463, current_pose_y:3.345304370106306,current_pose_yaw:2.204801321029663 +[2026-10-05 17:29:32.416] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.417] [path_visualizer] [debug] current_cmd_angular_z:-1.12005283622011 +[2026-10-05 17:29:32.466] [path_visualizer] [debug] current_pose_x:-2.9724429968598023, current_pose_y:3.413082317427313,current_pose_yaw:2.164052963256836 +[2026-10-05 17:29:32.466] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.466] [path_visualizer] [debug] current_cmd_angular_z:-0.997950851637746 +[2026-10-05 17:29:32.517] [path_visualizer] [debug] current_pose_x:-2.9724429968598023, current_pose_y:3.413082317427313,current_pose_yaw:2.164052963256836 +[2026-10-05 17:29:32.517] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.517] [path_visualizer] [debug] current_cmd_angular_z:-0.997950851637746 +[2026-10-05 17:29:32.566] [path_visualizer] [debug] current_pose_x:-2.9724429968598023, current_pose_y:3.413082317427313,current_pose_yaw:2.164052963256836 +[2026-10-05 17:29:32.566] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.566] [path_visualizer] [debug] current_cmd_angular_z:-0.997950851637746 +[2026-10-05 17:29:32.617] [path_visualizer] [debug] current_pose_x:-2.9664487546214646, current_pose_y:3.478368068455603,current_pose_yaw:2.126771926879883 +[2026-10-05 17:29:32.617] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.617] [path_visualizer] [debug] current_cmd_angular_z:-0.8860255164043845 +[2026-10-05 17:29:32.666] [path_visualizer] [debug] current_pose_x:-2.9664487546214646, current_pose_y:3.478368068455603,current_pose_yaw:2.126771926879883 +[2026-10-05 17:29:32.666] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.666] [path_visualizer] [debug] current_cmd_angular_z:-0.8860255164043845 +[2026-10-05 17:29:32.717] [path_visualizer] [debug] current_pose_x:-2.9664487546214646, current_pose_y:3.478368068455603,current_pose_yaw:2.126771926879883 +[2026-10-05 17:29:32.717] [path_visualizer] [debug] current_path_x:-3.002635352361549, current_path_y:3.3861362487433,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.717] [path_visualizer] [debug] current_cmd_angular_z:-0.8860255164043845 +[2026-10-05 17:29:32.766] [path_visualizer] [debug] current_pose_x:-2.9621055995144774, current_pose_y:3.540793728374962,current_pose_yaw:2.0937395095825195 +[2026-10-05 17:29:32.766] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.767] [path_visualizer] [debug] current_cmd_angular_z:-0.7929135713973602 +[2026-10-05 17:29:32.816] [path_visualizer] [debug] current_pose_x:-2.9621055995144774, current_pose_y:3.540793728374962,current_pose_yaw:2.0937395095825195 +[2026-10-05 17:29:32.816] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.816] [path_visualizer] [debug] current_cmd_angular_z:-0.7929135713973602 +[2026-10-05 17:29:32.866] [path_visualizer] [debug] current_pose_x:-2.958895987957756, current_pose_y:3.601248438248974,current_pose_yaw:2.0639123916625977 +[2026-10-05 17:29:32.866] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.866] [path_visualizer] [debug] current_cmd_angular_z:-0.7132858747290296 +[2026-10-05 17:29:32.916] [path_visualizer] [debug] current_pose_x:-2.958895987957756, current_pose_y:3.601248438248974,current_pose_yaw:2.0639123916625977 +[2026-10-05 17:29:32.916] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.916] [path_visualizer] [debug] current_cmd_angular_z:-0.7132858747290296 +[2026-10-05 17:29:32.966] [path_visualizer] [debug] current_pose_x:-2.958895987957756, current_pose_y:3.601248438248974,current_pose_yaw:2.0639123916625977 +[2026-10-05 17:29:32.966] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:32.966] [path_visualizer] [debug] current_cmd_angular_z:-0.7132858747290296 +[2026-10-05 17:29:33.016] [path_visualizer] [debug] current_pose_x:-2.9573673961550924, current_pose_y:3.6597397378352876,current_pose_yaw:2.0375614166259766 +[2026-10-05 17:29:33.016] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.016] [path_visualizer] [debug] current_cmd_angular_z:-0.6510762036714001 +[2026-10-05 17:29:33.066] [path_visualizer] [debug] current_pose_x:-2.9573673961550924, current_pose_y:3.6597397378352876,current_pose_yaw:2.0375614166259766 +[2026-10-05 17:29:33.066] [path_visualizer] [debug] current_path_x:-3.0026352965123926, current_path_y:3.5853207060624483,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.066] [path_visualizer] [debug] current_cmd_angular_z:-0.6510762036714001 +[2026-10-05 17:29:33.116] [path_visualizer] [debug] current_pose_x:-2.9566908955844093, current_pose_y:3.7169717558881645,current_pose_yaw:2.013547897338867 +[2026-10-05 17:29:33.116] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.116] [path_visualizer] [debug] current_cmd_angular_z:-0.598842746037384 +[2026-10-05 17:29:33.166] [path_visualizer] [debug] current_pose_x:-2.9566908955844093, current_pose_y:3.7169717558881645,current_pose_yaw:2.013547897338867 +[2026-10-05 17:29:33.166] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.166] [path_visualizer] [debug] current_cmd_angular_z:-0.598842746037384 +[2026-10-05 17:29:33.216] [path_visualizer] [debug] current_pose_x:-2.9566908955844093, current_pose_y:3.7169717558881645,current_pose_yaw:2.013547897338867 +[2026-10-05 17:29:33.216] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.216] [path_visualizer] [debug] current_cmd_angular_z:-0.598842746037384 +[2026-10-05 17:29:33.266] [path_visualizer] [debug] current_pose_x:-2.9572362764110824, current_pose_y:3.7729433000951547,current_pose_yaw:1.9920667409896853 +[2026-10-05 17:29:33.266] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.267] [path_visualizer] [debug] current_cmd_angular_z:-0.5592717926360105 +[2026-10-05 17:29:33.316] [path_visualizer] [debug] current_pose_x:-2.9572362764110824, current_pose_y:3.7729433000951547,current_pose_yaw:1.9920667409896853 +[2026-10-05 17:29:33.316] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.316] [path_visualizer] [debug] current_cmd_angular_z:-0.5592717926360105 +[2026-10-05 17:29:33.366] [path_visualizer] [debug] current_pose_x:-2.9572362764110824, current_pose_y:3.7729433000951547,current_pose_yaw:1.9920667409896853 +[2026-10-05 17:29:33.366] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.367] [path_visualizer] [debug] current_cmd_angular_z:-0.5592717926360105 +[2026-10-05 17:29:33.416] [path_visualizer] [debug] current_pose_x:-2.9582985695898136, current_pose_y:3.8281400801218,current_pose_yaw:1.9722392559051514 +[2026-10-05 17:29:33.416] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.416] [path_visualizer] [debug] current_cmd_angular_z:-0.526223681578736 +[2026-10-05 17:29:33.466] [path_visualizer] [debug] current_pose_x:-2.9582985695898136, current_pose_y:3.8281400801218,current_pose_yaw:1.9722392559051514 +[2026-10-05 17:29:33.466] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.466] [path_visualizer] [debug] current_cmd_angular_z:-0.526223681578736 +[2026-10-05 17:29:33.516] [path_visualizer] [debug] current_pose_x:-2.9593215151102807, current_pose_y:3.8828942302347116,current_pose_yaw:1.9534130096435547 +[2026-10-05 17:29:33.517] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.517] [path_visualizer] [debug] current_cmd_angular_z:-0.49493475786251934 +[2026-10-05 17:29:33.566] [path_visualizer] [debug] current_pose_x:-2.9593215151102807, current_pose_y:3.8828942302347116,current_pose_yaw:1.9534130096435547 +[2026-10-05 17:29:33.566] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.566] [path_visualizer] [debug] current_cmd_angular_z:-0.49493475786251934 +[2026-10-05 17:29:33.616] [path_visualizer] [debug] current_pose_x:-2.9593215151102807, current_pose_y:3.8828942302347116,current_pose_yaw:1.9534130096435547 +[2026-10-05 17:29:33.616] [path_visualizer] [debug] current_path_x:-3.0026352406632357, current_path_y:3.784505163381596,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.616] [path_visualizer] [debug] current_cmd_angular_z:-0.49493475786251934 +[2026-10-05 17:29:33.666] [path_visualizer] [debug] current_pose_x:-2.960756318843868, current_pose_y:3.9370732578137817,current_pose_yaw:1.9359605312347412 +[2026-10-05 17:29:33.666] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.666] [path_visualizer] [debug] current_cmd_angular_z:-0.4689581193211427 +[2026-10-05 17:29:33.716] [path_visualizer] [debug] current_pose_x:-2.960756318843868, current_pose_y:3.9370732578137817,current_pose_yaw:1.9359605312347412 +[2026-10-05 17:29:33.717] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.717] [path_visualizer] [debug] current_cmd_angular_z:-0.4689581193211427 +[2026-10-05 17:29:33.766] [path_visualizer] [debug] current_pose_x:-2.962087739358314, current_pose_y:3.990948672678829,current_pose_yaw:1.9192984104156492 +[2026-10-05 17:29:33.766] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.766] [path_visualizer] [debug] current_cmd_angular_z:-0.4439208884164182 +[2026-10-05 17:29:33.816] [path_visualizer] [debug] current_pose_x:-2.962087739358314, current_pose_y:3.990948672678829,current_pose_yaw:1.9192984104156492 +[2026-10-05 17:29:33.817] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.817] [path_visualizer] [debug] current_cmd_angular_z:-0.4439208884164182 +[2026-10-05 17:29:33.866] [path_visualizer] [debug] current_pose_x:-2.962087739358314, current_pose_y:3.990948672678829,current_pose_yaw:1.9192984104156492 +[2026-10-05 17:29:33.866] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.866] [path_visualizer] [debug] current_cmd_angular_z:-0.4439208884164182 +[2026-10-05 17:29:33.916] [path_visualizer] [debug] current_pose_x:-2.963676674543299, current_pose_y:4.044411194486391,current_pose_yaw:1.9037216901779173 +[2026-10-05 17:29:33.917] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.917] [path_visualizer] [debug] current_cmd_angular_z:-0.42266012033689315 +[2026-10-05 17:29:33.966] [path_visualizer] [debug] current_pose_x:-2.963676674543299, current_pose_y:4.044411194486391,current_pose_yaw:1.9037216901779173 +[2026-10-05 17:29:33.966] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:33.966] [path_visualizer] [debug] current_cmd_angular_z:-0.42266012033689315 +[2026-10-05 17:29:34.016] [path_visualizer] [debug] current_pose_x:-2.963676674543299, current_pose_y:4.044411194486391,current_pose_yaw:1.9037216901779173 +[2026-10-05 17:29:34.017] [path_visualizer] [debug] current_path_x:-3.0026351848140793, current_path_y:3.9836896207007437,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.017] [path_visualizer] [debug] current_cmd_angular_z:-0.42266012033689315 +[2026-10-05 17:29:34.066] [path_visualizer] [debug] current_pose_x:-2.965306268792591, current_pose_y:4.0975833804951804,current_pose_yaw:1.8889578580856323 +[2026-10-05 17:29:34.066] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.067] [path_visualizer] [debug] current_cmd_angular_z:-0.4032817128599617 +[2026-10-05 17:29:34.116] [path_visualizer] [debug] current_pose_x:-2.965306268792591, current_pose_y:4.0975833804951804,current_pose_yaw:1.8889578580856323 +[2026-10-05 17:29:34.117] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.117] [path_visualizer] [debug] current_cmd_angular_z:-0.4032817128599617 +[2026-10-05 17:29:34.166] [path_visualizer] [debug] current_pose_x:-2.9667333668929126, current_pose_y:4.150576880306042,current_pose_yaw:1.8747305870056152 +[2026-10-05 17:29:34.166] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.166] [path_visualizer] [debug] current_cmd_angular_z:-0.38371743099467004 +[2026-10-05 17:29:34.216] [path_visualizer] [debug] current_pose_x:-2.9667333668929126, current_pose_y:4.150576880306042,current_pose_yaw:1.8747305870056152 +[2026-10-05 17:29:34.216] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.216] [path_visualizer] [debug] current_cmd_angular_z:-0.38371743099467004 +[2026-10-05 17:29:34.266] [path_visualizer] [debug] current_pose_x:-2.9667333668929126, current_pose_y:4.150576880306042,current_pose_yaw:1.8747305870056152 +[2026-10-05 17:29:34.266] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.266] [path_visualizer] [debug] current_cmd_angular_z:-0.38371743099467004 +[2026-10-05 17:29:34.316] [path_visualizer] [debug] current_pose_x:-2.968286986510596, current_pose_y:4.203304151534086,current_pose_yaw:1.8613191843032837 +[2026-10-05 17:29:34.316] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.316] [path_visualizer] [debug] current_cmd_angular_z:-0.3665755832788669 +[2026-10-05 17:29:34.366] [path_visualizer] [debug] current_pose_x:-2.968286986510596, current_pose_y:4.203304151534086,current_pose_yaw:1.8613191843032837 +[2026-10-05 17:29:34.367] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.367] [path_visualizer] [debug] current_cmd_angular_z:-0.3665755832788669 +[2026-10-05 17:29:34.416] [path_visualizer] [debug] current_pose_x:-2.969675105677035, current_pose_y:4.255879129689681,current_pose_yaw:1.848402976989746 +[2026-10-05 17:29:34.416] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.416] [path_visualizer] [debug] current_cmd_angular_z:-0.3493949866179403 +[2026-10-05 17:29:34.467] [path_visualizer] [debug] current_pose_x:-2.969675105677035, current_pose_y:4.255879129689681,current_pose_yaw:1.848402976989746 +[2026-10-05 17:29:34.467] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.467] [path_visualizer] [debug] current_cmd_angular_z:-0.3493949866179403 +[2026-10-05 17:29:34.516] [path_visualizer] [debug] current_pose_x:-2.969675105677035, current_pose_y:4.255879129689681,current_pose_yaw:1.848402976989746 +[2026-10-05 17:29:34.516] [path_visualizer] [debug] current_path_x:-3.0026351289649225, current_path_y:4.182874078019892,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.516] [path_visualizer] [debug] current_cmd_angular_z:-0.3493949866179403 +[2026-10-05 17:29:34.566] [path_visualizer] [debug] current_pose_x:-2.9711677199511803, current_pose_y:4.308237672076664,current_pose_yaw:1.8362075090408325 +[2026-10-05 17:29:34.566] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.566] [path_visualizer] [debug] current_cmd_angular_z:-0.33430965924169587 +[2026-10-05 17:29:34.616] [path_visualizer] [debug] current_pose_x:-2.9711677199511803, current_pose_y:4.308237672076664,current_pose_yaw:1.8362075090408325 +[2026-10-05 17:29:34.616] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.616] [path_visualizer] [debug] current_cmd_angular_z:-0.33430965924169587 +[2026-10-05 17:29:34.666] [path_visualizer] [debug] current_pose_x:-2.9711677199511803, current_pose_y:4.308237672076664,current_pose_yaw:1.8362075090408325 +[2026-10-05 17:29:34.666] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.666] [path_visualizer] [debug] current_cmd_angular_z:-0.33430965924169587 +[2026-10-05 17:29:34.716] [path_visualizer] [debug] current_pose_x:-2.972635933793418, current_pose_y:4.360437878273111,current_pose_yaw:1.8245724439620972 +[2026-10-05 17:29:34.716] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.716] [path_visualizer] [debug] current_cmd_angular_z:-0.320194749729938 +[2026-10-05 17:29:34.766] [path_visualizer] [debug] current_pose_x:-2.972635933793418, current_pose_y:4.360437878273111,current_pose_yaw:1.8245724439620972 +[2026-10-05 17:29:34.766] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.766] [path_visualizer] [debug] current_cmd_angular_z:-0.320194749729938 +[2026-10-05 17:29:34.816] [path_visualizer] [debug] current_pose_x:-2.9739187926242963, current_pose_y:4.412537788165971,current_pose_yaw:1.8133188486099243 +[2026-10-05 17:29:34.816] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.817] [path_visualizer] [debug] current_cmd_angular_z:-0.3056885883308552 +[2026-10-05 17:29:34.866] [path_visualizer] [debug] current_pose_x:-2.9739187926242963, current_pose_y:4.412537788165971,current_pose_yaw:1.8133188486099243 +[2026-10-05 17:29:34.866] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.866] [path_visualizer] [debug] current_cmd_angular_z:-0.3056885883308552 +[2026-10-05 17:29:34.916] [path_visualizer] [debug] current_pose_x:-2.9739187926242963, current_pose_y:4.412537788165971,current_pose_yaw:1.8133188486099243 +[2026-10-05 17:29:34.917] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.917] [path_visualizer] [debug] current_cmd_angular_z:-0.3056885883308552 +[2026-10-05 17:29:34.966] [path_visualizer] [debug] current_pose_x:-2.9752688390810893, current_pose_y:4.464480669723124,current_pose_yaw:1.8026610612869263 +[2026-10-05 17:29:34.966] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:34.966] [path_visualizer] [debug] current_cmd_angular_z:-0.29279463382865284 +[2026-10-05 17:29:35.016] [path_visualizer] [debug] current_pose_x:-2.9752688390810893, current_pose_y:4.464480669723124,current_pose_yaw:1.8026610612869263 +[2026-10-05 17:29:35.017] [path_visualizer] [debug] current_path_x:-3.002635073115766, current_path_y:4.3820585353390396,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.017] [path_visualizer] [debug] current_cmd_angular_z:-0.29279463382865284 +[2026-10-05 17:29:35.066] [path_visualizer] [debug] current_pose_x:-2.9764738643863464, current_pose_y:4.516334071641326,current_pose_yaw:1.7923707962036133 +[2026-10-05 17:29:35.066] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.066] [path_visualizer] [debug] current_cmd_angular_z:-0.27973271056249144 +[2026-10-05 17:29:35.116] [path_visualizer] [debug] current_pose_x:-2.9764738643863464, current_pose_y:4.516334071641326,current_pose_yaw:1.7923707962036133 +[2026-10-05 17:29:35.116] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.116] [path_visualizer] [debug] current_cmd_angular_z:-0.27973271056249144 +[2026-10-05 17:29:35.166] [path_visualizer] [debug] current_pose_x:-2.9764738643863464, current_pose_y:4.516334071641326,current_pose_yaw:1.7923707962036133 +[2026-10-05 17:29:35.166] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.166] [path_visualizer] [debug] current_cmd_angular_z:-0.27973271056249144 +[2026-10-05 17:29:35.216] [path_visualizer] [debug] current_pose_x:-2.9777463420709642, current_pose_y:4.5680552527338,current_pose_yaw:1.7826256752014158 +[2026-10-05 17:29:35.216] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.216] [path_visualizer] [debug] current_cmd_angular_z:-0.26818282127400334 +[2026-10-05 17:29:35.266] [path_visualizer] [debug] current_pose_x:-2.9777463420709642, current_pose_y:4.5680552527338,current_pose_yaw:1.7826256752014158 +[2026-10-05 17:29:35.266] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.266] [path_visualizer] [debug] current_cmd_angular_z:-0.26818282127400334 +[2026-10-05 17:29:35.316] [path_visualizer] [debug] current_pose_x:-2.9789889642919705, current_pose_y:4.619679538345998,current_pose_yaw:1.7733073234558108 +[2026-10-05 17:29:35.316] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.316] [path_visualizer] [debug] current_cmd_angular_z:-0.25730135403620064 +[2026-10-05 17:29:35.366] [path_visualizer] [debug] current_pose_x:-2.9789889642919705, current_pose_y:4.619679538345998,current_pose_yaw:1.7733073234558108 +[2026-10-05 17:29:35.366] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.366] [path_visualizer] [debug] current_cmd_angular_z:-0.25730135403620064 +[2026-10-05 17:29:35.416] [path_visualizer] [debug] current_pose_x:-2.9789889642919705, current_pose_y:4.619679538345998,current_pose_yaw:1.7733073234558108 +[2026-10-05 17:29:35.416] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.416] [path_visualizer] [debug] current_cmd_angular_z:-0.25730135403620064 +[2026-10-05 17:29:35.466] [path_visualizer] [debug] current_pose_x:-2.980176204751684, current_pose_y:4.671221774811073,current_pose_yaw:1.764371156692505 +[2026-10-05 17:29:35.466] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.466] [path_visualizer] [debug] current_cmd_angular_z:-0.24683965665020072 +[2026-10-05 17:29:35.516] [path_visualizer] [debug] current_pose_x:-2.980176204751684, current_pose_y:4.671221774811073,current_pose_yaw:1.764371156692505 +[2026-10-05 17:29:35.516] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.516] [path_visualizer] [debug] current_cmd_angular_z:-0.24683965665020072 +[2026-10-05 17:29:35.566] [path_visualizer] [debug] current_pose_x:-2.980176204751684, current_pose_y:4.671221774811073,current_pose_yaw:1.764371156692505 +[2026-10-05 17:29:35.567] [path_visualizer] [debug] current_path_x:-3.002635017266609, current_path_y:4.581242992658187,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.567] [path_visualizer] [debug] current_cmd_angular_z:-0.24683965665020072 +[2026-10-05 17:29:35.616] [path_visualizer] [debug] current_pose_x:-2.9813083431315848, current_pose_y:4.722686013704344,current_pose_yaw:1.7557954788208008 +[2026-10-05 17:29:35.616] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.616] [path_visualizer] [debug] current_cmd_angular_z:-0.23675624268333367 +[2026-10-05 17:29:35.666] [path_visualizer] [debug] current_pose_x:-2.9813083431315848, current_pose_y:4.722686013704344,current_pose_yaw:1.7557954788208008 +[2026-10-05 17:29:35.666] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.667] [path_visualizer] [debug] current_cmd_angular_z:-0.23675624268333367 +[2026-10-05 17:29:35.716] [path_visualizer] [debug] current_pose_x:-2.982298389198449, current_pose_y:4.774099207668249,current_pose_yaw:1.7474849224090576 +[2026-10-05 17:29:35.716] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.716] [path_visualizer] [debug] current_cmd_angular_z:-0.2263163677019358 +[2026-10-05 17:29:35.766] [path_visualizer] [debug] current_pose_x:-2.982298389198449, current_pose_y:4.774099207668249,current_pose_yaw:1.7474849224090576 +[2026-10-05 17:29:35.767] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.767] [path_visualizer] [debug] current_cmd_angular_z:-0.2263163677019358 +[2026-10-05 17:29:35.816] [path_visualizer] [debug] current_pose_x:-2.982298389198449, current_pose_y:4.774099207668249,current_pose_yaw:1.7474849224090576 +[2026-10-05 17:29:35.816] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.816] [path_visualizer] [debug] current_cmd_angular_z:-0.2263163677019358 +[2026-10-05 17:29:35.866] [path_visualizer] [debug] current_pose_x:-2.9833346842762185, current_pose_y:4.825426099184722,current_pose_yaw:1.7396001815795898 +[2026-10-05 17:29:35.867] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.867] [path_visualizer] [debug] current_cmd_angular_z:-0.2170175240387996 +[2026-10-05 17:29:35.916] [path_visualizer] [debug] current_pose_x:-2.9833346842762185, current_pose_y:4.825426099184722,current_pose_yaw:1.7396001815795898 +[2026-10-05 17:29:35.916] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.916] [path_visualizer] [debug] current_cmd_angular_z:-0.2170175240387996 +[2026-10-05 17:29:35.966] [path_visualizer] [debug] current_pose_x:-2.984349628407736, current_pose_y:4.876689348601397,current_pose_yaw:1.7320576906204224 +[2026-10-05 17:29:35.966] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:35.966] [path_visualizer] [debug] current_cmd_angular_z:-0.20827047679383331 +[2026-10-05 17:29:36.016] [path_visualizer] [debug] current_pose_x:-2.984349628407736, current_pose_y:4.876689348601397,current_pose_yaw:1.7320576906204224 +[2026-10-05 17:29:36.016] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.016] [path_visualizer] [debug] current_cmd_angular_z:-0.20827047679383331 +[2026-10-05 17:29:36.066] [path_visualizer] [debug] current_pose_x:-2.984349628407736, current_pose_y:4.876689348601397,current_pose_yaw:1.7320576906204224 +[2026-10-05 17:29:36.066] [path_visualizer] [debug] current_path_x:-3.002634961417453, current_path_y:4.780427449977335,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.066] [path_visualizer] [debug] current_cmd_angular_z:-0.20827047679383331 +[2026-10-05 17:29:36.116] [path_visualizer] [debug] current_pose_x:-2.985323967142697, current_pose_y:4.927898045025701,current_pose_yaw:1.7248238325119019 +[2026-10-05 17:29:36.116] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.116] [path_visualizer] [debug] current_cmd_angular_z:-0.1998880195695831 +[2026-10-05 17:29:36.166] [path_visualizer] [debug] current_pose_x:-2.985323967142697, current_pose_y:4.927898045025701,current_pose_yaw:1.7248238325119019 +[2026-10-05 17:29:36.166] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.166] [path_visualizer] [debug] current_cmd_angular_z:-0.1998880195695831 +[2026-10-05 17:29:36.216] [path_visualizer] [debug] current_pose_x:-2.985323967142697, current_pose_y:4.927898045025701,current_pose_yaw:1.7248238325119019 +[2026-10-05 17:29:36.216] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.217] [path_visualizer] [debug] current_cmd_angular_z:-0.1998880195695831 +[2026-10-05 17:29:36.266] [path_visualizer] [debug] current_pose_x:-2.9862549344027784, current_pose_y:4.979057399693647,current_pose_yaw:1.717881441116333 +[2026-10-05 17:29:36.266] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.266] [path_visualizer] [debug] current_cmd_angular_z:-0.19181775279100174 +[2026-10-05 17:29:36.316] [path_visualizer] [debug] current_pose_x:-2.9862549344027784, current_pose_y:4.979057399693647,current_pose_yaw:1.717881441116333 +[2026-10-05 17:29:36.316] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.317] [path_visualizer] [debug] current_cmd_angular_z:-0.19181775279100174 +[2026-10-05 17:29:36.366] [path_visualizer] [debug] current_pose_x:-2.987070717372073, current_pose_y:5.030183205561913,current_pose_yaw:1.711151361465454 +[2026-10-05 17:29:36.367] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.367] [path_visualizer] [debug] current_cmd_angular_z:-0.1834530627302488 +[2026-10-05 17:29:36.416] [path_visualizer] [debug] current_pose_x:-2.987070717372073, current_pose_y:5.030183205561913,current_pose_yaw:1.711151361465454 +[2026-10-05 17:29:36.416] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.416] [path_visualizer] [debug] current_cmd_angular_z:-0.1834530627302488 +[2026-10-05 17:29:36.466] [path_visualizer] [debug] current_pose_x:-2.987070717372073, current_pose_y:5.030183205561913,current_pose_yaw:1.711151361465454 +[2026-10-05 17:29:36.466] [path_visualizer] [debug] current_path_x:-3.002634905568296, current_path_y:4.979611907296483,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.466] [path_visualizer] [debug] current_cmd_angular_z:-0.1834530627302488 +[2026-10-05 17:29:36.516] [path_visualizer] [debug] current_pose_x:-2.9879249708669375, current_pose_y:5.0812542072775715,current_pose_yaw:1.7047630548477173 +[2026-10-05 17:29:36.516] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.517] [path_visualizer] [debug] current_cmd_angular_z:-0.17601289709130863 +[2026-10-05 17:29:36.567] [path_visualizer] [debug] current_pose_x:-2.9879249708669375, current_pose_y:5.0812542072775715,current_pose_yaw:1.7047630548477173 +[2026-10-05 17:29:36.567] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.567] [path_visualizer] [debug] current_cmd_angular_z:-0.17601289709130863 +[2026-10-05 17:29:36.616] [path_visualizer] [debug] current_pose_x:-2.988761948763194, current_pose_y:5.132283763899365,current_pose_yaw:1.6986491680145266 +[2026-10-05 17:29:36.616] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.617] [path_visualizer] [debug] current_cmd_angular_z:-0.16901362731499087 +[2026-10-05 17:29:36.666] [path_visualizer] [debug] current_pose_x:-2.988761948763194, current_pose_y:5.132283763899365,current_pose_yaw:1.6986491680145266 +[2026-10-05 17:29:36.666] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.666] [path_visualizer] [debug] current_cmd_angular_z:-0.16901362731499087 +[2026-10-05 17:29:36.716] [path_visualizer] [debug] current_pose_x:-2.988761948763194, current_pose_y:5.132283763899365,current_pose_yaw:1.6986491680145266 +[2026-10-05 17:29:36.716] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.716] [path_visualizer] [debug] current_cmd_angular_z:-0.16901362731499087 +[2026-10-05 17:29:36.766] [path_visualizer] [debug] current_pose_x:-2.989563642986897, current_pose_y:5.183278035062369,current_pose_yaw:1.6927807331085205 +[2026-10-05 17:29:36.767] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.767] [path_visualizer] [debug] current_cmd_angular_z:-0.16228512644348073 +[2026-10-05 17:29:36.816] [path_visualizer] [debug] current_pose_x:-2.989563642986897, current_pose_y:5.183278035062369,current_pose_yaw:1.6927807331085205 +[2026-10-05 17:29:36.816] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.816] [path_visualizer] [debug] current_cmd_angular_z:-0.16228512644348073 +[2026-10-05 17:29:36.866] [path_visualizer] [debug] current_pose_x:-2.989563642986897, current_pose_y:5.183278035062369,current_pose_yaw:1.6927807331085205 +[2026-10-05 17:29:36.866] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.867] [path_visualizer] [debug] current_cmd_angular_z:-0.16228512644348073 +[2026-10-05 17:29:36.916] [path_visualizer] [debug] current_pose_x:-2.990330043383391, current_pose_y:5.234240015932152,current_pose_yaw:1.687146544456482 +[2026-10-05 17:29:36.916] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.916] [path_visualizer] [debug] current_cmd_angular_z:-0.15580486910115637 +[2026-10-05 17:29:36.967] [path_visualizer] [debug] current_pose_x:-2.990330043383391, current_pose_y:5.234240015932152,current_pose_yaw:1.687146544456482 +[2026-10-05 17:29:36.967] [path_visualizer] [debug] current_path_x:-3.0026348497191395, current_path_y:5.17879636461563,current_path_yaw:1.570796327 +[2026-10-05 17:29:36.967] [path_visualizer] [debug] current_cmd_angular_z:-0.15580486910115637 +[2026-10-05 17:29:37.016] [path_visualizer] [debug] current_pose_x:-2.9910013464122858, current_pose_y:5.2851801983869855,current_pose_yaw:1.6816816329956057 +[2026-10-05 17:29:37.016] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.016] [path_visualizer] [debug] current_cmd_angular_z:-0.1490695719132242 +[2026-10-05 17:29:37.066] [path_visualizer] [debug] current_pose_x:-2.9910013464122858, current_pose_y:5.2851801983869855,current_pose_yaw:1.6816816329956057 +[2026-10-05 17:29:37.066] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.066] [path_visualizer] [debug] current_cmd_angular_z:-0.1490695719132242 +[2026-10-05 17:29:37.116] [path_visualizer] [debug] current_pose_x:-2.9910013464122858, current_pose_y:5.2851801983869855,current_pose_yaw:1.6816816329956057 +[2026-10-05 17:29:37.116] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.116] [path_visualizer] [debug] current_cmd_angular_z:-0.1490695719132242 +[2026-10-05 17:29:37.167] [path_visualizer] [debug] current_pose_x:-2.9917003329274023, current_pose_y:5.336084449812137,current_pose_yaw:1.6764923334121704 +[2026-10-05 17:29:37.167] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.167] [path_visualizer] [debug] current_cmd_angular_z:-0.14305828035251417 +[2026-10-05 17:29:37.217] [path_visualizer] [debug] current_pose_x:-2.9917003329274023, current_pose_y:5.336084449812137,current_pose_yaw:1.6764923334121704 +[2026-10-05 17:29:37.217] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.217] [path_visualizer] [debug] current_cmd_angular_z:-0.14305828035251417 +[2026-10-05 17:29:37.266] [path_visualizer] [debug] current_pose_x:-2.9924160846841894, current_pose_y:5.3868684485096106,current_pose_yaw:1.6715093851089478 +[2026-10-05 17:29:37.266] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.266] [path_visualizer] [debug] current_cmd_angular_z:-0.13756461030408174 +[2026-10-05 17:29:37.316] [path_visualizer] [debug] current_pose_x:-2.9924160846841894, current_pose_y:5.3868684485096106,current_pose_yaw:1.6715093851089478 +[2026-10-05 17:29:37.316] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.316] [path_visualizer] [debug] current_cmd_angular_z:-0.13756461030408174 +[2026-10-05 17:29:37.366] [path_visualizer] [debug] current_pose_x:-2.9924160846841894, current_pose_y:5.3868684485096106,current_pose_yaw:1.6715093851089478 +[2026-10-05 17:29:37.366] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.366] [path_visualizer] [debug] current_cmd_angular_z:-0.13756461030408174 +[2026-10-05 17:29:37.416] [path_visualizer] [debug] current_pose_x:-2.9930960580962314, current_pose_y:5.437619726339307,current_pose_yaw:1.6667267084121704 +[2026-10-05 17:29:37.416] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.417] [path_visualizer] [debug] current_cmd_angular_z:-0.1322480779695059 +[2026-10-05 17:29:37.466] [path_visualizer] [debug] current_pose_x:-2.9930960580962314, current_pose_y:5.437619726339307,current_pose_yaw:1.6667267084121704 +[2026-10-05 17:29:37.466] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.466] [path_visualizer] [debug] current_cmd_angular_z:-0.1322480779695059 +[2026-10-05 17:29:37.516] [path_visualizer] [debug] current_pose_x:-2.9930960580962314, current_pose_y:5.437619726339307,current_pose_yaw:1.6667267084121704 +[2026-10-05 17:29:37.516] [path_visualizer] [debug] current_path_x:-3.0026347938699827, current_path_y:5.377980821934779,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.516] [path_visualizer] [debug] current_cmd_angular_z:-0.1322480779695059 +[2026-10-05 17:29:37.566] [path_visualizer] [debug] current_pose_x:-2.9936924194820342, current_pose_y:5.488269563892073,current_pose_yaw:1.66214394569397 +[2026-10-05 17:29:37.566] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.566] [path_visualizer] [debug] current_cmd_angular_z:-0.12680938325804286 +[2026-10-05 17:29:37.616] [path_visualizer] [debug] current_pose_x:-2.9936924194820342, current_pose_y:5.488269563892073,current_pose_yaw:1.66214394569397 +[2026-10-05 17:29:37.616] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.617] [path_visualizer] [debug] current_cmd_angular_z:-0.12680938325804286 +[2026-10-05 17:29:37.666] [path_visualizer] [debug] current_pose_x:-2.994211674581209, current_pose_y:5.538913242933922,current_pose_yaw:1.657695531845093 +[2026-10-05 17:29:37.667] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.667] [path_visualizer] [debug] current_cmd_angular_z:-0.12115730247391579 +[2026-10-05 17:29:37.716] [path_visualizer] [debug] current_pose_x:-2.994211674581209, current_pose_y:5.538913242933922,current_pose_yaw:1.657695531845093 +[2026-10-05 17:29:37.716] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.717] [path_visualizer] [debug] current_cmd_angular_z:-0.12115730247391579 +[2026-10-05 17:29:37.766] [path_visualizer] [debug] current_pose_x:-2.994211674581209, current_pose_y:5.538913242933922,current_pose_yaw:1.657695531845093 +[2026-10-05 17:29:37.766] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.766] [path_visualizer] [debug] current_cmd_angular_z:-0.12115730247391579 +[2026-10-05 17:29:37.816] [path_visualizer] [debug] current_pose_x:-2.994765938742908, current_pose_y:5.589538698226226,current_pose_yaw:1.6534765958786013 +[2026-10-05 17:29:37.816] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.816] [path_visualizer] [debug] current_cmd_angular_z:-0.11618302016035913 +[2026-10-05 17:29:37.867] [path_visualizer] [debug] current_pose_x:-2.994765938742908, current_pose_y:5.589538698226226,current_pose_yaw:1.6534765958786013 +[2026-10-05 17:29:37.867] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.867] [path_visualizer] [debug] current_cmd_angular_z:-0.11618302016035913 +[2026-10-05 17:29:37.916] [path_visualizer] [debug] current_pose_x:-2.9952678296610937, current_pose_y:5.640155891760605,current_pose_yaw:1.6493979692459106 +[2026-10-05 17:29:37.916] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.916] [path_visualizer] [debug] current_cmd_angular_z:-0.11116214054999218 +[2026-10-05 17:29:37.966] [path_visualizer] [debug] current_pose_x:-2.9952678296610937, current_pose_y:5.640155891760605,current_pose_yaw:1.6493979692459106 +[2026-10-05 17:29:37.966] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:37.966] [path_visualizer] [debug] current_cmd_angular_z:-0.11116214054999218 +[2026-10-05 17:29:38.016] [path_visualizer] [debug] current_pose_x:-2.9952678296610937, current_pose_y:5.640155891760605,current_pose_yaw:1.6493979692459106 +[2026-10-05 17:29:38.016] [path_visualizer] [debug] current_path_x:-3.0026347380208263, current_path_y:5.577165279253926,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.016] [path_visualizer] [debug] current_cmd_angular_z:-0.11116214054999218 +[2026-10-05 17:29:38.066] [path_visualizer] [debug] current_pose_x:-2.995801422899521, current_pose_y:5.69075799862752,current_pose_yaw:1.645529270172119 +[2026-10-05 17:29:38.066] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.066] [path_visualizer] [debug] current_cmd_angular_z:-0.10675963875746747 +[2026-10-05 17:29:38.116] [path_visualizer] [debug] current_pose_x:-2.995801422899521, current_pose_y:5.69075799862752,current_pose_yaw:1.645529270172119 +[2026-10-05 17:29:38.116] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.116] [path_visualizer] [debug] current_cmd_angular_z:-0.10675963875746747 +[2026-10-05 17:29:38.166] [path_visualizer] [debug] current_pose_x:-2.995801422899521, current_pose_y:5.69075799862752,current_pose_yaw:1.645529270172119 +[2026-10-05 17:29:38.166] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.166] [path_visualizer] [debug] current_cmd_angular_z:-0.10675963875746747 +[2026-10-05 17:29:38.216] [path_visualizer] [debug] current_pose_x:-2.99632651183275, current_pose_y:5.741351012227087,current_pose_yaw:1.641824722290039 +[2026-10-05 17:29:38.216] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.216] [path_visualizer] [debug] current_cmd_angular_z:-0.10263200269163403 +[2026-10-05 17:29:38.266] [path_visualizer] [debug] current_pose_x:-2.99632651183275, current_pose_y:5.741351012227087,current_pose_yaw:1.641824722290039 +[2026-10-05 17:29:38.266] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.266] [path_visualizer] [debug] current_cmd_angular_z:-0.10263200269163403 +[2026-10-05 17:29:38.316] [path_visualizer] [debug] current_pose_x:-2.9967907196093595, current_pose_y:5.791937921751902,current_pose_yaw:1.6382303237915041 +[2026-10-05 17:29:38.316] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.316] [path_visualizer] [debug] current_cmd_angular_z:-0.09834424262647087 +[2026-10-05 17:29:38.366] [path_visualizer] [debug] current_pose_x:-2.9967907196093595, current_pose_y:5.791937921751902,current_pose_yaw:1.6382303237915041 +[2026-10-05 17:29:38.366] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.366] [path_visualizer] [debug] current_cmd_angular_z:-0.09834424262647087 +[2026-10-05 17:29:38.416] [path_visualizer] [debug] current_pose_x:-2.9967907196093595, current_pose_y:5.791937921751902,current_pose_yaw:1.6382303237915041 +[2026-10-05 17:29:38.417] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.417] [path_visualizer] [debug] current_cmd_angular_z:-0.09834424262647087 +[2026-10-05 17:29:38.466] [path_visualizer] [debug] current_pose_x:-2.9972715098702807, current_pose_y:5.842515746140872,current_pose_yaw:1.6348106861114504 +[2026-10-05 17:29:38.466] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.466] [path_visualizer] [debug] current_cmd_angular_z:-0.0945096758498236 +[2026-10-05 17:29:38.516] [path_visualizer] [debug] current_pose_x:-2.9972715098702807, current_pose_y:5.842515746140872,current_pose_yaw:1.6348106861114504 +[2026-10-05 17:29:38.516] [path_visualizer] [debug] current_path_x:-3.0026346821716694, current_path_y:5.776349736573074,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.516] [path_visualizer] [debug] current_cmd_angular_z:-0.0945096758498236 +[2026-10-05 17:29:38.566] [path_visualizer] [debug] current_pose_x:-2.9977026635703536, current_pose_y:5.89308610245137,current_pose_yaw:1.631498575210571 +[2026-10-05 17:29:38.566] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.566] [path_visualizer] [debug] current_cmd_angular_z:-0.09058033948438436 +[2026-10-05 17:29:38.616] [path_visualizer] [debug] current_pose_x:-2.9977026635703536, current_pose_y:5.89308610245137,current_pose_yaw:1.631498575210571 +[2026-10-05 17:29:38.617] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.617] [path_visualizer] [debug] current_cmd_angular_z:-0.09058033948438436 +[2026-10-05 17:29:38.666] [path_visualizer] [debug] current_pose_x:-2.9977026635703536, current_pose_y:5.89308610245137,current_pose_yaw:1.631498575210571 +[2026-10-05 17:29:38.666] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.666] [path_visualizer] [debug] current_cmd_angular_z:-0.09058033948438436 +[2026-10-05 17:29:38.716] [path_visualizer] [debug] current_pose_x:-2.998151124484636, current_pose_y:5.9436428960111,current_pose_yaw:1.6283496618270874 +[2026-10-05 17:29:38.716] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.716] [path_visualizer] [debug] current_cmd_angular_z:-0.08708524160143442 +[2026-10-05 17:29:38.766] [path_visualizer] [debug] current_pose_x:-2.998151124484636, current_pose_y:5.9436428960111,current_pose_yaw:1.6283496618270874 +[2026-10-05 17:29:38.766] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.767] [path_visualizer] [debug] current_cmd_angular_z:-0.08708524160143442 +[2026-10-05 17:29:38.816] [path_visualizer] [debug] current_pose_x:-2.998151124484636, current_pose_y:5.9436428960111,current_pose_yaw:1.6283496618270874 +[2026-10-05 17:29:38.816] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.816] [path_visualizer] [debug] current_cmd_angular_z:-0.08708524160143442 +[2026-10-05 17:29:38.866] [path_visualizer] [debug] current_pose_x:-2.998587950404657, current_pose_y:5.994189042267405,current_pose_yaw:1.6253305673599243 +[2026-10-05 17:29:38.866] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.866] [path_visualizer] [debug] current_cmd_angular_z:-0.08377709325106235 +[2026-10-05 17:29:38.916] [path_visualizer] [debug] current_pose_x:-2.998587950404657, current_pose_y:5.994189042267405,current_pose_yaw:1.6253305673599243 +[2026-10-05 17:29:38.916] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.916] [path_visualizer] [debug] current_cmd_angular_z:-0.08377709325106235 +[2026-10-05 17:29:38.966] [path_visualizer] [debug] current_pose_x:-2.9989726856478773, current_pose_y:6.04472917834176,current_pose_yaw:1.6223989725112915 +[2026-10-05 17:29:38.966] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:38.967] [path_visualizer] [debug] current_cmd_angular_z:-0.08031841147816599 +[2026-10-05 17:29:39.016] [path_visualizer] [debug] current_pose_x:-2.9989726856478773, current_pose_y:6.04472917834176,current_pose_yaw:1.6223989725112915 +[2026-10-05 17:29:39.016] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.016] [path_visualizer] [debug] current_cmd_angular_z:-0.08031841147816599 +[2026-10-05 17:29:39.066] [path_visualizer] [debug] current_pose_x:-2.9989726856478773, current_pose_y:6.04472917834176,current_pose_yaw:1.6223989725112915 +[2026-10-05 17:29:39.066] [path_visualizer] [debug] current_path_x:-3.002634626322513, current_path_y:5.975534193892221,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.066] [path_visualizer] [debug] current_cmd_angular_z:-0.08031841147816599 +[2026-10-05 17:29:39.116] [path_visualizer] [debug] current_pose_x:-2.9993690793129284, current_pose_y:6.095255548417686,current_pose_yaw:1.619608759880066 +[2026-10-05 17:29:39.116] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.116] [path_visualizer] [debug] current_cmd_angular_z:-0.07721572321707026 +[2026-10-05 17:29:39.167] [path_visualizer] [debug] current_pose_x:-2.9993690793129284, current_pose_y:6.095255548417686,current_pose_yaw:1.619608759880066 +[2026-10-05 17:29:39.167] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.167] [path_visualizer] [debug] current_cmd_angular_z:-0.07721572321707026 +[2026-10-05 17:29:39.216] [path_visualizer] [debug] current_pose_x:-2.999723268847518, current_pose_y:6.14577469225938,current_pose_yaw:1.6169047355651855 +[2026-10-05 17:29:39.216] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.216] [path_visualizer] [debug] current_cmd_angular_z:-0.07402130750925176 +[2026-10-05 17:29:39.266] [path_visualizer] [debug] current_pose_x:-2.999723268847518, current_pose_y:6.14577469225938,current_pose_yaw:1.6169047355651855 +[2026-10-05 17:29:39.266] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.267] [path_visualizer] [debug] current_cmd_angular_z:-0.07402130750925176 +[2026-10-05 17:29:39.316] [path_visualizer] [debug] current_pose_x:-2.999723268847518, current_pose_y:6.14577469225938,current_pose_yaw:1.6169047355651855 +[2026-10-05 17:29:39.316] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.316] [path_visualizer] [debug] current_cmd_angular_z:-0.07402130750925176 +[2026-10-05 17:29:39.366] [path_visualizer] [debug] current_pose_x:-3.0000901631375014, current_pose_y:6.196285664523929,current_pose_yaw:1.614332675933838 +[2026-10-05 17:29:39.366] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.366] [path_visualizer] [debug] current_cmd_angular_z:-0.07117023577368795 +[2026-10-05 17:29:39.416] [path_visualizer] [debug] current_pose_x:-3.0000901631375014, current_pose_y:6.196285664523929,current_pose_yaw:1.614332675933838 +[2026-10-05 17:29:39.416] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.417] [path_visualizer] [debug] current_cmd_angular_z:-0.07117023577368795 +[2026-10-05 17:29:39.466] [path_visualizer] [debug] current_pose_x:-3.0004463024780224, current_pose_y:6.246788041989179,current_pose_yaw:1.6118652820587158 +[2026-10-05 17:29:39.466] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.466] [path_visualizer] [debug] current_cmd_angular_z:-0.06846128835053973 +[2026-10-05 17:29:39.516] [path_visualizer] [debug] current_pose_x:-3.0004463024780224, current_pose_y:6.246788041989179,current_pose_yaw:1.6118652820587158 +[2026-10-05 17:29:39.516] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.517] [path_visualizer] [debug] current_cmd_angular_z:-0.06846128835053973 +[2026-10-05 17:29:39.566] [path_visualizer] [debug] current_pose_x:-3.0004463024780224, current_pose_y:6.246788041989179,current_pose_yaw:1.6118652820587158 +[2026-10-05 17:29:39.566] [path_visualizer] [debug] current_path_x:-3.002634570473356, current_path_y:6.17471865121137,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.566] [path_visualizer] [debug] current_cmd_angular_z:-0.06846128835053973 +[2026-10-05 17:29:39.616] [path_visualizer] [debug] current_pose_x:-3.0007865781763, current_pose_y:6.297282050565148,current_pose_yaw:1.6094934940338135 +[2026-10-05 17:29:39.616] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.616] [path_visualizer] [debug] current_cmd_angular_z:-0.06584476346297681 +[2026-10-05 17:29:39.666] [path_visualizer] [debug] current_pose_x:-3.0007865781763, current_pose_y:6.297282050565148,current_pose_yaw:1.6094934940338135 +[2026-10-05 17:29:39.666] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.666] [path_visualizer] [debug] current_cmd_angular_z:-0.06584476346297681 +[2026-10-05 17:29:39.717] [path_visualizer] [debug] current_pose_x:-3.0007865781763, current_pose_y:6.297282050565148,current_pose_yaw:1.6094934940338135 +[2026-10-05 17:29:39.717] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.717] [path_visualizer] [debug] current_cmd_angular_z:-0.06584476346297681 +[2026-10-05 17:29:39.766] [path_visualizer] [debug] current_pose_x:-3.0011088940911277, current_pose_y:6.347770997234168,current_pose_yaw:1.607211112976074 +[2026-10-05 17:29:39.767] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.767] [path_visualizer] [debug] current_cmd_angular_z:-0.06329446171474307 +[2026-10-05 17:29:39.816] [path_visualizer] [debug] current_pose_x:-3.0011088940911277, current_pose_y:6.347770997234168,current_pose_yaw:1.607211112976074 +[2026-10-05 17:29:39.816] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.816] [path_visualizer] [debug] current_cmd_angular_z:-0.06329446171474307 +[2026-10-05 17:29:39.866] [path_visualizer] [debug] current_pose_x:-3.001391649835028, current_pose_y:6.3982548126051775,current_pose_yaw:1.6049948930740356 +[2026-10-05 17:29:39.866] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.866] [path_visualizer] [debug] current_cmd_angular_z:-0.06062923694946913 +[2026-10-05 17:29:39.916] [path_visualizer] [debug] current_pose_x:-3.001391649835028, current_pose_y:6.3982548126051775,current_pose_yaw:1.6049948930740356 +[2026-10-05 17:29:39.917] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.917] [path_visualizer] [debug] current_cmd_angular_z:-0.06062923694946913 +[2026-10-05 17:29:39.967] [path_visualizer] [debug] current_pose_x:-3.001391649835028, current_pose_y:6.3982548126051775,current_pose_yaw:1.6049948930740356 +[2026-10-05 17:29:39.967] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:39.967] [path_visualizer] [debug] current_cmd_angular_z:-0.06062923694946913 +[2026-10-05 17:29:40.016] [path_visualizer] [debug] current_pose_x:-3.0016850602708702, current_pose_y:6.448729545256342,current_pose_yaw:1.6028869152069094 +[2026-10-05 17:29:40.016] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.016] [path_visualizer] [debug] current_cmd_angular_z:-0.05824709096290904 +[2026-10-05 17:29:40.066] [path_visualizer] [debug] current_pose_x:-3.0016850602708702, current_pose_y:6.448729545256342,current_pose_yaw:1.6028869152069094 +[2026-10-05 17:29:40.066] [path_visualizer] [debug] current_path_x:-3.0026345146241997, current_path_y:6.373903108530518,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.066] [path_visualizer] [debug] current_cmd_angular_z:-0.05824709096290904 +[2026-10-05 17:29:40.116] [path_visualizer] [debug] current_pose_x:-3.0019494881523334, current_pose_y:6.499200893504119,current_pose_yaw:1.6008465290069578 +[2026-10-05 17:29:40.116] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.116] [path_visualizer] [debug] current_cmd_angular_z:-0.055819339351307146 +[2026-10-05 17:29:40.166] [path_visualizer] [debug] current_pose_x:-3.0019494881523334, current_pose_y:6.499200893504119,current_pose_yaw:1.6008465290069578 +[2026-10-05 17:29:40.166] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.167] [path_visualizer] [debug] current_cmd_angular_z:-0.055819339351307146 +[2026-10-05 17:29:40.216] [path_visualizer] [debug] current_pose_x:-3.0019494881523334, current_pose_y:6.499200893504119,current_pose_yaw:1.6008465290069578 +[2026-10-05 17:29:40.216] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.216] [path_visualizer] [debug] current_cmd_angular_z:-0.055819339351307146 +[2026-10-05 17:29:40.266] [path_visualizer] [debug] current_pose_x:-3.0022587504376657, current_pose_y:6.549684364520676,current_pose_yaw:1.5989084243774416 +[2026-10-05 17:29:40.266] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.266] [path_visualizer] [debug] current_cmd_angular_z:-0.053876017946019705 +[2026-10-05 17:29:40.316] [path_visualizer] [debug] current_pose_x:-3.0022587504376657, current_pose_y:6.549684364520676,current_pose_yaw:1.5989084243774416 +[2026-10-05 17:29:40.316] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.316] [path_visualizer] [debug] current_cmd_angular_z:-0.053876017946019705 +[2026-10-05 17:29:40.367] [path_visualizer] [debug] current_pose_x:-3.0022587504376657, current_pose_y:6.549684364520676,current_pose_yaw:1.5989084243774416 +[2026-10-05 17:29:40.367] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.367] [path_visualizer] [debug] current_cmd_angular_z:-0.053876017946019705 +[2026-10-05 17:29:40.416] [path_visualizer] [debug] current_pose_x:-3.002568190151214, current_pose_y:6.600297174302515,current_pose_yaw:1.5970475673675537 +[2026-10-05 17:29:40.416] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.416] [path_visualizer] [debug] current_cmd_angular_z:-0.05208830180277727 +[2026-10-05 17:29:40.466] [path_visualizer] [debug] current_pose_x:-3.002568190151214, current_pose_y:6.600297174302515,current_pose_yaw:1.5970475673675537 +[2026-10-05 17:29:40.466] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.467] [path_visualizer] [debug] current_cmd_angular_z:-0.05208830180277727 +[2026-10-05 17:29:40.516] [path_visualizer] [debug] current_pose_x:-3.002819759631884, current_pose_y:6.650948754973832,current_pose_yaw:1.5952318906784058 +[2026-10-05 17:29:40.516] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.516] [path_visualizer] [debug] current_cmd_angular_z:-0.05002925757989802 +[2026-10-05 17:29:40.567] [path_visualizer] [debug] current_pose_x:-3.002819759631884, current_pose_y:6.650948754973832,current_pose_yaw:1.5952318906784058 +[2026-10-05 17:29:40.567] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.567] [path_visualizer] [debug] current_cmd_angular_z:-0.05002925757989802 +[2026-10-05 17:29:40.616] [path_visualizer] [debug] current_pose_x:-3.002819759631884, current_pose_y:6.650948754973832,current_pose_yaw:1.5952318906784058 +[2026-10-05 17:29:40.616] [path_visualizer] [debug] current_path_x:-3.002634458775043, current_path_y:6.573087565849665,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.616] [path_visualizer] [debug] current_cmd_angular_z:-0.05002925757989802 +[2026-10-05 17:29:40.666] [path_visualizer] [debug] current_pose_x:-3.0030652036455194, current_pose_y:6.701590503875453,current_pose_yaw:1.5934944152832031 +[2026-10-05 17:29:40.666] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.666] [path_visualizer] [debug] current_cmd_angular_z:-0.04808868074806186 +[2026-10-05 17:29:40.716] [path_visualizer] [debug] current_pose_x:-3.0030652036455194, current_pose_y:6.701590503875453,current_pose_yaw:1.5934944152832031 +[2026-10-05 17:29:40.717] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.717] [path_visualizer] [debug] current_cmd_angular_z:-0.04808868074806186 +[2026-10-05 17:29:40.766] [path_visualizer] [debug] current_pose_x:-3.0032805400878653, current_pose_y:6.752227210226845,current_pose_yaw:1.5918084383010864 +[2026-10-05 17:29:40.766] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.766] [path_visualizer] [debug] current_cmd_angular_z:-0.04606257851817692 +[2026-10-05 17:29:40.816] [path_visualizer] [debug] current_pose_x:-3.0032805400878653, current_pose_y:6.752227210226845,current_pose_yaw:1.5918084383010864 +[2026-10-05 17:29:40.816] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.816] [path_visualizer] [debug] current_cmd_angular_z:-0.04606257851817692 +[2026-10-05 17:29:40.866] [path_visualizer] [debug] current_pose_x:-3.0032805400878653, current_pose_y:6.752227210226845,current_pose_yaw:1.5918084383010864 +[2026-10-05 17:29:40.866] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.866] [path_visualizer] [debug] current_cmd_angular_z:-0.04606257851817692 +[2026-10-05 17:29:40.916] [path_visualizer] [debug] current_pose_x:-3.00350270505582, current_pose_y:6.802858991919425,current_pose_yaw:1.5902044773101807 +[2026-10-05 17:29:40.917] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.917] [path_visualizer] [debug] current_cmd_angular_z:-0.04424318556349234 +[2026-10-05 17:29:40.966] [path_visualizer] [debug] current_pose_x:-3.00350270505582, current_pose_y:6.802858991919425,current_pose_yaw:1.5902044773101807 +[2026-10-05 17:29:40.966] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:40.966] [path_visualizer] [debug] current_cmd_angular_z:-0.04424318556349234 +[2026-10-05 17:29:41.016] [path_visualizer] [debug] current_pose_x:-3.00350270505582, current_pose_y:6.802858991919425,current_pose_yaw:1.5902044773101807 +[2026-10-05 17:29:41.016] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.017] [path_visualizer] [debug] current_cmd_angular_z:-0.04424318556349234 +[2026-10-05 17:29:41.066] [path_visualizer] [debug] current_pose_x:-3.0037194195680015, current_pose_y:6.853487261897649,current_pose_yaw:1.5886671543121338 +[2026-10-05 17:29:41.066] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.066] [path_visualizer] [debug] current_cmd_angular_z:-0.042523002036460956 +[2026-10-05 17:29:41.116] [path_visualizer] [debug] current_pose_x:-3.0037194195680015, current_pose_y:6.853487261897649,current_pose_yaw:1.5886671543121338 +[2026-10-05 17:29:41.116] [path_visualizer] [debug] current_path_x:-3.0026344029258865, current_path_y:6.772272023168814,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.117] [path_visualizer] [debug] current_cmd_angular_z:-0.042523002036460956 +[2026-10-05 17:29:41.166] [path_visualizer] [debug] current_pose_x:-3.003910626913734, current_pose_y:6.904113206552932,current_pose_yaw:1.587175726890564 +[2026-10-05 17:29:41.166] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.166] [path_visualizer] [debug] current_cmd_angular_z:-0.04073553827482539 +[2026-10-05 17:29:41.216] [path_visualizer] [debug] current_pose_x:-3.003910626913734, current_pose_y:6.904113206552932,current_pose_yaw:1.587175726890564 +[2026-10-05 17:29:41.216] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.216] [path_visualizer] [debug] current_cmd_angular_z:-0.04073553827482539 +[2026-10-05 17:29:41.266] [path_visualizer] [debug] current_pose_x:-3.003910626913734, current_pose_y:6.904113206552932,current_pose_yaw:1.587175726890564 +[2026-10-05 17:29:41.266] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.266] [path_visualizer] [debug] current_cmd_angular_z:-0.04073553827482539 +[2026-10-05 17:29:41.316] [path_visualizer] [debug] current_pose_x:-3.0041081940070122, current_pose_y:6.954735865908149,current_pose_yaw:1.585756778717041 +[2026-10-05 17:29:41.316] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.316] [path_visualizer] [debug] current_cmd_angular_z:-0.039132430486026715 +[2026-10-05 17:29:41.366] [path_visualizer] [debug] current_pose_x:-3.0041081940070122, current_pose_y:6.954735865908149,current_pose_yaw:1.585756778717041 +[2026-10-05 17:29:41.366] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.366] [path_visualizer] [debug] current_cmd_angular_z:-0.039132430486026715 +[2026-10-05 17:29:41.416] [path_visualizer] [debug] current_pose_x:-3.0042863429954982, current_pose_y:7.005356402502238,current_pose_yaw:1.5843836069107056 +[2026-10-05 17:29:41.416] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.416] [path_visualizer] [debug] current_cmd_angular_z:-0.03749951133920659 +[2026-10-05 17:29:41.466] [path_visualizer] [debug] current_pose_x:-3.0042863429954982, current_pose_y:7.005356402502238,current_pose_yaw:1.5843836069107056 +[2026-10-05 17:29:41.466] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.467] [path_visualizer] [debug] current_cmd_angular_z:-0.03749951133920659 +[2026-10-05 17:29:41.516] [path_visualizer] [debug] current_pose_x:-3.0042863429954982, current_pose_y:7.005356402502238,current_pose_yaw:1.5843836069107056 +[2026-10-05 17:29:41.516] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.516] [path_visualizer] [debug] current_cmd_angular_z:-0.03749951133920659 +[2026-10-05 17:29:41.566] [path_visualizer] [debug] current_pose_x:-3.004470437586182, current_pose_y:7.05597409287106,current_pose_yaw:1.583077073097229 +[2026-10-05 17:29:41.566] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.566] [path_visualizer] [debug] current_cmd_angular_z:-0.03603702628698874 +[2026-10-05 17:29:41.616] [path_visualizer] [debug] current_pose_x:-3.004470437586182, current_pose_y:7.05597409287106,current_pose_yaw:1.583077073097229 +[2026-10-05 17:29:41.616] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.616] [path_visualizer] [debug] current_cmd_angular_z:-0.03603702628698874 +[2026-10-05 17:29:41.666] [path_visualizer] [debug] current_pose_x:-3.004470437586182, current_pose_y:7.05597409287106,current_pose_yaw:1.583077073097229 +[2026-10-05 17:29:41.666] [path_visualizer] [debug] current_path_x:-3.0026343470767296, current_path_y:6.97145648048796,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.666] [path_visualizer] [debug] current_cmd_angular_z:-0.03603702628698874 +[2026-10-05 17:29:41.716] [path_visualizer] [debug] current_pose_x:-3.0046480748914535, current_pose_y:7.106589529017158,current_pose_yaw:1.5818231105804443 +[2026-10-05 17:29:41.716] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.716] [path_visualizer] [debug] current_cmd_angular_z:-0.034639673605289925 +[2026-10-05 17:29:41.766] [path_visualizer] [debug] current_pose_x:-3.0046480748914535, current_pose_y:7.106589529017158,current_pose_yaw:1.5818231105804443 +[2026-10-05 17:29:41.767] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.767] [path_visualizer] [debug] current_cmd_angular_z:-0.034639673605289925 +[2026-10-05 17:29:41.816] [path_visualizer] [debug] current_pose_x:-3.0048048098768896, current_pose_y:7.157203263737781,current_pose_yaw:1.5806063413619995 +[2026-10-05 17:29:41.816] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.816] [path_visualizer] [debug] current_cmd_angular_z:-0.03318571828950829 +[2026-10-05 17:29:41.867] [path_visualizer] [debug] current_pose_x:-3.0048048098768896, current_pose_y:7.157203263737781,current_pose_yaw:1.5806063413619995 +[2026-10-05 17:29:41.867] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.867] [path_visualizer] [debug] current_cmd_angular_z:-0.03318571828950829 +[2026-10-05 17:29:41.916] [path_visualizer] [debug] current_pose_x:-3.0048048098768896, current_pose_y:7.157203263737781,current_pose_yaw:1.5806063413619995 +[2026-10-05 17:29:41.917] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.917] [path_visualizer] [debug] current_cmd_angular_z:-0.03318571828950829 +[2026-10-05 17:29:41.966] [path_visualizer] [debug] current_pose_x:-3.0049656860658382, current_pose_y:7.207814633883954,current_pose_yaw:1.579447627067566 +[2026-10-05 17:29:41.966] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:41.966] [path_visualizer] [debug] current_cmd_angular_z:-0.031873753373678884 +[2026-10-05 17:29:42.016] [path_visualizer] [debug] current_pose_x:-3.0049656860658382, current_pose_y:7.207814633883954,current_pose_yaw:1.579447627067566 +[2026-10-05 17:29:42.016] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.016] [path_visualizer] [debug] current_cmd_angular_z:-0.031873753373678884 +[2026-10-05 17:29:42.066] [path_visualizer] [debug] current_pose_x:-3.0051105187601, current_pose_y:7.25842434253636,current_pose_yaw:1.5783261060714724 +[2026-10-05 17:29:42.066] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.066] [path_visualizer] [debug] current_cmd_angular_z:-0.030535902882172714 +[2026-10-05 17:29:42.116] [path_visualizer] [debug] current_pose_x:-3.0051105187601, current_pose_y:7.25842434253636,current_pose_yaw:1.5783261060714724 +[2026-10-05 17:29:42.116] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.116] [path_visualizer] [debug] current_cmd_angular_z:-0.030535902882172714 +[2026-10-05 17:29:42.166] [path_visualizer] [debug] current_pose_x:-3.0051105187601, current_pose_y:7.25842434253636,current_pose_yaw:1.5783261060714724 +[2026-10-05 17:29:42.166] [path_visualizer] [debug] current_path_x:-3.002634291227573, current_path_y:7.170640937807108,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.166] [path_visualizer] [debug] current_cmd_angular_z:-0.030535902882172714 +[2026-10-05 17:29:42.216] [path_visualizer] [debug] current_pose_x:-3.0052627555698606, current_pose_y:7.309032351970874,current_pose_yaw:1.5772613286972046 +[2026-10-05 17:29:42.216] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.216] [path_visualizer] [debug] current_cmd_angular_z:-0.029358162299411523 +[2026-10-05 17:29:42.266] [path_visualizer] [debug] current_pose_x:-3.0052627555698606, current_pose_y:7.309032351970874,current_pose_yaw:1.5772613286972046 +[2026-10-05 17:29:42.266] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.266] [path_visualizer] [debug] current_cmd_angular_z:-0.029358162299411523 +[2026-10-05 17:29:42.316] [path_visualizer] [debug] current_pose_x:-3.0052627555698606, current_pose_y:7.309032351970874,current_pose_yaw:1.5772613286972046 +[2026-10-05 17:29:42.316] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.316] [path_visualizer] [debug] current_cmd_angular_z:-0.029358162299411523 +[2026-10-05 17:29:42.366] [path_visualizer] [debug] current_pose_x:-3.005438945628256, current_pose_y:7.35962452657747,current_pose_yaw:1.5762510299682617 +[2026-10-05 17:29:42.366] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.366] [path_visualizer] [debug] current_cmd_angular_z:-0.028438732794314046 +[2026-10-05 17:29:42.416] [path_visualizer] [debug] current_pose_x:-3.005438945628256, current_pose_y:7.35962452657747,current_pose_yaw:1.5762510299682617 +[2026-10-05 17:29:42.417] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.417] [path_visualizer] [debug] current_cmd_angular_z:-0.028438732794314046 +[2026-10-05 17:29:42.466] [path_visualizer] [debug] current_pose_x:-3.0057075092718915, current_pose_y:7.410156923359338,current_pose_yaw:1.575313210487366 +[2026-10-05 17:29:42.466] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.466] [path_visualizer] [debug] current_cmd_angular_z:-0.0282415811197775 +[2026-10-05 17:29:42.516] [path_visualizer] [debug] current_pose_x:-3.0057075092718915, current_pose_y:7.410156923359338,current_pose_yaw:1.575313210487366 +[2026-10-05 17:29:42.516] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.516] [path_visualizer] [debug] current_cmd_angular_z:-0.0282415811197775 +[2026-10-05 17:29:42.566] [path_visualizer] [debug] current_pose_x:-3.0057075092718915, current_pose_y:7.410156923359338,current_pose_yaw:1.575313210487366 +[2026-10-05 17:29:42.566] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.566] [path_visualizer] [debug] current_cmd_angular_z:-0.0282415811197775 +[2026-10-05 17:29:42.616] [path_visualizer] [debug] current_pose_x:-3.0058453631666935, current_pose_y:7.460761596569965,current_pose_yaw:1.574366331100464 +[2026-10-05 17:29:42.616] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.616] [path_visualizer] [debug] current_cmd_angular_z:-0.027209388352199246 +[2026-10-05 17:29:42.666] [path_visualizer] [debug] current_pose_x:-3.0058453631666935, current_pose_y:7.460761596569965,current_pose_yaw:1.574366331100464 +[2026-10-05 17:29:42.666] [path_visualizer] [debug] current_path_x:-3.0026342353784163, current_path_y:7.369825395126257,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.666] [path_visualizer] [debug] current_cmd_angular_z:-0.027209388352199246 +[2026-10-05 17:29:42.716] [path_visualizer] [debug] current_pose_x:-3.0059296382102794, current_pose_y:7.511380595278514,current_pose_yaw:1.5734249353408811 +[2026-10-05 17:29:42.716] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.716] [path_visualizer] [debug] current_cmd_angular_z:-0.02585365148345284 +[2026-10-05 17:29:42.766] [path_visualizer] [debug] current_pose_x:-3.0059296382102794, current_pose_y:7.511380595278514,current_pose_yaw:1.5734249353408811 +[2026-10-05 17:29:42.766] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.767] [path_visualizer] [debug] current_cmd_angular_z:-0.02585365148345284 +[2026-10-05 17:29:42.816] [path_visualizer] [debug] current_pose_x:-3.0059296382102794, current_pose_y:7.511380595278514,current_pose_yaw:1.5734249353408811 +[2026-10-05 17:29:42.816] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.817] [path_visualizer] [debug] current_cmd_angular_z:-0.02585365148345284 +[2026-10-05 17:29:42.866] [path_visualizer] [debug] current_pose_x:-3.0060503402519227, current_pose_y:7.561975541589007,current_pose_yaw:1.5725396871566772 +[2026-10-05 17:29:42.866] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.866] [path_visualizer] [debug] current_cmd_angular_z:-0.02483752206781197 +[2026-10-05 17:29:42.916] [path_visualizer] [debug] current_pose_x:-3.0060503402519227, current_pose_y:7.561975541589007,current_pose_yaw:1.5725396871566772 +[2026-10-05 17:29:42.916] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.916] [path_visualizer] [debug] current_cmd_angular_z:-0.02483752206781197 +[2026-10-05 17:29:42.966] [path_visualizer] [debug] current_pose_x:-3.0060503402519227, current_pose_y:7.561975541589007,current_pose_yaw:1.5725396871566772 +[2026-10-05 17:29:42.967] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:42.967] [path_visualizer] [debug] current_cmd_angular_z:-0.02483752206781197 +[2026-10-05 17:29:43.016] [path_visualizer] [debug] current_pose_x:-3.0061838504739766, current_pose_y:7.612562496163831,current_pose_yaw:1.5717004537582397 +[2026-10-05 17:29:43.017] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:43.017] [path_visualizer] [debug] current_cmd_angular_z:-0.023993469378914858 +[2026-10-05 17:29:43.066] [path_visualizer] [debug] current_pose_x:-3.0061838504739766, current_pose_y:7.612562496163831,current_pose_yaw:1.5717004537582397 +[2026-10-05 17:29:43.066] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:43.066] [path_visualizer] [debug] current_cmd_angular_z:-0.023993469378914858 +[2026-10-05 17:29:43.116] [path_visualizer] [debug] current_pose_x:-3.0063135278401227, current_pose_y:7.663143039478612,current_pose_yaw:1.5708907842636108 +[2026-10-05 17:29:43.116] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:43.116] [path_visualizer] [debug] current_cmd_angular_z:-0.02318458800994788 +[2026-10-05 17:29:43.166] [path_visualizer] [debug] current_pose_x:-3.0063135278401227, current_pose_y:7.663143039478612,current_pose_yaw:1.5708907842636108 +[2026-10-05 17:29:43.166] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:43.166] [path_visualizer] [debug] current_cmd_angular_z:-0.02318458800994788 +[2026-10-05 17:29:43.216] [path_visualizer] [debug] current_pose_x:-3.0063135278401227, current_pose_y:7.663143039478612,current_pose_yaw:1.5708907842636108 +[2026-10-05 17:29:43.216] [path_visualizer] [debug] current_path_x:-3.00263417952926, current_path_y:7.569009852445404,current_path_yaw:1.570796327 +[2026-10-05 17:29:43.216] [path_visualizer] [debug] current_cmd_angular_z:-0.02318458800994788 +[2026-10-05 17:29:43.266] [path_visualizer] [debug] current_pose_x:-3.0064544697503397, current_pose_y:7.7137222869574895,current_pose_yaw:1.5701225996017458 +[2026-10-05 17:29:43.266] [path_visualizer] [debug] current_path_x:-3.002634123680103, current_path_y:7.768194309764552,current_path_yaw:1.570796327 +[2026-10-05 17:29:43.266] [path_visualizer] [debug] current_cmd_angular_z:-0.02252942461789793 diff --git a/rviz2.jpg b/rviz2.jpg deleted file mode 100644 index 961eac3..0000000 Binary files a/rviz2.jpg and /dev/null differ diff --git a/src/webots_simulation/include/sweet_webots_robot/PathVisualizer.hpp b/src/webots_simulation/include/sweet_webots_robot/PathVisualizer.hpp index d60a864..f7d5211 100644 --- a/src/webots_simulation/include/sweet_webots_robot/PathVisualizer.hpp +++ b/src/webots_simulation/include/sweet_webots_robot/PathVisualizer.hpp @@ -23,6 +23,11 @@ #include #include +#include +#include +#include +#include + class PathVisualizer : public rclcpp::Node { public: @@ -38,6 +43,8 @@ private: double w); double normalize_angle(double angle); bool downloadPathJson(const std::string &url,std::string &json_data); + bool downloadPathJson(const std::string &file_path,std::string &json_data, + bool is_local_file); bool loadPathFromJson(const std::string &json_data); double gps_to_x(double lat,double lon); @@ -100,8 +107,8 @@ private: bool has_pose_; // contorl paramss double max_speed_ = 0.8; - double max_yaw_rate_ = 2.0; - double lookahead_distance_ =0.6; + double max_yaw_rate_ = 5.0; + double lookahead_distance_ =0.4; double max_interval_distance_ = 0.2; double origin_lat_; double origin_lon_; @@ -110,13 +117,22 @@ private: int forward_index_limit_=100; int path_track_index_ = -1; + // stanley parametres + double k_yaw_ = 1.0; + double k_lat_ = 1.0; + bool origin_set_= false; bool path_transed = false; + std::string file_path_; std::string file_name_; std::string path_url_ ; std::string json_data_; std::unique_ptr geodetic_converter_; + + // logger + std::shared_ptr logger_; + }; #endif diff --git a/src/webots_simulation/src/PathVisualizer.cpp b/src/webots_simulation/src/PathVisualizer.cpp index d5e5615..f97902b 100644 --- a/src/webots_simulation/src/PathVisualizer.cpp +++ b/src/webots_simulation/src/PathVisualizer.cpp @@ -1,5 +1,7 @@ #include "sweet_webots_robot/PathVisualizer.hpp" + + PathVisualizer::PathVisualizer(const std::string& file_name): Node("path_visualizer"), target_index_(0), @@ -7,6 +9,7 @@ has_pose_(false) { file_name_ = file_name; path_url_ = "https://test.sweetai.cn:4433/load/locationCmdPath/" + file_name_; + file_path_ = "/home/sweetai/auto_drive_misson_center_webots_simulation/test_path.json"; RCLCPP_INFO(this->get_logger(),"PathVisualizer started"); // pub cmd_pub_ = this->create_publisher("/twist_cmd_vel",10); @@ -39,9 +42,35 @@ has_pose_(false) // urdf pose tf_broadcaster_ = std::make_unique(*this); // path get - downloadPathJson(path_url_,json_data_); + downloadPathJson(file_path_,json_data_,true); loadPathFromJson(json_data_); + // logger初始化 + auto console_sink = + std::make_shared(); + + // 每次启动时清空原文件 + auto file_sink = + std::make_shared( + "./path_visualizer.log", + true // truncate：清空原文件 + ); + + std::vector sinks{ + console_sink, + file_sink + }; + + logger_ = std::make_shared( + "path_visualizer", + sinks.begin(), + sinks.end() + ); + + logger_->set_level(spdlog::level::debug); + + logger_->info("PathVisualizer started"); + } using json = nlohmann::json; @@ -122,6 +151,60 @@ void PathVisualizer::transformPathToVehicleStart(double vehicle_initial_yaw) } } + +#include +#include +#include + +bool PathVisualizer::downloadPathJson(const std::string &file_path, + std::string &json_data, + bool is_local_file) +{ + json_data.clear(); + + // 打开本地 JSON 文件 + std::ifstream file(file_path); + if (!file.is_open()) + { + RCLCPP_ERROR( + this->get_logger(), + "Failed to open JSON file: %s", + file_path.c_str()); + return false; + } + + // 读取文件全部内容 + std::stringstream buffer; + buffer << file.rdbuf(); + + if (file.bad()) + { + RCLCPP_ERROR( + this->get_logger(), + "Failed to read JSON file: %s", + file_path.c_str()); + return false; + } + + json_data = buffer.str(); + + if (json_data.empty()) + { + RCLCPP_ERROR( + this->get_logger(), + "JSON file is empty: %s", + file_path.c_str()); + return false; + } + + RCLCPP_INFO( + this->get_logger(), + "Path JSON loaded successfully, size = %zu, path = %s", + json_data.size(), + file_path.c_str()); + + return true; +} bool PathVisualizer::downloadPathJson(const std::string &url, std::string &json_data) { @@ -171,6 +254,16 @@ bool PathVisualizer::loadPathFromJson( { // 解析 JSON json data =json::parse(json_data); + // 检查 properties + if (!data.contains("properties") || + !data["properties"].is_object()) + { + RCLCPP_ERROR(this->get_logger(),"JSON does not contain valid properties"); + return false; + } + max_speed_ = data["properties"]["misionSpeed"].get(); + k_yaw_ = data["properties"]["k_yaw"].get(); + k_lat_ = data["properties"]["k_lat"].get(); // 检查 features if (!data.contains("features") || !data["features"].is_array() || @@ -601,10 +694,11 @@ void PathVisualizer::control(){ "control has not pose."); return; } - + double speed=max_speed_; publishVehicleInfoRviz(); publishLocalPose(); target_index_= findClosestPoint(forward_index_limit_); + int current_index = target_index_; int target =findLookAheadPoint(); double target_x =path_x_[target]; @@ -617,15 +711,41 @@ void PathVisualizer::control(){ double local_x =cos(yaw_)*dx+sin(yaw_)*dy; double local_y =-sin(yaw_)*dx+cos(yaw_)*dy; + double target_angle = std::atan2(dy, dx); + double alpha = target_angle - yaw_; + while (alpha > M_PI) alpha -= 2 * M_PI; + while (alpha < -M_PI) alpha += 2 * M_PI; + /*Pure Pursuit*/ - double Ld =sqrt(local_x*local_x+local_y*local_y); - double curvature =2.0*local_y/(Ld*Ld); + // double Ld =sqrt(local_x*local_x+local_y*local_y); + // double w_cmd =2.0*speed*sin(alpha)/(Ld); + + /*Stanley*/ + double curent_path_x = path_x_[current_index]; + double curent_path_y = path_y_[current_index]; + double current_path_yaw =path_yaw_[current_index]; + alpha = current_path_yaw - yaw_; + while (alpha > M_PI) alpha -= 2 * M_PI; + while (alpha < -M_PI) alpha += 2 * M_PI; + + double dx_path = x_ - curent_path_x; + double dy_path = y_ - curent_path_y; + double error_lat = -dx_path * sin(current_path_yaw) + dy_path * cos(current_path_yaw); + double w_cmd =k_yaw_ * alpha - k_lat_ * std::atan2(error_lat,speed); geometry_msgs::msg::Twist cmd; - double speed=max_speed_; - cmd.linear.x =speed; - cmd.angular.z =speed*curvature; + logger_->debug("current_pose_x:{}, current_pose_y:{},current_pose_yaw:{}", + x_, y_,yaw_ + ); + logger_->debug("current_path_x:{}, current_path_y:{},current_path_yaw:{}", + curent_path_x, + curent_path_y, + current_path_yaw + ); + cmd.linear.x = speed; + cmd.angular.z = w_cmd; + if(cmd.angular.z >max_yaw_rate_) { @@ -637,7 +757,8 @@ void PathVisualizer::control(){ cmd.angular.z=-max_yaw_rate_; } - //cmd_pub_->publish(cmd); + cmd_pub_->publish(cmd); + logger_->debug("current_cmd_angular_z:{}",cmd.angular.z); // RCLCPP_INFO_THROTTLE( // this->get_logger(), diff --git a/test_path.json b/test_path.json new file mode 100644 index 0000000..567b61a --- /dev/null +++ b/test_path.json @@ -0,0 +1,131 @@ +{ + "type": "FeatureCollection", + "properties": { + "turnRadius": 1.0, + "misionSpeed": 0.64, + "k_yaw": 2.0, + "k_lat": 4.0 + }, + "features": [ + { + "type": "Feature", + "properties": { + "turnInds": [ + 1, + 13 + ], + "mission": [] + }, + "geometry": { + "type": "LineString", + "coordinates": [ + [ + 30.800621004223, + 121.215415999929, + 0.0 + ], + [ + 30.800621004223, + 121.215478749384, + 0.0 + ], + [ + 30.800621368104, + 121.215481695811, + 0.285599332 + ], + [ + 30.800622430267, + 121.215484403537, + 0.571198664 + ], + [ + 30.800624104662, + 121.215486653196, + 0.856797996 + ], + [ + 30.80062625564, + 121.215488262536, + 1.142397329 + ], + [ + 30.80062870894, + 121.215489101177, + 1.427996661 + ], + [ + 30.800631265812, + 121.215489101177, + 1.713595993 + ], + [ + 30.800633719113, + 121.215488262536, + 1.999195325 + ], + [ + 30.80063587009, + 121.215486653196, + 2.284794657 + ], + [ + 30.800637544485, + 121.215484403537, + 2.570393989 + ], + [ + 30.800638606648, + 121.215481695811, + 2.855993321 + ], + [ + 30.800638970529, + 121.215478749384, + 3.141592654 + ], + [ + 30.800638970529, + 121.215395083444, + 3.141592654 + ], + [ + 30.800639276622, + 121.215392376652, + 2.879793266 + ], + [ + 30.800640174043, + 121.215389854323, + 2.617993878 + ], + [ + 30.800641601633, + 121.21538768835, + 2.35619449 + ], + [ + 30.800643462105, + 121.21538602634, + 2.094395102 + ], + [ + 30.800645628671, + 121.215384981558, + 1.832595715 + ], + [ + 30.800647953682, + 121.215384625202, + 1.570796327 + ], + [ + 30.800692869446, + 121.215384625202, + 1.570796327 + ] + ] + } + } + ] +} \ No newline at end of file