Repository navigation
Carla 0.9.10路侧感知代码:适配draw_circle缺失,添加3D可视化 #4485
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
Closed
Closed
Changes from all commits
Commits
Show all changes
6 commits
Select commit
Hold shift + click to select a range
9a8943d
路侧感知数据集预处理
ou-yang220 b57cf05
Merge branch 'OpenHUTB:main' into main
ou-yang220 fd0f9d5
Carla 0.9.10路侧感知数据采集
ou-yang220 7c678c2
Merge branch 'main' of https://github.com/ou-yang220/nn2
ou-yang220 24b6231
Carla 0.9.10路侧感知代码
ou-yang220 2d1bc38
Merge branch 'OpenHUTB:main' into main
ou-yang220 File filter
Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
There are no files selected for viewing
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,273 @@ | ||
| #!/usr/bin/env python3 | ||
| # -*- coding: utf-8 -*- | ||
| """ | ||
| Carla 0.9.10 路侧感知采集(可视化版) | ||
| 适配0.9.10:移除draw_circle,用draw_line模拟激光雷达范围 | ||
| 运行前:启动D:\WindowsNoEditor\CarlaUE4.exe,等待1分钟初始化 | ||
| """ | ||
| import sys | ||
| import os | ||
| import time | ||
| import json | ||
| import math | ||
| from typing import Dict, Any | ||
|
|
||
| # ========== 加载Carla egg文件 ========== | ||
| CARLA_EGG_PATH = r"D:\WindowsNoEditor\PythonAPI\carla\dist\carla-0.9.10-py3.7-win-amd64.egg" | ||
| sys.path.append(CARLA_EGG_PATH) | ||
|
|
||
| # 导入Carla并容错 | ||
| try: | ||
| import carla | ||
|
|
||
| print(f"✅ 成功加载Carla API(0.9.10适配版)") | ||
| except Exception as e: | ||
| print(f"❌ 加载Carla API失败:{str(e)}") | ||
| sys.exit(1) | ||
|
|
||
| # ========== 配置项 ========== | ||
| CARLA_HOST = "localhost" | ||
| CARLA_PORT = 2000 | ||
| TIMEOUT = 20.0 | ||
| SAVE_DIR = "carla_sensor_data" | ||
| VEHICLE_NUM = 3 | ||
| # 可视化配置 | ||
| VISUALIZATION_DURATION = 30.0 # 可视化效果持续30秒 | ||
| LIDAR_RANGE = 100.0 # 激光雷达范围 | ||
|
|
||
|
|
||
| # ========== 连接模拟器 ========== | ||
| def connect_carla(): | ||
| """连接Carla,获取client、world、视角原点""" | ||
| try: | ||
| client = carla.Client(CARLA_HOST, CARLA_PORT) | ||
| client.set_timeout(TIMEOUT) | ||
| world = client.load_world("Town01") | ||
| time.sleep(3) | ||
|
|
||
| # 获取视角当前的位置 | ||
| spectator = world.get_spectator() | ||
| spectator_transform = spectator.get_transform() | ||
| print(f"✅ 视角当前位置:x={spectator_transform.location.x:.1f}, y={spectator_transform.location.y:.1f}") | ||
| print(f"✅ 成功连接Carla(Town01地图):{CARLA_HOST}:{CARLA_PORT}") | ||
| return client, world, spectator_transform | ||
| except Exception as e: | ||
| print(f"❌ 连接失败:{str(e)}") | ||
| sys.exit(1) | ||
|
|
||
|
|
||
| # ========== 在视角前生成车辆 ========== | ||
| def spawn_vehicles_in_view(world, spectator_transform): | ||
| """在视角正前方生成车辆,返回生成的车辆列表""" | ||
| # 1. 清除现有车辆 | ||
| vehicles = world.get_actors().filter("vehicle.*") | ||
| for v in vehicles: | ||
| v.destroy() | ||
| print(f"🗑️ 已清除 {len(vehicles)} 辆旧车辆") | ||
|
|
||
| # 2. 选择黑色特斯拉 | ||
| blueprint_lib = world.get_blueprint_library() | ||
| vehicle_bp = blueprint_lib.find("vehicle.tesla.model3") | ||
| vehicle_bp.set_attribute("color", "0,0,0") | ||
| if not vehicle_bp: | ||
| vehicle_bp = blueprint_lib.filter("vehicle.*")[0] | ||
|
|
||
| # 3. 计算视角正前方生成位置 | ||
| spawn_positions = [ | ||
| carla.Location( | ||
| x=spectator_transform.location.x + 5 * math.cos(math.radians(spectator_transform.rotation.yaw)), | ||
| y=spectator_transform.location.y + 5 * math.sin(math.radians(spectator_transform.rotation.yaw)) + 1, | ||
| z=0.5 | ||
| ), | ||
| carla.Location( | ||
| x=spectator_transform.location.x + 8 * math.cos(math.radians(spectator_transform.rotation.yaw)), | ||
| y=spectator_transform.location.y + 8 * math.sin(math.radians(spectator_transform.rotation.yaw)) - 1, | ||
| z=0.5 | ||
| ), | ||
| carla.Location( | ||
| x=spectator_transform.location.x + 11 * math.cos(math.radians(spectator_transform.rotation.yaw)), | ||
| y=spectator_transform.location.y + 11 * math.sin(math.radians(spectator_transform.rotation.yaw)), | ||
| z=0.5 | ||
| ) | ||
| ] | ||
|
|
||
| # 4. 逐个生成车辆并记录 | ||
| spawned_vehicles = [] | ||
| for i in range(VEHICLE_NUM): | ||
| try: | ||
| vehicle_yaw = spectator_transform.rotation.yaw + 180 | ||
| transform = carla.Transform(spawn_positions[i], carla.Rotation(yaw=vehicle_yaw)) | ||
| vehicle = world.spawn_actor(vehicle_bp, transform) | ||
| if vehicle: | ||
| spawned_vehicles.append(vehicle) | ||
| print(f"🚗 成功生成第{i + 1}辆车(在视角前{5 + i * 3}米处)") | ||
| time.sleep(1) | ||
| except Exception as e: | ||
| print(f"⚠️ 第{i + 1}辆车生成失败:{str(e)}") | ||
| continue | ||
|
|
||
| print(f"✅ 车辆生成完成:成功 {len(spawned_vehicles)}/{VEHICLE_NUM} 辆") | ||
| return spawned_vehicles | ||
|
|
||
|
|
||
| # ========== 在CarlaUE4中可视化运行效果(适配0.9.10) ========== | ||
| def visualize_in_carla(world, spectator_transform, spawned_vehicles): | ||
| """在CarlaUE4窗口中绘制:车辆ID标注、激光雷达范围(用线模拟)、路侧单元位置""" | ||
| debug = world.debug # Carla 0.9.10调试工具 | ||
|
|
||
| # 1. 绘制路侧单元(RSU)位置(红色立方体+文字) | ||
| rsu_location = spectator_transform.location | ||
| debug.draw_box( | ||
| box=carla.BoundingBox(rsu_location, carla.Vector3D(1, 1, 2)), | ||
| rotation=spectator_transform.rotation, | ||
| thickness=0.1, | ||
| color=carla.Color(255, 0, 0), # 红色 | ||
| life_time=VISUALIZATION_DURATION | ||
| ) | ||
| debug.draw_string( | ||
| rsu_location + carla.Location(z=2), | ||
| "RSU_001(路侧单元)", | ||
| color=carla.Color(255, 0, 0), | ||
| life_time=VISUALIZATION_DURATION | ||
| ) | ||
|
|
||
| # 2. 模拟绘制激光雷达范围(替换draw_circle,0.9.10支持) | ||
| # 用多条线绘制圆形轮廓,模拟100米激光雷达范围 | ||
| center = rsu_location | ||
| num_segments = 36 # 36条线组成圆形,足够平滑 | ||
| for i in range(num_segments): | ||
| # 计算线段起点和终点 | ||
| angle1 = math.radians(i * 10) | ||
| angle2 = math.radians((i + 1) * 10) | ||
| start = carla.Location( | ||
| x=center.x + LIDAR_RANGE * math.cos(angle1), | ||
| y=center.y + LIDAR_RANGE * math.sin(angle1), | ||
| z=center.z + 0.1 # 略高于地面,避免被遮挡 | ||
| ) | ||
| end = carla.Location( | ||
| x=center.x + LIDAR_RANGE * math.cos(angle2), | ||
| y=center.y + LIDAR_RANGE * math.sin(angle2), | ||
| z=center.z + 0.1 | ||
| ) | ||
| # 绘制蓝色线段 | ||
| debug.draw_line( | ||
| start, end, | ||
| thickness=0.5, | ||
| color=carla.Color(0, 0, 255), # 蓝色 | ||
| life_time=VISUALIZATION_DURATION | ||
| ) | ||
| # 标注激光雷达范围文字 | ||
| debug.draw_string( | ||
| center + carla.Location(z=3), | ||
| f"激光雷达范围:{LIDAR_RANGE}m", | ||
| color=carla.Color(0, 0, 255), | ||
| life_time=VISUALIZATION_DURATION | ||
| ) | ||
|
|
||
| # 3. 为每辆车添加3D标注(绿色立方体+黄色文字) | ||
| for idx, vehicle in enumerate(spawned_vehicles): | ||
| v_loc = vehicle.get_transform().location | ||
| # 绘制车辆包围盒 | ||
| debug.draw_box( | ||
| box=carla.BoundingBox(v_loc, carla.Vector3D(2, 1, 1)), | ||
| rotation=vehicle.get_transform().rotation, | ||
| thickness=0.1, | ||
| color=carla.Color(0, 255, 0), # 绿色 | ||
| life_time=VISUALIZATION_DURATION | ||
| ) | ||
| # 绘制车辆ID和坐标 | ||
| debug.draw_string( | ||
| v_loc + carla.Location(z=1.5), | ||
| f"车辆{idx + 1}\nID:{vehicle.id}\nx:{v_loc.x:.1f}, y:{v_loc.y:.1f}", | ||
| color=carla.Color(255, 255, 0), # 黄色 | ||
| life_time=VISUALIZATION_DURATION | ||
| ) | ||
|
|
||
| print(f"✅ 可视化效果已绘制在CarlaUE4窗口(持续{VISUALIZATION_DURATION}秒)") | ||
|
|
||
|
|
||
| # ========== 采集路侧数据 ========== | ||
| def get_roadside_data(world, spawned_vehicles, spectator_transform): | ||
| """采集数据,兼容可视化场景""" | ||
| try: | ||
| lidar_cfg = {"range": f"{LIDAR_RANGE}m", "freq": "10Hz"} | ||
| camera_cfg = {"resolution": "1920x1080"} | ||
|
|
||
| vehicle_data = [] | ||
| for v in spawned_vehicles: | ||
| trans = v.get_transform() | ||
| vehicle_data.append({ | ||
| "id": v.id, | ||
| "model": v.type_id, | ||
| "x": float(trans.location.x), | ||
| "y": float(trans.location.y), | ||
| "z": float(trans.location.z), | ||
| "yaw": float(trans.rotation.yaw) | ||
| }) | ||
|
|
||
| return { | ||
| "timestamp": time.strftime("%Y%m%d_%H%M%S"), | ||
| "roadside_id": "RSU_001", | ||
| "rsu_location": { | ||
| "x": float(spectator_transform.location.x), | ||
| "y": float(spectator_transform.location.y), | ||
| "z": float(spectator_transform.location.z) | ||
| }, | ||
| "lidar_config": lidar_cfg, | ||
| "camera_config": camera_cfg, | ||
| "detected_vehicles": vehicle_data, | ||
| "vehicle_count": len(vehicle_data) | ||
| } | ||
| except Exception as e: | ||
| print(f"⚠️ 采集数据异常:{str(e)}") | ||
| return {"timestamp": time.strftime("%Y%m%d_%H%M%S"), "vehicle_count": 0} | ||
|
|
||
|
|
||
| # ========== 保存数据 ========== | ||
| def save_data(data): | ||
| """保存数据到绝对路径""" | ||
| save_path = os.path.abspath(SAVE_DIR) | ||
| os.makedirs(save_path, exist_ok=True) | ||
| file_name = f"roadside_data_{data['timestamp']}.json" | ||
| file_path = os.path.join(save_path, file_name) | ||
| with open(file_path, "w", encoding="utf-8") as f: | ||
| json.dump(data, f, ensure_ascii=False, indent=4) | ||
| print(f"✅ 数据已保存:{file_path}") | ||
|
|
||
|
|
||
| # ========== 主函数 ========== | ||
| def main(): | ||
| print("===== Carla 0.9.10 路侧感知采集(可视化版) =====\n") | ||
| # 1. 连接模拟器 | ||
| client, world, spectator_transform = connect_carla() | ||
|
|
||
| # 2. 生成车辆 | ||
| spawned_vehicles = spawn_vehicles_in_view(world, spectator_transform) | ||
|
|
||
| # 3. 可视化运行效果(核心:CarlaUE4内直接展示) | ||
| visualize_in_carla(world, spectator_transform, spawned_vehicles) | ||
|
|
||
| # 4. 调整视角 | ||
| spectator = world.get_spectator() | ||
| new_rotation = carla.Rotation( | ||
| pitch=spectator_transform.rotation.pitch - 5, | ||
| yaw=spectator_transform.rotation.yaw, | ||
| roll=spectator_transform.rotation.roll | ||
| ) | ||
| spectator.set_transform(carla.Transform(spectator_transform.location, new_rotation)) | ||
|
|
||
| # 5. 采集数据(修正:传入spectator_transform) | ||
| print("🔍 正在采集路侧感知数据...") | ||
| sensor_data = get_roadside_data(world, spawned_vehicles, spectator_transform) | ||
|
|
||
| # 6. 保存数据 | ||
| save_data(sensor_data) | ||
|
|
||
| # 7. 输出结果 | ||
| print(f"\n📊 采集完成!共检测到 {sensor_data['vehicle_count']} 辆车辆") | ||
| print(f"\n💡 可视化效果在CarlaUE4窗口持续{VISUALIZATION_DURATION}秒,可开始录视频!") | ||
| print("===== 操作结束 =====\n") | ||
|
|
||
|
|
||
| if __name__ == "__main__": | ||
| main() | ||
Oops, something went wrong.
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
避免使用绝对路径