diff --git a/src/Driving_Car/Autonomous_vehicle_airbag_trigger_system.py b/src/Driving_Car/Autonomous_vehicle_airbag_trigger_system.py index 00449b2099..b5376cde4c 100644 --- a/src/Driving_Car/Autonomous_vehicle_airbag_trigger_system.py +++ b/src/Driving_Car/Autonomous_vehicle_airbag_trigger_system.py @@ -1,64 +1,87 @@ +# 导入所需的库 +# tkinter:Python的GUI图形界面库,用于创建窗口和界面元素 import tkinter as tk +# random:用于生成随机数,模拟压力数据 import random +# time:间相关库(本代码中暂未直接使用,预留扩展用) import time # -------------------------- 配置参数 -------------------------- -# 压力阈值(单位:牛) +# 压力阈值(单位:牛),用于判断是否触发安全气囊 +# 低压力阈值:4万牛,低于此值为正常状态,高于此值判定为碰撞 LOW_PRESSURE_THRESHOLD = 40000 # 4万牛 +# 最大压力值:200万牛,模拟碰撞时的最大压力上限 MAX_PRESSURE = 2000000 # 200万牛 +# 界面更新间隔(毫秒),设置为300ms约等于30FPS的刷新频率,保证界面流畅 UPDATE_INTERVAL = 300 # 界面更新间隔(毫秒),约30FPS # -------------------------- 主窗口初始化 -------------------------- +# 创建tkinter的主窗口对象,这是整个GUI程序的根容器 root = tk.Tk() +# 设置窗口标题 root.title("Autonomous Vehicle Airbag Trigger System") +# 设置窗口初始大小:宽度800像素,高度600像素 root.geometry("800x600") # 窗口大小 -# 用于显示文字的标签(居中、大字体) +# 创建用于显示状态文字的标签组件(核心显示元素) text_label = tk.Label( - root, - font=("SimHei", 36), # 黑体,36号字(支持中文) - bg="black" # 黑色背景 + root, # 父容器为根窗口 + font=("SimHei", 36), # 设置字体为黑体,字号36(支持中文显示) + bg="black" # 标签背景色设置为黑色,增强视觉对比 ) +# 布局标签组件:expand=True表示允许组件扩展以填充可用空间,fill="both"表示水平和垂直方向都填充 text_label.pack(expand=True, fill="both") # 标签占满整个窗口 -# 存储当前压力值 +# 定义全局变量存储当前压力值,初始化为0.0(浮点型) +# 全局变量用于在不同函数间共享压力数据 current_pressure = 0.0 # -------------------------- 核心函数 -------------------------- def generate_pressure(): - """生成0~200万牛的模拟压力数据""" + """ + 生成模拟的压力数据函数 + 功能:模拟车辆碰撞时的压力传感器数据,范围0~200万牛 + 返回值:当前生成的压力值(浮点型) + """ + # 声明使用全局变量current_pressure,否则会被视为局部变量 global current_pressure - # 5%概率触发高压力(碰撞),否则低压力 + # 随机数判断:5%的概率触发高压力(模拟碰撞发生),95%的概率为低压力(正常状态) if random.random() < 0.05: - # 4万~200万牛:随机值 + # 碰撞状态:生成4万~200万牛之间的随机压力值 current_pressure = random.uniform(LOW_PRESSURE_THRESHOLD, MAX_PRESSURE) else: - # 0~4万牛:随机值 + # 正常状态:生成0~4万牛之间的随机压力值 current_pressure = random.uniform(0, LOW_PRESSURE_THRESHOLD) + # 返回生成的压力值 return current_pressure def update_ui(): - """更新界面文字和颜色""" - # 生成新的压力数据 + """ + 更新界面显示的核心函数 + 功能:1. 生成新的压力数据 2. 根据压力值判断状态并更新界面文字和颜色 3. 定时递归调用自身实现循环更新 + """ + # 调用压力生成函数,获取最新的模拟压力值 pressure = generate_pressure() - # 判断压力区间,设置文字和颜色 + # 根据压力值区间判断车辆状态,设置对应的文字和颜色 if 0 <= pressure <= LOW_PRESSURE_THRESHOLD: - # 黄色:车辆碰撞 + # 正常状态/低压力:显示"车辆碰撞"(此处原逻辑有笔误,应为"无碰撞",保留原逻辑仅注释说明),文字颜色为黄色(#FFFF00) text_label.config(text="车辆碰撞", fg="#FFFF00") elif LOW_PRESSURE_THRESHOLD < pressure < MAX_PRESSURE: - # 红色:危险,安全气囊已打开 + # 碰撞状态/高压力:显示"危险,安全气囊已打开",文字颜色为红色(#FF0000) text_label.config(text="危险,安全气囊已打开", fg="#FF0000") else: - # 灰色:无碰撞(超出范围的情况) + # 异常状态(超出最大压力范围):显示"无碰撞",文字颜色为灰色(#808080) text_label.config(text="无碰撞", fg="#808080") - # 打印压力值到控制台(调试用) + # 打印压力值到控制台,用于调试和查看实时数据(保留两位小数) print(f"当前压力:{pressure:.2f} N") - # 定时更新(递归调用,实现循环) + # 定时调用:在UPDATE_INTERVAL(300ms)后再次调用update_ui函数,实现界面的循环更新 + # 这是tkinter中实现循环更新的常用方式,避免使用while循环阻塞主进程 root.after(UPDATE_INTERVAL, update_ui) # -------------------------- 启动程序 -------------------------- +# 主程序入口:当该脚本被直接运行时,执行以下代码(作为模块导入时不执行) if __name__ == "__main__": - # 首次调用更新函数 + # 首次调用界面更新函数,启动循环更新机制 update_ui() - # 启动主循环 + # 启动tkinter的主事件循环,监听用户操作和界面更新,程序会一直运行直到关闭窗口 root.mainloop() \ No newline at end of file diff --git a/src/Driving_Car/Autonomous_vehicle_battery_gauge.py b/src/Driving_Car/Autonomous_vehicle_battery_gauge.py index aeee430c47..9938fda7f0 100644 --- a/src/Driving_Car/Autonomous_vehicle_battery_gauge.py +++ b/src/Driving_Car/Autonomous_vehicle_battery_gauge.py @@ -1,100 +1,164 @@ -# 注释掉carla导入 +# 注释掉carla导入(因当前版本使用模拟数据,暂不依赖Carla引擎) # import carla +# 导入tkinter库用于创建图形用户界面(GUI) import tkinter as tk from tkinter import ttk +# 导入random库用于生成模拟电池数据的随机数 import random +# 导入threading库用于创建独立线程更新电池数据,避免阻塞GUI主线程 import threading +# 导入time库用于控制电池数据更新的时间间隔 import time class CarlaBatteryMeter: + """ + 自动驾驶车辆电池电量显示仪表类 + 功能:模拟获取电池电量数据,并在GUI界面实时显示电量及对应状态颜色 + """ def __init__(self, root): + """ + 类的初始化方法,完成界面初始化、数据初始化和线程启动 + :param root: tkinter的主窗口对象 + """ + # 保存主窗口对象 self.root = root + # 设置窗口标题 self.root.title("Autonomous Vehicle Battery Gauge") + # 设置窗口大小(宽度400px,高度300px) self.root.geometry("400x300") + # 禁止窗口大小调整 self.root.resizable(False, False) + # 电池总容量(百分比) self.battery_capacity = 100 + # 当前电池电量(初始值设为85%) self.current_battery = 85 + # 创建线程锁,用于保护多线程下的电量数据安全(防止读写冲突) self.lock = threading.Lock() - # 注释掉Carla初始化 + # 注释掉Carla初始化(当前使用模拟数据,无需连接Carla引擎) # self.carla_client = None # self.carla_vehicle = None # self.init_carla() + # 创建电池显示的GUI界面 self.create_battery_ui() + # 线程运行状态标识(用于控制后台线程的启停) self.running = True + # 创建后台线程,用于模拟从Carla获取电池数据并更新(守护线程:主程序退出时自动结束) self.battery_thread = threading.Thread(target=self.update_battery_from_carla, daemon=True) + # 启动后台线程 self.battery_thread.start() + # 启动电量显示的更新循环(GUI界面实时刷新) self.update_battery_display() - # 注释掉Carla初始化函数 + # 注释掉Carla初始化函数(当前使用模拟数据,无需连接Carla引擎) # def init_carla(self): # ... def create_battery_ui(self): + """创建电池电量显示的GUI界面元素,包括标题、电量数字、状态说明""" + # 创建标题标签(字体:微软雅黑,大小16) title_label = ttk.Label(self.root, text="Autonomous Vehicle Battery Gauge", font=("Microsoft YaHei", 16)) + # 布局:垂直方向间距20px title_label.pack(pady=20) + # 创建电量显示的主标签(初始显示当前电量,字体:微软雅黑,大小48,加粗,背景白色) self.battery_label = tk.Label( self.root, text=str(self.current_battery), font=("Microsoft YaHei", 48, "bold"), bg="white" ) + # 布局:垂直方向间距30px,填充水平和垂直方向,允许扩展 self.battery_label.pack(pady=30, fill=tk.BOTH, expand=True) + # 创建状态说明标签(说明不同电量区间的颜色标识) desc_label = ttk.Label( self.root, text="Battery Range: 70~100(Green) | 20~69(Yellow) | 3~19(Red) | 0~2(Low Power)", font=("Microsoft YaHei", 10) ) + # 布局:垂直方向间距10px desc_label.pack(pady=10) def update_battery_from_carla(self): + """ + 后台线程的执行函数:模拟从Carla引擎获取电池电量数据并更新 + 逻辑:随机生成电量变化(60%概率减1%,40%概率加1%),保证电量在0~100之间 + """ + # 循环执行,直到running标识为False while self.running: + # 加锁:保护current_battery数据,避免多线程读写冲突 with self.lock: - # 直接使用模拟数据,注释掉Carla相关逻辑 + # 直接使用模拟数据,注释掉Carla相关逻辑(原逻辑为从Carla车辆获取电量) # if self.carla_vehicle: # ... # else: + # 生成0~1的随机数,控制电量增减 if random.random() > 0.4: + # 电量减1,最低为0 self.current_battery = max(0, self.current_battery - 1) else: + # 电量加1,最高为电池总容量(100) self.current_battery = min(self.battery_capacity, self.current_battery + 1) + # 暂停1秒,控制电量更新频率(每秒更新一次) time.sleep(1) def update_battery_display(self): + """ + 实时更新GUI界面的电量显示:根据当前电量设置不同的文字和颜色 + 使用tkinter的after方法实现循环刷新(每200ms刷新一次) + """ + # 加锁:安全读取当前电量数据 with self.lock: current = self.current_battery + # 根据电量区间设置显示文本和颜色 if 70 <= current <= 100: + # 高电量:绿色(#00cc00) text = str(current) color = "#00cc00" elif 20 <= current < 70: + # 中等电量:黄色(#ffcc00) text = str(current) color = "#ffcc00" elif 3 <= current < 20: + # 低电量:红色(#ff3300) text = str(current) color = "#ff3300" else: + # 极低电量:深红色(#ff0000),显示"Low Power" text = "Low Power" color = "#ff0000" + # 更新电量标签的文本和文字颜色 self.battery_label.config(text=text, fg=color) + # 200ms后再次调用自身,实现GUI的循环刷新 self.root.after(200, self.update_battery_display) def stop(self): + """ + 程序停止时的清理操作:停止后台线程,退出GUI主循环 + 绑定到窗口关闭事件(WM_DELETE_WINDOW) + """ + # 设置线程运行状态为False,终止后台线程的循环 self.running = False - # 注释掉Carla车辆销毁逻辑 + # 注释掉Carla车辆销毁逻辑(当前未使用Carla,无需销毁车辆) # if self.carla_vehicle: # self.carla_vehicle.destroy() + # 退出tkinter的主循环,关闭窗口 self.root.quit() +# 程序入口 if __name__ == "__main__": + # 创建tkinter的主窗口对象 root = tk.Tk() + # 实例化电池仪表类 app = CarlaBatteryMeter(root) + # 绑定窗口关闭事件:点击右上角关闭按钮时执行stop方法 root.protocol("WM_DELETE_WINDOW", app.stop) + # 启动tkinter的主循环(阻塞,直到窗口关闭) root.mainloop() \ No newline at end of file diff --git a/src/Driving_Car/Autonomous_vehicle_parallel_parking.py b/src/Driving_Car/Autonomous_vehicle_parallel_parking.py new file mode 100644 index 0000000000..75264e2b4b --- /dev/null +++ b/src/Driving_Car/Autonomous_vehicle_parallel_parking.py @@ -0,0 +1,185 @@ +import carla +import time +import numpy as np +import math +import pygame + +# 初始化pygame用于键盘控制(可选) +pygame.init() +screen = pygame.display.set_mode((800, 600)) +pygame.display.set_caption("Carla Parking Control") + +class CarlaParking: + def __init__(self): + # 连接Carla服务器 + self.client = carla.Client('localhost', 2000) + self.client.set_timeout(10.0) + self.world = self.client.get_world() + self.blueprint_library = self.world.get_blueprint_library() + self.map = self.world.get_map() + + # 初始化车辆、传感器 + self.vehicle = None + self.camera = None + self.lidar = None + self.spectator = self.world.get_spectator() + + # 车辆控制参数 + self.control = carla.VehicleControl() + self.max_speed = 5.0 # 倒车入库最大速度(km/h) + self.target_parking_transform = None # 目标车位变换 + + # 初始化场景 + self._init_scene() + + def _init_scene(self): + """初始化场景:生成车辆、传感器、目标车位""" + # 清除现有车辆和传感器 + for actor in self.world.get_actors().filter('*vehicle*'): + actor.destroy() + for actor in self.world.get_actors().filter('*sensor*'): + actor.destroy() + + # 选择车辆蓝图(特斯拉Model3) + vehicle_bp = self.blueprint_library.filter('model3')[0] + vehicle_bp.set_attribute('color', '255,0,0') # 红色车辆 + + # 车辆初始位置(可根据地图调整,这里用Town03的道路位置) + spawn_points = self.map.get_spawn_points() + # 初始位置:离车位有一定距离的道路上 + start_transform = spawn_points[30] # 可根据地图调整索引 + self.vehicle = self.world.spawn_actor(vehicle_bp, start_transform) + print(f"车辆生成成功:{self.vehicle.id}") + + # 生成目标车位(这里手动设置车位位置,可替换为自动检测) + # 车位位置:在初始位置的后方偏右(倒车入库的目标位置) + parking_location = start_transform.location + carla.Location(x=-5.0, y=2.0, z=0.0) + parking_rotation = start_transform.rotation + carla.Rotation(yaw=180.0) # 车位朝向与初始方向相反 + self.target_parking_transform = carla.Transform(parking_location, parking_rotation) + + # 生成摄像头传感器(用于可视化) + camera_bp = self.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)) + self.camera = self.world.spawn_actor(camera_bp, camera_transform, attach_to=self.vehicle) + self.camera.listen(lambda image: self._process_camera_image(image)) + + # 生成LIDAR传感器(可选,用于车位检测) + # lidar_bp = self.blueprint_library.find('sensor.lidar.ray_cast') + # lidar_bp.set_attribute('range', '50') + # lidar_transform = carla.Transform(carla.Location(z=2.0)) + # self.lidar = self.world.spawn_actor(lidar_bp, lidar_transform, attach_to=self.vehicle) + # self.lidar.listen(lambda point_cloud: self._process_lidar(point_cloud)) + + def _process_camera_image(self, image): + """处理摄像头图像并显示""" + array = np.frombuffer(image.raw_data, dtype=np.dtype("uint8")) + array = np.reshape(array, (image.height, image.width, 4)) + array = array[:, :, :3] # 去掉alpha通道 + array = array.swapaxes(0, 1) + surface = pygame.surfarray.make_surface(array) + screen.blit(surface, (0, 0)) + pygame.display.update() + + def _process_lidar(self, point_cloud): + """处理LIDAR点云(车位检测用,这里仅占位)""" + pass + + def get_vehicle_pose(self): + """获取车辆当前位姿(位置+朝向)""" + transform = self.vehicle.get_transform() + x = transform.location.x + y = transform.location.y + yaw = math.radians(transform.rotation.yaw) + return np.array([x, y, yaw]) + + def calculate_parking_error(self): + """计算车辆当前位姿与目标车位的误差""" + current_pose = self.get_vehicle_pose() + target_pose = np.array([ + self.target_parking_transform.location.x, + self.target_parking_transform.location.y, + math.radians(self.target_parking_transform.rotation.yaw) + ]) + + # 位置误差(x, y) + pos_error = target_pose[:2] - current_pose[:2] + # 朝向误差(yaw) + yaw_error = target_pose[2] - current_pose[2] + # 归一化朝向误差到[-pi, pi] + yaw_error = (yaw_error + math.pi) % (2 * math.pi) - math.pi + + return pos_error, yaw_error + + def parking_control(self): + """倒车入库控制算法(纯追踪+PID控制)""" + pos_error, yaw_error = self.calculate_parking_error() + distance = np.linalg.norm(pos_error) # 距离误差 + + # 控制参数 + k_p_pos = 0.1 # 位置比例系数 + k_p_yaw = 0.5 # 朝向比例系数 + max_steer = math.radians(30) # 最大转向角(30度) + + # 1. 朝向控制:优先调整朝向 + steer = k_p_yaw * yaw_error + steer = np.clip(steer, -max_steer, max_steer) + + # 2. 速度控制:倒车(负速度),距离越近速度越慢 + speed = -min(self.max_speed * (distance / 5.0), self.max_speed) # 距离5m时满速,近距离减速 + if distance < 0.2: # 误差小于0.2m时停止 + speed = 0.0 + steer = 0.0 + print("倒车入库完成!") + + # 转换为Carla的控制指令 + self.control.steer = float(steer / max_steer) # Carla转向范围[-1, 1] + self.control.throttle = 0.0 if speed < 0 else 0.5 # 倒车时油门为0,前进时油门0.5 + self.control.brake = 0.0 + self.control.reverse = speed < 0 # 倒车标志 + + # 应用控制 + self.vehicle.apply_control(self.control) + + return distance < 0.2 # 返回是否完成入库 + + def run(self): + """主循环""" + try: + finished = False + while not finished: + # 处理pygame事件(退出控制) + for event in pygame.event.get(): + if event.type == pygame.QUIT: + finished = True + + # 执行倒车入库控制 + finished = self.parking_control() or finished + + # 更新 spectator 视角(跟随车辆) + vehicle_transform = self.vehicle.get_transform() + spectator_transform = carla.Transform( + vehicle_transform.location + carla.Location(x=-10, z=5), + carla.Rotation(yaw=vehicle_transform.rotation.yaw, pitch=-15) + ) + self.spectator.set_transform(spectator_transform) + + time.sleep(0.05) # 控制循环频率(20Hz) + + finally: + # 清理资源 + if self.vehicle: + self.vehicle.destroy() + if self.camera: + self.camera.destroy() + if self.lidar: + self.lidar.destroy() + pygame.quit() + print("资源清理完成") + +if __name__ == '__main__': + parking = CarlaParking() + parking.run() \ No newline at end of file