diff --git a/src/Unmanned_Aerial_car_Perception/main.py b/src/Unmanned_Aerial_car_Perception/main.py index 7b4d34803e..711e0cbc11 100644 --- a/src/Unmanned_Aerial_car_Perception/main.py +++ b/src/Unmanned_Aerial_car_Perception/main.py @@ -4,11 +4,34 @@ def main(): - # 初始化变量,用于后续资源清理 + # 初始化变量 vehicle = None camera_sensor = None collision_sensor = None spectator = None + is_vehicle_alive = False # 标记车辆是否真实存活 + + # 核心配置(聚焦稳定性和运动性) + CONFIG = { + "init_control_times": 12, # 初始激活指令次数(确保能动) + "init_control_interval": 0.05, # 每次激活指令间隔 + "init_total_delay": 0.8, # 激活总延迟(适配物理引擎响应) + "normal_throttle": 0.85, # 正常行驶油门(保证动力) + "avoid_throttle": 0.5, # 绕障时油门 + "avoid_steer": 0.6, # 绕障转向幅度 + "loop_interval": 0.008, # 控制循环间隔(响应快) + "detect_distance": 10.0, # 障碍物检测距离 + "stuck_reset_dist": 2.0 # 卡停时重置距离 + } + + try: + # 1. 连接Carla模拟器(超长超时+稳定性配置) + client = carla.Client("localhost", 2000) + client.set_timeout(60.0) # 60秒超时,适配低配/卡顿场景 + world = client.get_world() + print(f"✅ 成功连接Carla模拟器 | 地图:{world.get_map().name}") + + # 重置世界设置,关闭同步模式(物理引擎更稳定) spectator = None # 控制模拟器视角,确保能看到车辆 try: # 1. 连接Carla模拟器(延长超时,适配低配电脑) @@ -28,6 +51,21 @@ def main(): world_settings.fixed_delta_seconds = None world.apply_settings(world_settings) + # 清理残留Actor(避免资源冲突) + for actor in world.get_actors(): + if actor.type_id.startswith(("vehicle", "sensor")): + actor.destroy() + time.sleep(1) # 等待清理完成 + print("🧹 已清理所有残留车辆/传感器") + + # 2. 选择安全生成点(避免卡阻) + spawn_points = world.get_map().get_spawn_points() + if not spawn_points: + raise Exception("❌ 未找到任何车辆生成点") + + # 优先选前5个生成点中最空旷的 + spawn_point = spawn_points[2] if len(spawn_points) >= 3 else spawn_points[0] + print(f"📍 选定车辆生成点 | 位置:({spawn_point.location.x:.1f}, {spawn_point.location.y:.1f})") # 清空残留车辆,避免碰撞卡阻 for actor in world.get_actors(): if actor.type_id.startswith("vehicle"): @@ -42,34 +80,187 @@ def main(): # world = client.load_world("Town01") # print("🔄 已切换地图为:Town01") - # 2. 获取车辆蓝图,设置红色车身 + # 3. 生成车辆(多次重试+存活校验) vehicle_bp = world.get_blueprint_library().find("vehicle.tesla.model3") - if vehicle_bp.has_attribute('color'): - vehicle_bp.set_attribute('color', '255,0,0') # 红色车身 - print("🎨 已设置车辆颜色为红色") - - # 3. 选择合法生成点生成车辆(增加重试,避免碰撞失败) - spawn_points = world.get_map().get_spawn_points() - if spawn_points: - spawn_point = spawn_points[0] # 可替换为spawn_points[10]避免边缘位置 - # 生成车辆(重试3次,解决偶发碰撞问题) - max_retry = 3 - for i in range(max_retry): - try: - vehicle = world.spawn_actor(vehicle_bp, spawn_point) + vehicle_bp.set_attribute("color", "255,0,0") # 红色车身 + + # 5次重试生成,确保成功 + max_spawn_retry = 5 + for retry in range(max_spawn_retry): + try: + vehicle = world.spawn_actor(vehicle_bp, spawn_point) + # 校验车辆是否真的存活 + if vehicle and vehicle.is_alive: + vehicle.set_simulate_physics(True) # 强制开启物理 + vehicle.set_autopilot(False) + is_vehicle_alive = True + print(f"🚗 车辆生成成功 | ID:{vehicle.id} | 重试次数:{retry + 1}") break - except: - if i == max_retry - 1: - raise Exception("车辆生成失败:生成点有碰撞,请更换spawn_points索引(如spawn_points[10])") - time.sleep(0.5) - - print(f"🚗 成功生成特斯拉车辆,ID:{vehicle.id}") + else: + if vehicle: + vehicle.destroy() + except Exception as e: + if retry == max_spawn_retry - 1: + raise Exception(f"🚨 车辆生成失败(重试{max_spawn_retry}次):{e}") + time.sleep(0.8) + + # 4. 强制激活车辆(核心:确保小车能动) + print("🔋 正在激活车辆物理状态...") + # 连续下发激活指令,确保物理引擎响应 + for _ in range(CONFIG["init_control_times"]): + vehicle.apply_control(carla.VehicleControl( + throttle=1.0, # 满油门激活 + steer=0.0, + brake=0.0, + hand_brake=False, + reverse=False + )) + time.sleep(CONFIG["init_control_interval"]) + + time.sleep(CONFIG["init_total_delay"]) # 给物理引擎足够响应时间 + + # 校验激活状态:检查速度是否大于0 + init_speed = math.hypot(vehicle.get_velocity().x, vehicle.get_velocity().y) + if init_speed < 0.1: + print("⚠️ 车辆初始速度低,二次激活...") + # 重置物理状态后再次激活 + vehicle.set_simulate_physics(False) + time.sleep(0.2) + vehicle.set_simulate_physics(True) + vehicle.apply_control(carla.VehicleControl(throttle=1.0, steer=0.0)) + time.sleep(0.3) + + # 5. 绑定视角(全程跟随,便于观察) + spectator = world.get_spectator() - # 关键:将模拟器视角瞬移到车辆上方(确保能看到车) - spectator_transform = carla.Transform( - spawn_point.location + carla.Location(z=5), # 车辆上方5米 - carla.Rotation(pitch=-15, yaw=spawn_point.rotation.yaw) # 俯视视角 + def follow_vehicle(): + trans = vehicle.get_transform() + # 视角后移+升高,清晰观察车辆运动 + spectator_loc = carla.Location( + x=trans.location.x - math.cos(math.radians(trans.rotation.yaw)) * 7, + y=trans.location.y - math.sin(math.radians(trans.rotation.yaw)) * 7, + z=trans.location.z + 4.5 ) + spectator_rot = carla.Rotation(pitch=-30, yaw=trans.rotation.yaw) + spectator.set_transform(carla.Transform(spectator_loc, spectator_rot)) + + follow_vehicle() + print("👀 视角已绑定车辆,全程跟随") + + # 6. 简化传感器(非核心功能,失败不影响运动) + # 碰撞传感器:碰撞后继续行驶,不停车 + try: + collision_bp = world.get_blueprint_library().find("sensor.other.collision") + collision_sensor = world.spawn_actor(collision_bp, carla.Transform(), attach_to=vehicle) + + def collision_cb(event): + nonlocal steer + print("\n💥 检测到碰撞,自动调整方向!") + steer = -steer if abs(steer) > 0 else -CONFIG["avoid_steer"] + vehicle.apply_control(carla.VehicleControl( + throttle=CONFIG["avoid_throttle"], + steer=steer, + brake=0.0 + )) + + collision_sensor.listen(collision_cb) + print("🛡️ 碰撞传感器已挂载") + except: + print("⚠️ 碰撞传感器挂载失败(不影响车辆运动)") + + # 7. 障碍物检测(简化逻辑,确保行驶流畅) + def detect_obstacle(): + trans = vehicle.get_transform() + # 检测前方2-10米的障碍物 + for check_dist in range(2, int(CONFIG["detect_distance"]) + 1, 2): + check_loc = trans.location + trans.get_forward_vector() * check_dist + waypoint = world.get_map().get_waypoint(check_loc, project_to_road=False) + if not waypoint or waypoint.lane_type != carla.LaneType.Driving: + return True + return False + + # 8. 核心行驶逻辑(无限行驶,无时长限制) + print("\n🚙 车辆开始行驶(无限时长)| 按 Ctrl+C 手动终止") + print("------------------------------------------------") + steer = 0.0 + run_time = 0 # 记录行驶时长(秒) + + # 无限循环行驶(替代固定时长,满足"行驶时长加长"需求) + while True: + # 实时校验车辆状态 + if not vehicle or not vehicle.is_alive: + print("❌ 车辆异常消失,程序终止") + break + + # 更新视角 + follow_vehicle() + + # 检测障碍物并调整转向 + has_obstacle = detect_obstacle() + if has_obstacle: + steer = CONFIG["avoid_steer"] # 向右绕行 + throttle = CONFIG["avoid_throttle"] + print( + f"\r⚠️ 前方有障碍 | 绕行中 | 行驶时长:{run_time:.0f}秒 | 速度:{math.hypot(vehicle.get_velocity().x, vehicle.get_velocity().y) * 3.6:.0f}km/h", + end="") + else: + # 平滑回正转向 + steer = steer * 0.9 if abs(steer) > 0.05 else 0.0 + throttle = CONFIG["normal_throttle"] + print( + f"\r✅ 正常行驶 | 行驶时长:{run_time:.0f}秒 | 速度:{math.hypot(vehicle.get_velocity().x, vehicle.get_velocity().y) * 3.6:.0f}km/h | 转向:{steer:.2f}", + end="") + + # 持续下发行驶指令(核心:确保车辆一直运动) + vehicle.apply_control(carla.VehicleControl( + throttle=throttle, + steer=steer, + brake=0.0, + hand_brake=False, + reverse=False + )) + + # 卡停处理:速度过低时重置位置 + current_speed = math.hypot(vehicle.get_velocity().x, vehicle.get_velocity().y) + if current_speed < 0.1: + print("\n⚠️ 车辆卡停,重置位置...") + new_loc = vehicle.get_transform().location + carla.Location(x=CONFIG["stuck_reset_dist"]) + vehicle.set_transform(carla.Transform(new_loc, vehicle.get_transform().rotation)) + vehicle.apply_control(carla.VehicleControl(throttle=1.0, steer=0.0)) + + # 更新行驶时长 + run_time += CONFIG["loop_interval"] + time.sleep(CONFIG["loop_interval"]) + + # 手动终止处理(Ctrl+C) + except KeyboardInterrupt: + print(f"\n\n🛑 手动终止程序 | 车辆累计行驶时长:{run_time:.0f}秒") + # 异常处理 + except Exception as e: + print(f"\n❌ 程序异常:{str(e)}") + print("\n🔧 快速修复建议:") + print("1. 关闭Carla,在任务管理器结束CarlaUE4.exe") + print("2. 以管理员身份重启Carla:CarlaUE4.exe -windowed -ResX=800 -ResY=600") + print("3. 再次运行本代码") + # 资源清理(仅在车辆存活时执行) + finally: + print("\n🧹 开始清理资源...") + # 停车并销毁车辆 + if vehicle and is_vehicle_alive: + vehicle.apply_control(carla.VehicleControl(throttle=0.0, brake=1.0)) + time.sleep(1) + vehicle.destroy() + print("🗑️ 车辆已安全销毁") + # 销毁传感器 + if collision_sensor: + collision_sensor.stop() + collision_sensor.destroy() + print("🗑️ 碰撞传感器已销毁") + if camera_sensor: + camera_sensor.stop() + camera_sensor.destroy() + print("🗑️ 摄像头已销毁") + print("✅ 所有资源清理完成!") spectator.set_transform(spectator_transform) print("👀 模拟器视角已切换到车辆位置!")