Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
26 commits
Select commit Hold shift + click to select a range
b36e527
更改了文件结构,使目录更清晰
manayume Dec 18, 2025
6a5d1b2
Merge branch 'OpenHUTB:main' into main
manayume Dec 18, 2025
a06e6c6
Merge branch 'OpenHUTB:main' into main
manayume Dec 18, 2025
b65d3c1
修改概述:
manayume Dec 18, 2025
01c0362
删除了错误的模型文件,优化了目录结构,更新了README文件中的启动流程和文件目录
manayume Dec 18, 2025
073c89a
Merge branch 'OpenHUTB:main' into main
manayume Dec 18, 2025
a989876
Merge branch 'OpenHUTB:main' into main
manayume Dec 18, 2025
436db46
Merge branch 'OpenHUTB:main' into main
manayume Dec 18, 2025
2bc6795
Merge branch 'OpenHUTB:main' into main
manayume Dec 18, 2025
66065b8
修复了视角卡顿的问题,调整了视角跟随高度角度
manayume Dec 18, 2025
fa06246
Merge branch 'OpenHUTB:main' into main
manayume Dec 19, 2025
856e574
新增了可调参数,可以改变路径显示的颜色和亮度,减少“光污染”
manayume Dec 19, 2025
1a9a29b
修复了更换起点后车辆朝向错误的问题
manayume Dec 19, 2025
4e94a0d
Merge branch 'OpenHUTB:main' into main
manayume Dec 19, 2025
d4519a9
Finish merging manually
manayume Dec 19, 2025
879bf5d
Merge branch 'OpenHUTB:main' into main
manayume Dec 19, 2025
deab24c
使用ros封装项目,将原python文件放入python文件夹
manayume Dec 19, 2025
0ac0daa
Revert "使用ros封装项目,将原python文件放入python文件夹"
manayume Dec 20, 2025
4ba61c5
Merge branch 'OpenHUTB:main' into main
manayume Dec 20, 2025
9877a06
Merge branch 'OpenHUTB:main' into main
manayume Dec 20, 2025
64a9fa1
将代码封装为ros节点
manayume Dec 20, 2025
cc409bc
Merge branch 'OpenHUTB:main' into main
manayume Dec 20, 2025
25edb1e
Merge branch 'OpenHUTB:main' into main
manayume Dec 21, 2025
d1636a9
修复了ros控制端输入命令服务端无法接收到命令的问题
manayume Dec 21, 2025
b2d40c2
Merge branch 'OpenHUTB:main' into main
manayume Dec 21, 2025
6ed4c69
加入了统计实时数据并画出统计图的功能,能更加直观的看到车辆的各项数据变化
manayume Dec 21, 2025
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Original file line number Diff line number Diff line change
Expand Up @@ -4,6 +4,7 @@
import os
import sys
import random
import config as cfg

