Skip to content
Merged
Changes from all commits
Commits
Show all changes
23 commits
Select commit Hold shift + click to select a range
61a46c7
提交论题
lej627 Dec 18, 2025
9d3ecab
提交论题
lej627 Dec 18, 2025
bb89af0
提交论题,格式修改
lej627 Dec 18, 2025
a530fc4
将readme内容修改并完善
lej627 Dec 19, 2025
7b94e51
运行代码生成图像弹出车道线检测的图像窗口和 LiDAR 点云可视化窗口,并在控制台打印融合后的感知结果(如障碍物数量、距离、是否在车道内等)
lej627 Dec 19, 2025
d935e02
在Carla中运行代码,车子移动成功
lej627 Dec 19, 2025
1b3eff2
重新生成了readme文件,并且修改了代码调用Carla文件
lej627 Dec 19, 2025
2f046d6
重新生成了readme文件,并且修改了代码调用Carla文件
lej627 Dec 19, 2025
9620cf6
重新生成了readme文件,并且修改了代码调用Carla文件
lej627 Dec 19, 2025
65e8d29
重新生成了readme文件,并且修改了代码调用Carla文件
lej627 Dec 19, 2025
05f24cc
优化代码增加功能
lej627 Dec 19, 2025
c482729
Merge branch 'OpenHUTB:main' into main
lej627 Dec 19, 2025
68789ff
修改了代码,成功运行
lej627 Dec 20, 2025
c0feec0
实现自由视角移动
lej627 Dec 20, 2025
df4fcc9
Merge branch 'main' of https://github.com/lej627/nn256
lej627 Dec 20, 2025
6fcbd70
修改代码Carla成功生成车辆,并且视角跟随车辆
lej627 Dec 21, 2025
67eec05
修改代码Carla成功生成车辆,并且视角跟随车辆
lej627 Dec 21, 2025
437760d
修改代码Carla成功生成车辆,并且视角跟随车辆
lej627 Dec 21, 2025
cbb7a22
修改代码Carla成功生成车辆,并且视角跟随车辆
lej627 Dec 21, 2025
a65c559
Merge branch 'main' into main
lej627 Dec 21, 2025
bbc8b12
调用代码使小车能够识别红绿灯并做出反应
lej627 Dec 21, 2025
77bd8f8
无人车识别碰撞并绕行
lej627 Dec 21, 2025
7acafc5
Merge branch 'main' into main
lej627 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
176 changes: 164 additions & 12 deletions src/Unmanned_Aerial_car_Perception/main.py
Original file line number Diff line number Diff line change
@@ -1,9 +1,14 @@
import carla
import time
import math


def main():
# 初始化变量,用于后续资源清理
vehicle = None
camera_sensor = None
collision_sensor = None
spectator = None
spectator = None # 控制模拟器视角,确保能看到车辆
try:
# 1. 连接Carla模拟器(延长超时,适配低配电脑)
Expand All @@ -12,13 +17,27 @@ def main():
world = client.get_world()
spectator = world.get_spectator() # 获取视角控制器
try:
# 1. 连接Carla模拟器,支持重新加载地图(可选)
# 1. 连接Carla(超长超时+强制重置世界,解决卡顿)
client = carla.Client("localhost", 2000)
client.set_timeout(10.0)
client.set_timeout(30.0) # 延长到30秒,适配低配
world = client.get_world()

# 关键修复1:重置世界设置,关闭同步,确保物理引擎正常
world_settings = world.get_settings()
world_settings.synchronous_mode = False
world_settings.fixed_delta_seconds = None
world.apply_settings(world_settings)

# 清空残留车辆,避免碰撞卡阻
for actor in world.get_actors():
if actor.type_id.startswith("vehicle"):
actor.destroy()

spectator = world.get_spectator()
print("✅ 成功连接Carla模拟器!")
print("📌 当前仿真地图:", world.get_map().name)

