diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/README.md b/src/Autonomous_vehicle_navigation_using_deep_learning_master/README.md index 3a90822a45..4940205df8 100644 --- a/src/Autonomous_vehicle_navigation_using_deep_learning_master/README.md +++ b/src/Autonomous_vehicle_navigation_using_deep_learning_master/README.md @@ -26,20 +26,54 @@ pip install -r requirements.txt 3. **运行主程序**: ```bash +cd main python main.py ``` +4. **运行测试程序**: +```bash +cd test +python test_driving.py +``` ## 项目结构 ``` -├── main.py # 主程序入口 -├── config.py # 配置文件 -├── get_location.py # 位置坐标获取工具 -├── test_braking.py # 刹车模型测试 -├── test_driving.py # 驾驶模型测试 -├── pedestrians_1.py # 行人生成器1 -├── pedestrians_2.py # 行人生成器2 -└── requirements.txt # 依赖包列表 +│ README.md +│ requirements.txt +├─agents +│ │ __init__.py +│ ├─navigation +│ │ basic_agent.py +│ │ behavior_agent.py +│ │ behavior_types.py +│ │ controller.py +│ │ global_route_planner.py +│ │ local_planner.py +│ │ __init__.py +│ └─tools +│ misc.py +│ __init__.py +├─main +│ car_env.py +│ config.py +│ config_manager.py +│ get_location.py +│ main.py +│ model_manager.py +│ route_visualizer.py +│ traffic_manager.py +│ trajectory_manager.py +│ vehicle_tracker.py +├─models +│ Braking___282.00max__282.00avg__282.00min__1679121006.model +│ Driving__6030.00max_6030.00avg_6030.00min__1679109656.model +└─test + braking_dqn.py + driving_dqn.py + pedestrians_1.py + pedestrians_2.py + test_braking.py + test_driving.py ``` ## 核心功能 diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/main.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main.py deleted file mode 100644 index 69975cea17..0000000000 --- a/src/Autonomous_vehicle_navigation_using_deep_learning_master/main.py +++ /dev/null @@ -1,279 +0,0 @@ -""" -主程序入口 - 协调所有模块 -""" -import os -os.environ['TF_CPP_MIN_LOG_LEVEL'] = '2' -import time -import numpy as np -from collections import deque - -from car_env import CarEnv -from route_visualizer import RouteVisualizer -from vehicle_tracker import VehicleTracker -from model_manager import ModelManager -from trajectory_manager import TrajectoryManager -from traffic_manager import TrafficManager -from config_manager import ConfigManager -import config as cfg - -def setup_environment(): - """设置整体环境""" - print("=" * 60) - print("CARLA自动驾驶系统启动") - print("=" * 60) - - # 获取配置 - trajectory = cfg.get_current_trajectory() - if trajectory is None: - print("❌ 无法获取轨迹配置") - return None, None, None, None, None, None, None - - print(f"📌 使用轨迹: {trajectory['description']}") - - # 创建CARLA环境 - try: - env = CarEnv(trajectory['start'], trajectory['end']) - print("✅ CARLA环境创建成功") - except Exception as e: - print(f"❌ 创建CARLA环境失败: {e}") - return None, None, None, None, None, None, None - - # 创建配置管理器 - config_mgr = ConfigManager(client=env.client) - - # 应用默认设置 - config_mgr.apply_default_settings() - - # 设置仿真参数(提高性能) - settings = env.world.get_settings() - settings.fixed_delta_seconds = cfg.FIXED_DELTA_SECONDS - settings.synchronous_mode = cfg.SYNCHRONOUS_MODE - settings.no_rendering_mode = cfg.NO_RENDERING_MODE - env.world.apply_settings(settings) - - print(f"📊 设置时间步长: {cfg.FIXED_DELTA_SECONDS}s ({1/cfg.FIXED_DELTA_SECONDS:.1f} FPS)") - - # 检查模拟器状态 - config_mgr.inspect_simulation() - - # 创建交通管理器 - traffic_mgr = TrafficManager(client=env.client) - - # 生成交通流 - if cfg.ENABLE_TRAFFIC: - print("\n🚦 生成交通流...") - traffic_mgr.generate_traffic( - num_vehicles=cfg.TRAFFIC_VEHICLES, - num_walkers=cfg.TRAFFIC_WALKERS, - safe_mode=cfg.TRAFFIC_SAFE_MODE, - hybrid_mode=cfg.TRAFFIC_HYBRID_MODE, - sync_mode=cfg.TRAFFIC_SYNC_MODE, - respawn_vehicles=cfg.TRAFFIC_RESPAWN - ) - - # 创建路线可视化器 - visualizer = RouteVisualizer(env.world) - - # 创建车辆跟踪器(控制视角) - tracker = VehicleTracker(env.world) - - # 创建模型管理器 - model_mgr = ModelManager() - - # 创建轨迹管理器 - traj_mgr = TrajectoryManager(env) - - return env, config_mgr, traffic_mgr, visualizer, tracker, model_mgr, traj_mgr - -def run_episode(env, config_mgr, traffic_mgr, visualizer, tracker, model_mgr, traj_mgr, episode_num): - """运行单个episode""" - print(f"\n{'='*60}") - print(f"Episode {episode_num}") - print(f"{'='*60}") - - # 重置环境 - try: - current_state = env.reset() - print(f"✅ 环境重置成功") - except Exception as e: - print(f"❌ 环境重置失败: {e}") - return False - - # 获取车辆 - ego_vehicle = env.vehicle - if ego_vehicle is None: - print("❌ 未找到车辆") - return False - - # 重置跟踪器 - tracker.reset() - - # 设置初始视角(俯视) - tracker.set_top_down_view(ego_vehicle, height=cfg.TOP_DOWN_HEIGHT) - - # 获取并绘制规划路线 - route_points = traj_mgr.get_route_points() - visualizer.draw_planned_route(route_points) - - # 重置可视化器历史 - visualizer.reset_history() - - done = False - step_count = 0 - frame_skip_count = 0 - fps_counter = deque(maxlen=120) # 增加历史长度 - last_frame_time = time.time() - - while not done and step_count < cfg.MAX_STEPS_PER_EPISODE: - step_count += 1 - step_start = time.time() - current_time = time.time() - - # 计算帧间隔 - frame_interval = current_time - last_frame_time - last_frame_time = current_time - - # 自适应跳帧逻辑 - should_skip_frame = False - if cfg.MAX_FRAME_SKIP > 0 and frame_interval > cfg.FIXED_DELTA_SECONDS * 1.5: - frame_skip_count += 1 - if frame_skip_count <= cfg.MAX_FRAME_SKIP: - should_skip_frame = True - if cfg.DEBUG_MODE and step_count % 50 == 0: - print(f"[跳过] 帧间隔过大: {frame_interval:.3f}s,跳过更新") - else: - frame_skip_count = 0 - - # 更新交通管理器(如果是同步模式) - if traffic_mgr and cfg.TRAFFIC_SYNC_MODE and not should_skip_frame: - traffic_mgr.update() - - # 获取车辆状态 - vehicle_state = tracker.get_vehicle_state(ego_vehicle) - - # 更新视角(跳过某些帧时也更新,但减少频率) - if not should_skip_frame or step_count % 2 == 0: - tracker.smooth_follow_vehicle(ego_vehicle, height=cfg.TOP_DOWN_HEIGHT) - - # 更新车辆可视化(可以适当降低频率) - if vehicle_state and (step_count % 2 == 0 or not should_skip_frame): - visualizer.update_vehicle_display( - vehicle_state['x'], - vehicle_state['y'], - vehicle_state['heading'] - ) - - # 模型预测动作 - action = model_mgr.predict_action(current_state, vehicle_state) - - # 执行动作 - try: - new_state, reward, done, _ = env.step(action, current_state) - current_state = new_state - except Exception as e: - print(f"❌ 执行动作失败: {e}") - done = True - - # 显示进度 - if step_count % 100 == 0: - progress_info = tracker.calculate_progress( - vehicle_state['x'] if vehicle_state else 0, - vehicle_state['y'] if vehicle_state else 0, - route_points - ) - print(f"步骤 {step_count}, 奖励: {reward:.2f}, {progress_info}") - - # 计算FPS - frame_time = time.time() - step_start - fps_counter.append(frame_time) - - # 计算平滑FPS - if len(fps_counter) >= 30: - avg_frame_time = np.mean(list(fps_counter)[-30:]) - current_fps = 1.0 / avg_frame_time if avg_frame_time > 0 else 0 - else: - current_fps = len(fps_counter) / sum(fps_counter) if fps_counter else 0 - - # 显示调试信息 - if cfg.DEBUG_MODE and step_count % 100 == 0: - if vehicle_state: - print(f"[{step_count:4d}] FPS: {current_fps:5.1f} | " - f"动作: {cfg.ACTION_NAMES[action]} | " - f"位置: ({vehicle_state['x']:.1f}, {vehicle_state['y']:.1f}) | " - f"速度: {vehicle_state['speed_2d']:.1f}m/s") - - if done: - print(f"✅ Episode {episode_num} 完成,步数: {step_count}") - break - - # 限制帧率(如果需要) - if cfg.FPS_LIMIT > 0: - target_frame_time = 1.0 / cfg.FPS_LIMIT - actual_frame_time = time.time() - step_start - if actual_frame_time < target_frame_time: - time.sleep(target_frame_time - actual_frame_time) - - if step_count >= cfg.MAX_STEPS_PER_EPISODE: - print(f"⏰ Episode {episode_num} 达到最大步数限制") - - # 显示统计信息 - path_length = visualizer.calculate_path_length() - avg_fps = 1.0 / (sum(fps_counter) / len(fps_counter)) if fps_counter else 0 - print(f"📊 行驶距离: {path_length:.1f}m, 平均FPS: {avg_fps:.1f}") - - return True - -def main(): - """主函数""" - # 初始化各模块 - result = setup_environment() - if result[0] is None: - return - - env, config_mgr, traffic_mgr, visualizer, tracker, model_mgr, traj_mgr = result - - # 加载模型 - if not model_mgr.load_models(): - print("❌ 模型加载失败") - return - - print("\n🚗 开始自动驾驶...") - - # 运行多个episode - for episode in range(cfg.TOTAL_EPISODES): - success = run_episode( - env, config_mgr, traffic_mgr, visualizer, tracker, model_mgr, traj_mgr, episode + 1 - ) - - if not success: - print(f"❌ Episode {episode + 1} 运行失败") - - # 等待片刻再开始下一个episode - if episode < cfg.TOTAL_EPISODES - 1: - print(f"\n等待 {cfg.EPISODE_INTERVAL} 秒开始下一个episode...") - time.sleep(cfg.EPISODE_INTERVAL) - - # 清理 - print("\n" + "=" * 60) - print("所有episode完成!") - print("=" * 60) - - # 清理交通流 - if traffic_mgr: - traffic_mgr.cleanup() - - # 显示最终统计 - print("\n📈 最终统计:") - print(f"总episodes: {cfg.TOTAL_EPISODES}") - print(f"每episode最大步数: {cfg.MAX_STEPS_PER_EPISODE}") - print(f"交通模式: {'启用' if cfg.ENABLE_TRAFFIC else '禁用'}") - - if cfg.ENABLE_TRAFFIC and traffic_mgr: - traffic_info = traffic_mgr.get_traffic_info() - print(f"交通车辆数: {traffic_info['num_vehicles']}") - print(f"交通行人数: {traffic_info['num_walkers']}") - - print("程序结束") - -if __name__ == '__main__': - main() diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/car_env.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/car_env.py similarity index 98% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/car_env.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/car_env.py index 0c5caf86d9..13bdf2eb7a 100644 --- a/src/Autonomous_vehicle_navigation_using_deep_learning_master/car_env.py +++ b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/car_env.py @@ -13,6 +13,12 @@ except IndexError: pass +# 获取当前文件的目录 +current_dir = os.path.dirname(os.path.abspath(__file__)) +# 获取父目录 +parent_dir = os.path.dirname(current_dir) +# 将父目录添加到系统路径 +sys.path.append(parent_dir) from agents.navigation.global_route_planner import GlobalRoutePlanner import carla @@ -420,7 +426,7 @@ def step(self, action, current_state): self.vehicle.apply_control(carla.VehicleControl(throttle=0, brake=1.0)) print("执行动作: 刹车") elif action == 1: - self.vehicle.apply_control(carla.VehicleControl(throttle=0.5, steer= 0*self.STEER_AMT)) + self.vehicle.apply_control(carla.VehicleControl(throttle=0.4, steer= 0*self.STEER_AMT)) print("执行动作: 直行") elif action == 2: self.vehicle.apply_control(carla.VehicleControl(throttle=0.1, steer=-0.3*self.STEER_AMT)) diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/config.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/config.py similarity index 84% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/config.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/config.py index 195518bacc..565a3cf51c 100644 --- a/src/Autonomous_vehicle_navigation_using_deep_learning_master/config.py +++ b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/config.py @@ -1,7 +1,7 @@ """ 配置文件 - 存储所有配置参数 """ - +import os # ==================== 轨迹配置 ==================== TRAJECTORIES = { "custom_trajectory": { @@ -27,10 +27,17 @@ def get_current_trajectory(): print(f"❌ 轨迹 '{CURRENT_TRAJECTORY}' 不存在") return None + # ==================== 模型配置 ==================== +# 设置基础路径 +current_dir = os.path.dirname(os.path.abspath(__file__)) +base_dir = os.path.dirname(current_dir) # 上一级目录 +MODELS_DIR = os.path.join(base_dir, 'models') +braking = os.path.join(MODELS_DIR, 'Braking___282.model') +driving = os.path.join(MODELS_DIR, 'Driving__6030.model') MODEL_PATHS = { - 'braking': "models/Braking___282.model", - 'driving': "models/Driving__6030.model" + 'braking': braking , + 'driving': driving } # ==================== 动作配置 ==================== @@ -43,8 +50,8 @@ def get_current_trajectory(): # ==================== 交通配置 ==================== ENABLE_TRAFFIC = True # 是否启用交通流(暂时关闭,避免干扰) -TRAFFIC_VEHICLES = 15 # 交通车辆数量 -TRAFFIC_WALKERS = 20 # 交通行人数量 +TRAFFIC_VEHICLES = 30 # 交通车辆数量 +TRAFFIC_WALKERS = 50 # 交通行人数量 TRAFFIC_SAFE_MODE = True # 交通安全模式 TRAFFIC_HYBRID_MODE = True # 混合物理模式 TRAFFIC_SYNC_MODE = False # 交通同步模式 @@ -53,7 +60,7 @@ def get_current_trajectory(): # ==================== 可视化配置 ==================== ROUTE_COLOR = (255, 0, 0) # 路线颜色 (红色) PATH_COLOR = (0, 100, 255) # 路径颜色 (蓝色) -VEHICLE_COLOR = (0, 255, 0) # 车辆颜色 (绿色) +VEHICLE_COLOR = (0, 0, 0) # 车辆颜色 (绿色) ROUTE_HEIGHT = 0.3 # 路线显示高度 PATH_HEIGHT = 0.2 # 路径显示高度 @@ -62,16 +69,16 @@ def get_current_trajectory(): # ==================== 视角配置 ==================== TOP_DOWN_HEIGHT = 30.0 # 俯视视角高度(提高) TOP_DOWN_PITCH = -85.0 # 俯视角 (几乎垂直向下,-90是完全垂直) -SMOOTH_FOLLOW_FACTOR = 0.001 # 视角平滑系数 (0-1,越小越平滑) -MIN_SMOOTH_FACTOR = 0 # 最小平滑系数 +SMOOTH_FOLLOW_FACTOR = 0.01 # 视角平滑系数 (0-1,越小越平滑) +MIN_SMOOTH_FACTOR = 0.001 # 最小平滑系数 MAX_SMOOTH_FACTOR = 0.3 # 最大平滑系数 SMOOTH_FACTOR_ADAPTIVE = True # 是否自适应平滑系数 DISTANCE_THRESHOLD = 5.0 # 距离阈值,超过此值加大平滑系数 # ==================== 性能配置 ==================== DEBUG_MODE = True # 调试模式 -FPS_LIMIT = 0 # FPS限制 (0为无限制,提高性能) -UPDATE_RATE = 1.0 # 更新率 (1.0 = 每步更新) +FPS_LIMIT = 120 # FPS限制 (0为无限制,提高性能) +UPDATE_RATE = 0.5 # 更新率 (1.0 = 每步更新) USE_SMOOTH_INTERPOLATION = True # 使用平滑插值 INTERPOLATION_STEPS = 5 # 插值步数 MAX_FRAME_SKIP = 2 # 最大跳帧数 diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/config_manager.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/config_manager.py similarity index 100% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/config_manager.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/config_manager.py diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/get_location.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/get_location.py similarity index 100% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/get_location.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/get_location.py diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/main.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/main.py new file mode 100644 index 0000000000..1307269b1b --- /dev/null +++ b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/main.py @@ -0,0 +1,217 @@ + +#!/usr/bin/env python3 +""" +主程序 - 简化版 +""" + +import os +os.environ['TF_CPP_MIN_LOG_LEVEL'] = '2' +import time +import sys +import glob + +# 导入CARLA +try: + sys.path.append(glob.glob('../carla/dist/carla-*%d.%d-%s.egg' % ( + sys.version_info.major, + sys.version_info.minor, + 'win-amd64' if os.name == 'nt' else 'linux-x86_64'))[0]) +except IndexError: + pass + +import carla +import numpy as np +from collections import deque + +from car_env import CarEnv +from route_visualizer import RouteVisualizer +from vehicle_tracker import VehicleTracker +from traffic_manager import TrafficManager +import config as cfg + +def setup_environment(): + """设置环境""" + print("启动CARLA自动驾驶系统") + + # 获取轨迹 + trajectory = cfg.get_current_trajectory() + if not trajectory: + print("轨迹配置错误") + return None, None, None, None, None + + print(f"使用轨迹: {trajectory['description']}") + + # 创建环境 + try: + env = CarEnv(trajectory['start'], trajectory['end']) + print("CARLA环境创建成功") + except Exception as e: + print(f"创建环境失败: {e}") + return None, None, None, None, None + + # 设置仿真参数 + settings = env.world.get_settings() + settings.fixed_delta_seconds = cfg.FIXED_DELTA_SECONDS + settings.synchronous_mode = False + settings.no_rendering_mode = False + env.world.apply_settings(settings) + + # 设置天气 + env.world.set_weather(carla.WeatherParameters.ClearNoon) + + # 创建交通管理器 + traffic_mgr = TrafficManager(env.client, env.world) + + # 生成交通 + if cfg.ENABLE_TRAFFIC: + print("生成交通流...") + traffic_mgr.generate_traffic( + num_vehicles=cfg.TRAFFIC_VEHICLES, + num_walkers=cfg.TRAFFIC_WALKERS, + safe_mode=cfg.TRAFFIC_SAFE_MODE + ) + + # 创建其他管理器 + visualizer = RouteVisualizer(env.world) + tracker = VehicleTracker(env.world) + + return env, traffic_mgr, visualizer, tracker, trajectory + +def load_models(): + """加载模型""" + try: + from tensorflow.keras.models import load_model + import tensorflow as tf + + braking_model = load_model(cfg.MODEL_PATHS['braking']) + driving_model = load_model(cfg.MODEL_PATHS['driving']) + + print("模型加载成功") + return braking_model, driving_model + except Exception as e: + print(f"模型加载失败: {e}") + return None, None + +def predict_action(braking_model, driving_model, current_state, vehicle_state=None): + """预测动作""" + if not braking_model or not driving_model: + return 0 + + # 刹车模型预测 + braking_state = np.array(current_state[:2]).reshape(1, -1) + braking_qs = braking_model.predict(braking_state, verbose=0)[0] + braking_action = np.argmax(braking_qs) + + # 如果安全,使用驾驶模型 + if braking_action == 1: + driving_state = np.array(current_state[2:]).reshape(1, -1) + driving_qs = driving_model.predict(driving_state, verbose=0)[0] + return np.argmax(driving_qs) + 1 + + return 0 + +def run_episode(env, traffic_mgr, visualizer, tracker, episode_num): + """运行一个episode""" + print(f"\nEpisode {episode_num}") + + # 加载模型 + braking_model, driving_model = load_models() + if not braking_model or not driving_model: + print("无法加载模型,退出") + return False + + # 重置环境 + try: + current_state = env.reset() + print("环境重置成功") + except Exception as e: + print(f"环境重置失败: {e}") + return False + + # 获取车辆 + ego_vehicle = env.vehicle + if not ego_vehicle: + print("未找到车辆") + return False + + # 设置俯视视角 + tracker.set_top_down_view(ego_vehicle) + + # 绘制路线 + if hasattr(env, 'path') and env.path: + route_points = [] + for waypoint in env.path: + location = waypoint.transform.location + route_points.append((location.x, location.y, location.z)) + visualizer.draw_planned_route(route_points) + + # 运行循环 + step_count = 0 + done = False + fps_counter = deque(maxlen=30) + + while not done and step_count < cfg.MAX_STEPS_PER_EPISODE: + step_count += 1 + step_start = time.time() + + # 每步都更新视角 + tracker.smooth_follow_vehicle(ego_vehicle) + + # 更新车辆显示 + vehicle_state = tracker.get_vehicle_state(ego_vehicle) + if vehicle_state: + visualizer.update_vehicle_display( + vehicle_state['x'], + vehicle_state['y'], + vehicle_state['heading'] + ) + + # 预测并执行动作 + action = predict_action(braking_model, driving_model, current_state, vehicle_state) + + try: + new_state, reward, done, _ = env.step(action, current_state) + current_state = new_state + except Exception as e: + print(f"执行动作失败: {e}") + done = True + + # 计算FPS + frame_time = time.time() - step_start + fps_counter.append(frame_time) + + if cfg.DEBUG_MODE and step_count % 50 == 0: + fps = len(fps_counter) / sum(fps_counter) if fps_counter else 0 + print(f"步骤 {step_count}, FPS: {fps:.1f}, 动作: {cfg.ACTION_NAMES[action]}") + + if done: + print(f"Episode {episode_num} 完成,步数: {step_count}") + break + + return True + +def main(): + """主函数""" + # 设置环境 + result = setup_environment() + if not result[0]: + return + + env, traffic_mgr, visualizer, tracker, trajectory = result + + # 运行episode + for episode in range(cfg.TOTAL_EPISODES): + success = run_episode(env, traffic_mgr, visualizer, tracker, episode + 1) + + if episode < cfg.TOTAL_EPISODES - 1: + print(f"等待 {cfg.EPISODE_INTERVAL} 秒...") + time.sleep(cfg.EPISODE_INTERVAL) + + # 清理 + if traffic_mgr: + traffic_mgr.cleanup() + + print("\n程序结束") + +if __name__ == '__main__': + main() diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/model_manager.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/model_manager.py similarity index 100% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/model_manager.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/model_manager.py diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/route_visualizer.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/route_visualizer.py similarity index 99% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/route_visualizer.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/route_visualizer.py index add06ba397..d2dd0ff3fb 100644 --- a/src/Autonomous_vehicle_navigation_using_deep_learning_master/route_visualizer.py +++ b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/route_visualizer.py @@ -183,7 +183,7 @@ def _draw_vehicle_outline(self, x, y, heading): for i in range(len(points) - 1): self.world.debug.draw_line( points[i], points[i+1], - thickness=0.15, + thickness=0.01, color=carla.Color(50, 255, 50), # 亮绿色轮廓 life_time=0.5, persistent_lines=False diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/traffic_manager.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/traffic_manager.py new file mode 100644 index 0000000000..584670f20f --- /dev/null +++ b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/traffic_manager.py @@ -0,0 +1,184 @@ + +""" +交通管理器 - 简化版 +""" + +import sys +import os +import glob + +try: + sys.path.append(glob.glob('../carla/dist/carla-*%d.%d-%s.egg' % ( + sys.version_info.major, + sys.version_info.minor, + 'win-amd64' if os.name == 'nt' else 'linux-x86_64'))[0]) +except IndexError: + pass + +import carla +from numpy import random + +class TrafficManager: + """交通管理器""" + + def __init__(self, client, world): + self.client = client + self.world = world + self.tm_port = 8000 + self.vehicles_list = [] + self.walkers_list = [] + self.all_id = [] + + def generate_traffic(self, num_vehicles=15, num_walkers=20, safe_mode=True): + """生成交通流""" + print(f"生成交通: {num_vehicles}辆车, {num_walkers}个行人") + + # 获取交通管理器 + traffic_manager = self.client.get_trafficmanager(self.tm_port) + traffic_manager.set_global_distance_to_leading_vehicle(2.5) + + # 生成车辆 + self._spawn_vehicles(traffic_manager, num_vehicles, safe_mode) + + # 生成行人 + if num_walkers > 0: + self._spawn_walkers_simple(num_walkers) + + print(f"完成: {len(self.vehicles_list)}辆车, {len(self.walkers_list)}个行人") + return True + + def _spawn_vehicles(self, traffic_manager, num_vehicles, safe_mode): + """生成车辆""" + blueprints = self.world.get_blueprint_library().filter('vehicle.*') + + if safe_mode: + # 过滤危险车辆 + safe_vehicles = [ + 'vehicle.audi.a2', + 'vehicle.audi.tt', + 'vehicle.bmw.grandtourer', + 'vehicle.dodge.charger_police', + 'vehicle.jeep.wrangler_rubicon', + 'vehicle.lincoln.mkz2017', + 'vehicle.mercedes-benz.coupe', + 'vehicle.mini.cooperst', + 'vehicle.nissan.micra', + 'vehicle.nissan.patrol', + 'vehicle.seat.leon', + 'vehicle.tesla.model3', + 'vehicle.toyota.prius', + 'vehicle.volkswagen.t2' + ] + blueprints = [bp for bp in blueprints if any(safe in bp.id for safe in safe_vehicles)] + + spawn_points = self.world.get_map().get_spawn_points() + random.shuffle(spawn_points) + + batch = [] + for i in range(min(num_vehicles, len(spawn_points))): + blueprint = random.choice(blueprints) + batch.append( + carla.command.SpawnActor(blueprint, spawn_points[i]) + .then(carla.command.SetAutopilot(carla.command.FutureActor, True, traffic_manager.get_port())) + ) + + # 批量生成 + for response in self.client.apply_batch_sync(batch): + if not response.error: + self.vehicles_list.append(response.actor_id) + + def _spawn_walkers_simple(self, num_walkers): + """简化的行人生成""" + walker_bps = self.world.get_blueprint_library().filter('walker.pedestrian.*') + + # 生成行人 + batch = [] + walker_speeds = [] + + for i in range(num_walkers): + spawn_location = self.world.get_random_location_from_navigation() + if spawn_location and spawn_location.z < 5: # 确保位置合理 + walker_bp = random.choice(walker_bps) + + # 设置为非无敌 + if walker_bp.has_attribute('is_invincible'): + walker_bp.set_attribute('is_invincible', 'false') + + # 设置速度 + speed = 1.0 # 默认速度 + if walker_bp.has_attribute('speed'): + speed = walker_bp.get_attribute('speed').recommended_values[1] + + walker_speeds.append(speed) + batch.append(carla.command.SpawnActor(walker_bp, carla.Transform(spawn_location))) + + # 生成行人实体 + walker_ids = [] + results = self.client.apply_batch_sync(batch) + + for i, response in enumerate(results): + if not response.error: + walker_id = response.actor_id + walker_ids.append(walker_id) + self.walkers_list.append({ + "id": walker_id, + "speed": walker_speeds[i] if i < len(walker_speeds) else 1.0 + }) + + # 生成行人控制器 + batch = [] + controller_bp = self.world.get_blueprint_library().find('controller.ai.walker') + + for walker_info in self.walkers_list: + batch.append(carla.command.SpawnActor(controller_bp, carla.Transform(), walker_info["id"])) + + results = self.client.apply_batch_sync(batch) + + for i, response in enumerate(results): + if not response.error and i < len(self.walkers_list): + self.walkers_list[i]["con"] = response.actor_id + self.all_id.append(response.actor_id) + self.all_id.append(self.walkers_list[i]["id"]) + + # 初始化控制器 + all_actors = self.world.get_actors(self.all_id) + + for i in range(0, len(self.all_id), 2): + if i < len(all_actors): + controller = all_actors[i] + walker = all_actors[i+1] if i+1 < len(all_actors) else None + + if controller and walker: + try: + controller.start() + + # 设置目的地 + target = self.world.get_random_location_from_navigation() + if target: + controller.go_to_location(target) + + # 设置速度 + walker_index = i // 2 + if walker_index < len(self.walkers_list): + controller.set_max_speed(self.walkers_list[walker_index]["speed"]) + except: + pass + + def cleanup(self): + """清理交通""" + print("清理交通...") + + # 销毁车辆 + if self.vehicles_list: + self.client.apply_batch([carla.command.DestroyActor(x) for x in self.vehicles_list]) + + # 销毁行人 + if self.all_id: + # 先停止控制器 + all_actors = self.world.get_actors(self.all_id) + for i in range(0, len(self.all_id), 2): + if i < len(all_actors): + all_actors[i].stop() + + # 销毁所有行人相关actor + self.client.apply_batch([carla.command.DestroyActor(x) for x in self.all_id]) diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/trajectory_manager.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/trajectory_manager.py similarity index 100% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/trajectory_manager.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/trajectory_manager.py diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/vehicle_tracker.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/main/vehicle_tracker.py similarity index 100% rename from src/Autonomous_vehicle_navigation_using_deep_learning_master/vehicle_tracker.py rename to src/Autonomous_vehicle_navigation_using_deep_learning_master/main/vehicle_tracker.py diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/models/Braking___282.00max__282.00avg__282.00min__1679121006.model b/src/Autonomous_vehicle_navigation_using_deep_learning_master/models/Braking___282.00max__282.00avg__282.00min__1679121006.model deleted file mode 100644 index 6345372b28..0000000000 Binary files a/src/Autonomous_vehicle_navigation_using_deep_learning_master/models/Braking___282.00max__282.00avg__282.00min__1679121006.model and /dev/null differ diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/models/Driving__6030.00max_6030.00avg_6030.00min__1679109656.model b/src/Autonomous_vehicle_navigation_using_deep_learning_master/models/Driving__6030.00max_6030.00avg_6030.00min__1679109656.model deleted file mode 100644 index 2a5f4da072..0000000000 Binary files a/src/Autonomous_vehicle_navigation_using_deep_learning_master/models/Driving__6030.00max_6030.00avg_6030.00min__1679109656.model and /dev/null differ diff --git a/src/Autonomous_vehicle_navigation_using_deep_learning_master/traffic_manager.py b/src/Autonomous_vehicle_navigation_using_deep_learning_master/traffic_manager.py deleted file mode 100644 index 583e4a9d2d..0000000000 --- a/src/Autonomous_vehicle_navigation_using_deep_learning_master/traffic_manager.py +++ /dev/null @@ -1,361 +0,0 @@ -""" -交通管理器 - 封装generate_traffic.py功能,生成和管理交通流 -""" - -import sys -import os -import glob -import time -import logging -from numpy import random - -# 添加CARLA路径 -try: - sys.path.append(glob.glob('../carla/dist/carla-*%d.%d-%s.egg' % ( - sys.version_info.major, - sys.version_info.minor, - 'win-amd64' if os.name == 'nt' else 'linux-x86_64'))[0]) -except IndexError: - pass - -import carla -from carla import VehicleLightState as vls - -class TrafficManager: - """交通管理器 - 负责生成和控制交通流""" - - def __init__(self, client=None, host='localhost', port=2000): - """ - 初始化交通管理器 - - Args: - client: 可选的CARLA客户端对象 - host: CARLA服务器主机 - port: CARLA服务器端口 - """ - if client: - self.client = client - self.world = client.get_world() - else: - self.client = carla.Client(host, port) - self.client.set_timeout(10.0) - self.world = self.client.get_world() - - self.tm_port = 8000 - self.traffic_manager = None - self.vehicles_list = [] - self.walkers_list = [] - self.all_actors = [] - self.all_id = [] - - self.is_synchronous = False - self.synchronous_master = False - - print("🚦 交通管理器初始化完成") - - def generate_traffic(self, - num_vehicles=20, - num_walkers=30, - safe_mode=True, - hybrid_mode=True, - sync_mode=False, - respawn_vehicles=False): - """ - 生成交通流 - - Args: - num_vehicles: 车辆数量 - num_walkers: 行人数量 - safe_mode: 安全模式(避免事故倾向车辆) - hybrid_mode: 混合物理模式 - sync_mode: 同步模式 - respawn_vehicles: 是否重生休眠车辆 - - Returns: - bool: 是否成功 - """ - print("\n" + "="*50) - print("生成交通流") - print("="*50) - print(f"车辆: {num_vehicles}辆") - print(f"行人: {num_walkers}个") - print(f"安全模式: {'开启' if safe_mode else '关闭'}") - print(f"混合模式: {'开启' if hybrid_mode else '关闭'}") - print(f"同步模式: {'开启' if sync_mode else '关闭'}") - - try: - # 获取交通管理器 - self.traffic_manager = self.client.get_trafficmanager(self.tm_port) - - # 配置交通管理器 - self.traffic_manager.set_global_distance_to_leading_vehicle(2.5) - - if respawn_vehicles: - self.traffic_manager.set_respawn_dormant_vehicles(True) - - if hybrid_mode: - self.traffic_manager.set_hybrid_physics_mode(True) - self.traffic_manager.set_hybrid_physics_radius(70.0) - - # 设置仿真模式 - self.is_synchronous = sync_mode - settings = self.world.get_settings() - - if sync_mode: - self.traffic_manager.set_synchronous_mode(True) - if not settings.synchronous_mode: - self.synchronous_master = True - settings.synchronous_mode = True - settings.fixed_delta_seconds = 0.05 - else: - self.synchronous_master = False - - self.world.apply_settings(settings) - print("✅ 同步模式已启用") - - # 生成车辆 - self._spawn_vehicles(num_vehicles, safe_mode) - - # 生成行人 - self._spawn_walkers(num_walkers) - - # 配置交通管理器参数 - self.traffic_manager.global_percentage_speed_difference(30.0) - - print(f"\n✅ 交通流生成完成!") - print(f" 生成车辆: {len(self.vehicles_list)}辆") - print(f" 生成行人: {len(self.walkers_list)}个") - - return True - - except Exception as e: - print(f"❌ 生成交通流失败: {e}") - return False - - def _spawn_vehicles(self, num_vehicles, safe_mode): - """生成车辆""" - print("🚗 生成车辆...") - - # 获取车辆蓝图 - blueprints = self.world.get_blueprint_library().filter('vehicle.*') - - if safe_mode: - # 过滤掉不安全或特殊车辆 - blueprints = [x for x in blueprints if int(x.get_attribute('number_of_wheels')) == 4] - blueprints = [x for x in blueprints if not x.id.endswith('microlino')] - blueprints = [x for x in blueprints if not x.id.endswith('carlacola')] - blueprints = [x for x in blueprints if not x.id.endswith('cybertruck')] - blueprints = [x for x in blueprints if not x.id.endswith('t2')] - blueprints = [x for x in blueprints if not x.id.endswith('sprinter')] - blueprints = [x for x in blueprints if not x.id.endswith('firetruck')] - blueprints = [x for x in blueprints if not x.id.endswith('ambulance')] - - blueprints = sorted(blueprints, key=lambda bp: bp.id) - - # 获取生成点 - spawn_points = self.world.get_map().get_spawn_points() - random.shuffle(spawn_points) - - if num_vehicles > len(spawn_points): - print(f"⚠️ 请求的车辆数({num_vehicles})超过生成点数({len(spawn_points)})") - num_vehicles = len(spawn_points) - - # 批量生成车辆 - batch = [] - for n, transform in enumerate(spawn_points): - if n >= num_vehicles: - break - - blueprint = random.choice(blueprints) - - # 设置随机颜色 - if blueprint.has_attribute('color'): - color = random.choice(blueprint.get_attribute('color').recommended_values) - blueprint.set_attribute('color', color) - - # 设置驾驶员ID - if blueprint.has_attribute('driver_id'): - driver_id = random.choice(blueprint.get_attribute('driver_id').recommended_values) - blueprint.set_attribute('driver_id', driver_id) - - blueprint.set_attribute('role_name', 'autopilot') - - # 添加到批量命令 - batch.append(carla.command.SpawnActor(blueprint, transform) - .then(carla.command.SetAutopilot( - carla.command.FutureActor, - True, - self.traffic_manager.get_port()))) - - # 执行批量命令 - for response in self.client.apply_batch_sync(batch, self.synchronous_master): - if response.error: - logging.error(f"生成车辆失败: {response.error}") - else: - self.vehicles_list.append(response.actor_id) - - print(f"✅ 生成 {len(self.vehicles_list)} 辆车辆") - - def _spawn_walkers(self, num_walkers): - """生成行人""" - print("🚶 生成行人...") - - if num_walkers <= 0: - return - - # 获取行人蓝图 - walker_bps = self.world.get_blueprint_library().filter('walker.pedestrian.*') - - # 获取随机位置 - spawn_points = [] - for i in range(num_walkers): - spawn_point = carla.Transform() - loc = self.world.get_random_location_from_navigation() - if loc: - spawn_point.location = loc - spawn_points.append(spawn_point) - - # 生成行人 - batch = [] - walker_speeds = [] - for spawn_point in spawn_points: - walker_bp = random.choice(walker_bps) - - # 设置为非无敌 - if walker_bp.has_attribute('is_invincible'): - walker_bp.set_attribute('is_invincible', 'false') - - # 设置速度 - speed = 0.0 - if walker_bp.has_attribute('speed'): - speed = walker_bp.get_attribute('speed').recommended_values[1] # 正常行走速度 - - walker_speeds.append(speed) - batch.append(carla.command.SpawnActor(walker_bp, spawn_point)) - - # 执行批量命令 - results = self.client.apply_batch_sync(batch, True) - - for i in range(len(results)): - if results[i].error: - logging.error(f"生成行人失败: {results[i].error}") - else: - self.walkers_list.append({"id": results[i].actor_id}) - - # 生成行人控制器 - batch = [] - walker_controller_bp = self.world.get_blueprint_library().find('controller.ai.walker') - - for i in range(len(self.walkers_list)): - batch.append(carla.command.SpawnActor( - walker_controller_bp, - carla.Transform(), - self.walkers_list[i]["id"])) - - results = self.client.apply_batch_sync(batch, True) - - for i in range(len(results)): - if results[i].error: - logging.error(f"生成行人控制器失败: {results[i].error}") - else: - self.walkers_list[i]["con"] = results[i].actor_id - self.all_id.append(results[i].actor_id) - self.all_id.append(self.walkers_list[i]["id"]) - - # 获取所有行人actor - all_actors = self.world.get_actors(self.all_id) - - # 初始化控制器 - for i in range(0, len(self.all_id), 2): - # 启动控制器 - all_actors[i].start() - # 设置随机目标 - all_actors[i].go_to_location(self.world.get_random_location_from_navigation()) - # 设置最大速度 - all_actors[i].set_max_speed(float(walker_speeds[int(i/2)])) - - print(f"✅ 生成 {len(self.walkers_list)} 个行人") - - def update(self): - """更新交通管理器(用于同步模式)""" - if self.is_synchronous and self.synchronous_master: - self.world.tick() - elif self.is_synchronous: - self.world.wait_for_tick() - - def set_vehicle_lights(self, enabled=True): - """设置车辆灯光""" - if not self.vehicles_list: - return - - try: - all_vehicle_actors = self.world.get_actors(self.vehicles_list) - for actor in all_vehicle_actors: - self.traffic_manager.update_vehicle_lights(actor, enabled) - - print(f"✅ 车辆灯光 {'开启' if enabled else '关闭'}") - except Exception as e: - print(f"⚠️ 设置车辆灯光失败: {e}") - - def set_global_speed_limit(self, percentage=30.0): - """设置全局速度限制百分比""" - if self.traffic_manager: - self.traffic_manager.global_percentage_speed_difference(percentage) - print(f"✅ 设置全局速度限制: {percentage}%") - - def cleanup(self): - """清理所有生成的交通""" - print("\n🧹 清理交通流...") - - try: - # 停止同步模式 - if self.is_synchronous and self.synchronous_master: - settings = self.world.get_settings() - settings.synchronous_mode = False - settings.fixed_delta_seconds = None - self.world.apply_settings(settings) - - # 销毁车辆 - if self.vehicles_list: - print(f"销毁 {len(self.vehicles_list)} 辆车辆...") - self.client.apply_batch([ - carla.command.DestroyActor(x) for x in self.vehicles_list - ]) - - # 销毁行人 - if self.all_id: - print(f"销毁 {len(self.walkers_list)} 个行人...") - - # 先停止控制器 - all_actors = self.world.get_actors(self.all_id) - for i in range(0, len(self.all_id), 2): - all_actors[i].stop() - - # 销毁所有actor - self.client.apply_batch([ - carla.command.DestroyActor(x) for x in self.all_id - ]) - - # 清空列表 - self.vehicles_list = [] - self.walkers_list = [] - self.all_id = [] - - print("✅ 交通流清理完成") - - except Exception as e: - print(f"❌ 清理交通流失败: {e}") - - def get_traffic_info(self): - """获取交通信息""" - return { - 'num_vehicles': len(self.vehicles_list), - 'num_walkers': len(self.walkers_list), - 'is_synchronous': self.is_synchronous, - 'tm_port': self.tm_port - } - - def __del__(self): - """析构函数,确保清理""" - if self.vehicles_list or self.walkers_list: - self.cleanup()