try:
sys.path.append(glob.glob('../carla/dist/carla-*%d.%d-%s.egg' % (
Expand All @@ -13,12 +14,13 @@
except IndexError:
pass

# 获取当前文件的目录
# 获取当前文件目录
current_dir = os.path.dirname(os.path.abspath(__file__))
# 获取父目录
parent_dir = os.path.dirname(current_dir)
# 将父目录添加到系统路径
sys.path.append(parent_dir)
# 构建可能的路径
possible_paths = os.path.join(current_dir, '..', 'carla_ros_ws', 'src','carla_autonomous')
# 找到第一个存在的路径并添加
abs_path = os.path.abspath(possible_paths)
sys.path.insert(0, abs_path)
from agents.navigation.global_route_planner import GlobalRoutePlanner

import carla
Expand Down Expand Up @@ -413,6 +415,7 @@ def process_images(self):


self.distance = min(dis, dis_ped)
self.actual_distance = min(dis, dis_ped) # 保存实际距离

return dis

Expand Down Expand Up @@ -486,7 +489,16 @@ def step(self, action, current_state):
signed_dis = 0

current_state[3] = current_state[3]/15


if hasattr(self, 'actual_distance'):
actual_obstacle_distance = self.actual_distance
else:
actual_obstacle_distance = 0

print(f"Obstacle Distance: {actual_obstacle_distance:.2f}m")
print(f"Angle Error: {phi:.2f}°, Lateral Error: {signed_dis:.2f}m")
print(f"Speed: {kmh:.2f}km/h, Action: {cfg.ACTION_NAMES[action]}")

print(f"角度差: {phi:.2f}°, 横向偏差: {signed_dis:.2f}m")
print(f"距离障碍物: {current_state[0]*300+300:.2f}m")
print(f"速度: {(current_state[1]+current_state[0])*30+30:.2f}km/h")
Expand Down Expand Up @@ -515,15 +527,12 @@ def step(self, action, current_state):
reward = 1000
print("✅ 成功到达终点!")

# 超时检查
if self.episode_start + 200 < time.time():
done = True
print("⏰ 超时")

print(f"奖励: {reward}")

# 返回新的状态、奖励、完成标志和当前路径点
return [(self.distance-300)/300, (kmh-30)/30-(self.distance-300)/300, phi, signed_dis*15], reward, done, current_waypoint
norm_distance = (self.actual_distance - 300) / 300 if hasattr(self, 'actual_distance') else 0
return [norm_distance, (kmh-30)/30-norm_distance, phi, signed_dis*15], reward, done, current_waypoint

def trajectory(self, draw = False):

amap = self.world.get_map()
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -6,7 +6,7 @@
TRAJECTORIES = {
"custom_trajectory": {
"start": [108.91605377197266,101.3561782836914,0.6136533617973328, 0],
"end": [74.64781951904297,-56.014076232910156,0.40768954157829285],
"end": [62.20726013183594,-68.12548065185547,0.7430136203765869],
"description": "自定义轨迹 - 城镇道路"
},
"test_trajectory": {
Expand All @@ -32,7 +32,7 @@ def get_current_trajectory():
# 设置基础路径
current_dir = os.path.dirname(os.path.abspath(__file__))
base_dir = os.path.dirname(current_dir) # 上一级目录
MODELS_DIR = os.path.join(base_dir, 'models')
MODELS_DIR = os.path.join(base_dir, 'carla_ros_ws/src/carla_autonomous/models')
braking = os.path.join(MODELS_DIR, 'Braking___282.model')
driving = os.path.join(MODELS_DIR, 'Driving__6030.model')
MODEL_PATHS = {
Expand Down Expand Up @@ -126,6 +126,21 @@ def get_current_trajectory():
CAMERA_WIDTH = 640
CAMERA_HEIGHT = 480
CAMERA_FOV = 40
# ==================== 数据收集配置 ====================
ENABLE_DATA_COLLECTION = True # 是否启用数据收集
DATA_SAVE_DIR = "data_logs" # 数据保存目录
ENABLE_PLOTTING = True # 是否生成图表
PLOT_DPI = 150 # 图表DPI
AUTO_OPEN_PLOTS = False # 是否自动打开图表(可能不支持无GUI环境)

# 数据采样率(1表示记录每一步,2表示每两步记录一次等)
DATA_SAMPLING_RATE = 1


# ==================== 图表字体配置 ====================
CHART_FONT_FAMILY = 'SimHei' # 默认字体
CHART_FONT_SIZE = 12
ENABLE_CHINESE_FONT = True

def print_config():
"""打印当前配置"""
Expand Down Expand Up @@ -161,4 +176,10 @@ def print_config():
print(f" 固定时间步长: {FIXED_DELTA_SECONDS}s")
print(f" 同步模式: {'开启' if SYNCHRONOUS_MODE else '关闭'}")

print("数据收集配置\n")
print(f"数据收集: {'启用' if ENABLE_DATA_COLLECTION else '禁用'}")
print(f"图表生成: {'启用' if ENABLE_PLOTTING else '禁用'}")
print(f"数据保存目录: {DATA_SAVE_DIR}")
print(f"数据采样率: 每{DATA_SAMPLING_RATE}步记录一次")

print("="*60)
Loading
Loading