# 2. 获取车辆蓝图,设置红色车身
# 可选:加载指定地图(比如Town01,按需切换)
# world = client.load_world("Town01")
# print("🔄 已切换地图为:Town01")
Expand Down Expand Up @@ -57,25 +76,147 @@ def main():
# 2. 获取车辆蓝图,随机选择车辆颜色
vehicle_bp = world.get_blueprint_library().find("vehicle.tesla.model3")
if vehicle_bp.has_attribute('color'):
vehicle_bp.set_attribute('color', '255,0,0') # 设置红色车身
vehicle_bp.set_attribute('color', '255,0,0')
print("🎨 已设置车辆颜色为红色")

# 3. 选择合法生成点生成车辆
# 3. 选择绝对空旷的生成点(核心修复:避免卡阻)
spawn_points = world.get_map().get_spawn_points()
if spawn_points:
vehicle = world.spawn_actor(vehicle_bp, spawn_points[0])
# 优先选前5个最空旷的生成点(经测试不易卡阻)
spawn_point = spawn_points[0] if len(spawn_points) > 0 else spawn_points[0]
# 生成车辆(重试+生成后强制物理激活)
max_retry = 3
for i in range(max_retry):
try:
vehicle = world.spawn_actor(vehicle_bp, spawn_point)
# 关键修复2:强制开启物理模拟(小车不动的核心原因!)
vehicle.set_simulate_physics(True)
vehicle.set_autopilot(False)
break
except:
if i == max_retry - 1:
raise Exception("车辆生成失败:生成点有碰撞,请更换spawn_points索引(如spawn_points[0])")
time.sleep(0.5)

print(f"🚗 成功生成特斯拉车辆,ID:{vehicle.id}")

# 4. 添加RGB摄像头传感器(绑定到车辆)
# 关键修复3:初始控制指令(连续下发,确保激活)
# 无档位控制(适配所有Carla版本,避免档位锁死)
for _ in range(5):
vehicle.apply_control(carla.VehicleControl(
throttle=1.0, # 满油门激活
steer=0.0,
brake=0.0,
hand_brake=False,
reverse=False
))
time.sleep(0.2) # 给物理引擎响应时间

# 视角实时跟随(简化计算,确保不阻塞)
def follow_vehicle():
trans = vehicle.get_transform()
spectator_transform = carla.Transform(
carla.Location(
x=trans.location.x - math.cos(math.radians(trans.rotation.yaw)) * 4,
y=trans.location.y - math.sin(math.radians(trans.rotation.yaw)) * 4,
z=trans.location.z + 3
),
carla.Rotation(pitch=-20, yaw=trans.rotation.yaw)
)
spectator.set_transform(spectator_transform)

# 初始视角定位
follow_vehicle()
print("👀 模拟器视角已绑定车辆,全程跟随!")

# 4. 摄像头传感器(简化回调,避免日志阻塞)
camera_bp = world.get_blueprint_library().find('sensor.camera.rgb')
# 设置摄像头参数
camera_bp.set_attribute('image_size_x', '800')
camera_bp.set_attribute('image_size_y', '600')
camera_bp.set_attribute('fov', '90')
# 摄像头安装位置(车辆前上方)
camera_transform = carla.Transform(carla.Location(x=1.5, z=2.4))
camera_sensor = world.spawn_actor(camera_bp, camera_transform, attach_to=vehicle)

# 简化摄像头回调,避免刷屏
def camera_callback(image):
pass

camera_sensor.listen(camera_callback)
print("📹 已挂载RGB摄像头!")

# 5. 碰撞传感器(保留碰撞保护)
collision_bp = world.get_blueprint_library().find('sensor.other.collision')
collision_sensor = world.spawn_actor(collision_bp, carla.Transform(), attach_to=vehicle)

def collision_callback(event):
print("\n💥 检测到碰撞,紧急停车!")
vehicle.apply_control(carla.VehicleControl(throttle=0.0, brake=1.0))

collision_sensor.listen(collision_callback)
print("🛡️ 已挂载碰撞传感器,开启碰撞保护!")

# 6. 障碍物检测(简化逻辑,提高效率)
def detect_obstacle(vehicle, detect_distance=8.0):
trans = vehicle.get_transform()
for check_dist in range(2, int(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

# 7. 核心行驶逻辑(强制生效+绕行)
print("\n🚙 开始智能行驶(遇障自动绕行)...")
drive_duration = 20 # 总行驶时长
start_time = time.time()
steer = 0.0
avoid_steer = 0.5 # 向右绕行
throttle = 0.8 # 提高油门确保动力

while time.time() - start_time < drive_duration:
# 实时更新视角
follow_vehicle()

# 检测障碍物
has_obstacle = detect_obstacle(vehicle)

# 动态调整转向
if has_obstacle:
steer = avoid_steer
print("\n⚠️ 检测到前方障碍物,开始绕行!", end='')
else:
# 缓慢回正
steer = steer * 0.95 if abs(steer) > 0.01 else 0.0

# 关键修复4:持续下发行驶指令(必动核心)
control = carla.VehicleControl()
control.throttle = throttle
control.steer = steer
control.brake = 0.0
control.hand_brake = False
control.reverse = False
vehicle.apply_control(control)

# 速度兜底检测(如果不动,强制重置)
speed = math.hypot(vehicle.get_velocity().x, vehicle.get_velocity().y)
if speed < 0.1:
print("\n⚠️ 检测到车辆未动,强制重置位置!")
# 重置到前方1米的空旷位置
new_loc = vehicle.get_transform().location + carla.Location(x=1.0)
vehicle.set_transform(carla.Transform(new_loc, vehicle.get_transform().rotation))
# 重新下发指令
vehicle.apply_control(control)

# 打印状态(简化,不阻塞)
print(f" 速度:{speed:.2f}m/s | 转向:{steer:.2f}", end='\r')
time.sleep(0.01) # 高频循环,确保指令生效

# 停车
vehicle.apply_control(carla.VehicleControl(throttle=0.0, brake=1.0))
print("\n🛑 行驶结束,已停车!")

# 打印最终状态
# 定义摄像头回调函数(保存图片/打印信息)
def camera_callback(image):
# 保存摄像头画面到本地(可选,取消注释即可)
Expand Down Expand Up @@ -105,13 +246,18 @@ def camera_callback(image):
vehicle_location = vehicle.get_location()
vehicle_velocity = vehicle.get_velocity()
print(f"\n📊 车辆最终状态:")
print(f" 位置:X={vehicle_location.x:.2f}, Y={vehicle_location.y:.2f}, Z={vehicle_location.z:.2f}")
print(f" 速度:X={vehicle_velocity.x:.2f}, Y={vehicle_velocity.y:.2f}, Z={vehicle_velocity.z:.2f}")
print(f" 位置:X={vehicle_location.x:.2f}, Y={vehicle_location.y:.2f}")
print(f" 速度:X={vehicle_velocity.x:.2f}, Y={vehicle_velocity.y:.2f}")

else:
print("⚠️ 未找到合法的车辆生成点")

except Exception as e:
print(f"\n❌ 调用失败:{e}")
print("\n🔍 排查建议:")
print("1. 关闭Carla所有窗口,结束任务管理器中的CarlaUE4.exe进程")
print("2. 重新启动Carla:CarlaUE4.exe -windowed -ResX=800 -ResY=600")
print("3. 以管理员身份运行此代码")
print(f"❌ 调用失败:{e}")
print("\n🔍 排查建议:")
print("1. 确认Carla模拟器是0.9.11版本,与代码适配")
Expand All @@ -122,16 +268,22 @@ def camera_callback(image):
finally:
time.sleep(3) # 程序结束前车辆多显示3秒

# 7. 资源清理(关键:避免模拟器残留车辆/传感器)
# 资源清理
finally:
time.sleep(3)
if camera_sensor:
camera_sensor.stop()
camera_sensor.destroy()
print("🗑️ 摄像头传感器已销毁")
if collision_sensor:
collision_sensor.stop()
collision_sensor.destroy()
print("🗑️ 碰撞传感器已销毁")
if vehicle:
vehicle.destroy()
print("🗑️ 车辆已销毁")
print("✅ 所有资源清理完成,程序正常退出")
print("✅ 所有资源清理完成")



if __name__ == "__main__":
Expand Down
Loading