From 0d5b42a9cb1e926b8e5fa2212416706a5c8d18a2 Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Thu, 18 Dec 2025 20:07:24 +0800 Subject: [PATCH 1/8] =?UTF-8?q?=E6=A8=A1=E5=9D=97=E5=8C=96PID=E6=8E=A7?= =?UTF-8?q?=E5=88=B6=E4=BC=98=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- .../object_detection.py | 106 ++++++++++++------ 1 file changed, 70 insertions(+), 36 deletions(-) diff --git a/src/Object_Tracking_Planning/object_detection.py b/src/Object_Tracking_Planning/object_detection.py index 97cba38106..919f3f96c9 100644 --- a/src/Object_Tracking_Planning/object_detection.py +++ b/src/Object_Tracking_Planning/object_detection.py @@ -1178,7 +1178,7 @@ def _pid_control(self, target_speed, current_speed): return np.clip((self._k_p * error) + (self._k_d * _de) + (self._k_i * _ie), -1.0, 1.0) -class PIDLateralController(): +class PIDLateralController: """ PIDLateralController implements lateral control using a PID. """ @@ -1187,64 +1187,98 @@ def __init__(self, vehicle, K_P=1.0, K_D=0.0, K_I=0.0, dt=0.03): """ Constructor method. - :param vehicle: actor to apply to local planner logic onto - :param K_P: Proportional term - :param K_D: Differential term - :param K_I: Integral term - :param dt: time differential in seconds + Args: + vehicle: Actor to apply local planner logic onto + K_P: Proportional term coefficient (default: 1.0) + K_D: Differential term coefficient (default: 0.0) + K_I: Integral term coefficient (default: 0.0) + dt: Time differential in seconds (default: 0.03) """ self._vehicle = vehicle self._k_p = K_P self._k_d = K_D self._k_i = K_I self._dt = dt - self._e_buffer = deque(maxlen=10) + self._error_buffer = deque(maxlen=10) def run_step(self, waypoint): """ - Execute one step of lateral control to steer - the vehicle towards a certain waypoin. + Execute one step of lateral control to steer the vehicle towards a waypoint. - :param waypoint: target waypoint - :return: steering control in the range [-1, 1] where: - -1 maximum steering to left - +1 maximum steering to right + Args: + waypoint: Target waypoint + + Returns: + float: Steering control in range [-1, 1] where: + -1 = maximum steering to left + +1 = maximum steering to right """ return self._pid_control(waypoint, self._vehicle.get_transform()) def _pid_control(self, waypoint, vehicle_transform): """ - Estimate the steering angle of the vehicle based on the PID equations + Estimate steering angle based on PID equations. - :param waypoint: target waypoint - :param vehicle_transform: current transform of the vehicle - :return: steering control in the range [-1, 1] + Args: + waypoint: Target waypoint + vehicle_transform: Current transform of the vehicle + + Returns: + float: Steering control in range [-1, 1] """ + # Calculate vehicle direction vector v_begin = vehicle_transform.location - v_end = v_begin + carla.Location(x=math.cos(math.radians(vehicle_transform.rotation.yaw)), - y=math.sin(math.radians(vehicle_transform.rotation.yaw))) + yaw_rad = math.radians(vehicle_transform.rotation.yaw) + v_end = v_begin + carla.Location( + x=math.cos(yaw_rad), + y=math.sin(yaw_rad) + ) + # Calculate vectors v_vec = np.array([v_end.x - v_begin.x, v_end.y - v_begin.y, 0.0]) - w_vec = np.array([waypoint.transform.location.x - - v_begin.x, waypoint.transform.location.y - - v_begin.y, 0.0]) - _dot = math.acos(np.clip(np.dot(w_vec, v_vec) / - (np.linalg.norm(w_vec) * np.linalg.norm(v_vec)), -1.0, 1.0)) - - _cross = np.cross(v_vec, w_vec) + w_vec = np.array([ + waypoint.transform.location.x - v_begin.x, + waypoint.transform.location.y - v_begin.y, + 0.0 + ]) + + # Calculate angle difference + v_norm = np.linalg.norm(v_vec) + w_norm = np.linalg.norm(w_vec) + dot_product = np.dot(w_vec, v_vec) / (v_norm * w_norm) + dot_product_clipped = np.clip(dot_product, -1.0, 1.0) + angle_diff = math.acos(dot_product_clipped) + + # Determine sign based on cross product + cross_product = np.cross(v_vec, w_vec) + if cross_product[2] < 0: + angle_diff *= -1.0 + + # Update error buffer and calculate PID terms + self._error_buffer.append(angle_diff) + + # Calculate derivative and integral terms + derivative_error = self._calculate_derivative_error() + integral_error = self._calculate_integral_error() + + # PID calculation with clamping + pid_output = ( + self._k_p * angle_diff + + self._k_d * derivative_error + + self._k_i * integral_error + ) - if _cross[2] < 0: - _dot *= -1.0 + return np.clip(pid_output, -1.0, 1.0) - self._e_buffer.append(_dot) - if len(self._e_buffer) >= 2: - _de = (self._e_buffer[-1] - self._e_buffer[-2]) / self._dt - _ie = sum(self._e_buffer) * self._dt - else: - _de = 0.0 - _ie = 0.0 + def _calculate_derivative_error(self): + """Calculate derivative error term.""" + if len(self._error_buffer) >= 2: + return (self._error_buffer[-1] - self._error_buffer[-2]) / self._dt + return 0.0 - return np.clip((self._k_p * _dot) + (self._k_d * _de) + (self._k_i * _ie), -1.0, 1.0) + def _calculate_integral_error(self): + """Calculate integral error term.""" + return sum(self._error_buffer) * self._dt # ============================================================================== From 837902a843be986dcc615ac4ee2a23b05222a015 Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Fri, 19 Dec 2025 14:57:41 +0800 Subject: [PATCH 2/8] =?UTF-8?q?=E7=AE=80=E6=B4=81=E5=8C=96=E4=B8=8E?= =?UTF-8?q?=E7=8E=AF=E5=A2=83=E7=AE=A1=E7=90=86=E4=BC=98=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- .../object_detection.py | 172 ++++++++++++------ 1 file changed, 113 insertions(+), 59 deletions(-) diff --git a/src/Object_Tracking_Planning/object_detection.py b/src/Object_Tracking_Planning/object_detection.py index 919f3f96c9..a05617ff4c 100644 --- a/src/Object_Tracking_Planning/object_detection.py +++ b/src/Object_Tracking_Planning/object_detection.py @@ -105,113 +105,167 @@ def get_actor_display_name(actor, truncate=250): # ============================================================================== class World(object): - """ Class representing the surrounding environment """ + """Class representing the surrounding environment""" + + # 常量提取 + DEFAULT_VEHICLE_MODEL = 'model3' + DEFAULT_VEHICLE_COLOR = '236,102,17' def __init__(self, carla_world, hud, args): """Constructor method""" self.world = carla_world - try: - self.map = self.world.get_map() - except RuntimeError as error: - print('RuntimeError: {}'.format(error)) - print(' The server could not send the OpenDRIVE (.xodr) file:') - print(' Make sure it exists, has the same name of your town, and is correct.') - sys.exit(1) self.hud = hud + self.args = args + + self._initialize_map() + self._weather_presets = find_weather_presets() + self._weather_index = 0 + + # 初始化所有传感器和玩家为None self.player = None self.collision_sensor = None self.lane_invasion_sensor = None self.gnss_sensor = None self.camera_manager = None - self._weather_presets = find_weather_presets() - self._weather_index = 0 - self._actor_filter = args.filter - self._gamma = args.gamma - self.restart(args) - self.world.on_tick(hud.on_world_tick) + self.recording_enabled = False self.recording_start = 0 - def restart(self, args): + self.restart() + self.world.on_tick(hud.on_world_tick) + + def _initialize_map(self): + """初始化地图,处理可能的错误""" + try: + self.map = self.world.get_map() + except RuntimeError as error: + print(f'RuntimeError: {error}') + print('The server could not send the OpenDRIVE (.xodr) file:') + print('Make sure it exists, has the same name of your town, and is correct.') + sys.exit(1) + + def restart(self): """Restart the world""" - # Keep same camera config if the camera manager exists. - cam_index = self.camera_manager.index if self.camera_manager is not None else 0 - cam_pos_id = self.camera_manager.transform_index if self.camera_manager is not None else 0 - # Set the seed if requested by user - if args.seed is not None: - random.seed(args.seed) - - # KK Get a vehicle blueprint - # blueprint = self.world.get_blueprint_library().filter('vehicle.lincoln.mkz2017')[0] # KK - blueprint = self.world.get_blueprint_library().filter('model3')[0] + # 保存相机状态 + cam_index = self.camera_manager.index if self.camera_manager else 0 + cam_pos_id = self.camera_manager.transform_index if self.camera_manager else 0 + + # 设置随机种子 + if self.args.seed is not None: + random.seed(self.args.seed) + + # 创建并配置车辆 + blueprint = self._create_vehicle_blueprint() + + # 生成玩家车辆 + self._spawn_player(blueprint) + + # 设置传感器 + self._setup_sensors(cam_index, cam_pos_id) + + def _create_vehicle_blueprint(self): + """创建并配置车辆蓝图""" + blueprint_lib = self.world.get_blueprint_library() + blueprint = blueprint_lib.filter(self.DEFAULT_VEHICLE_MODEL)[0] blueprint.set_attribute('role_name', 'hero') + if blueprint.has_attribute('color'): - color = '236,102,17' # KK Packt logo color - blueprint.set_attribute('color', color) - # Spawn the player. - print("Spawning the player") + blueprint.set_attribute('color', self.DEFAULT_VEHICLE_COLOR) + + return blueprint + + def _spawn_player(self, blueprint): + """生成玩家车辆""" + # 如果玩家已存在,在当前位置重新生成 if self.player is not None: - spawn_point = self.player.get_transform() - spawn_point.location.z += 2.0 - spawn_point.rotation.roll = 0.0 - spawn_point.rotation.pitch = 0.0 - self.destroy() + spawn_point = self._get_respawn_point() + self.destroy() # 销毁现有actor self.player = self.world.try_spawn_actor(blueprint, spawn_point) - while self.player is None: - if not self.map.get_spawn_points(): - print('There are no spawn points available in your map/town.') - print('Please add some Vehicle Spawn Point to your UE4 scene.') - sys.exit(1) - spawn_points = self.map.get_spawn_points() - spawn_point = random.choice(spawn_points) if spawn_points else carla.Transform() - # spawn_point = spawn_points[0] if spawn_points else carla.Transform() # KK + # 首次生成或重新生成失败时 + if self.player is None: + spawn_point = self._get_random_spawn_point() self.player = self.world.try_spawn_actor(blueprint, spawn_point) - # Set up the sensors. + + def _get_respawn_point(self): + """获取重新生成点(当前位置上方)""" + spawn_point = self.player.get_transform() + spawn_point.location.z += 2.0 + spawn_point.rotation.roll = 0.0 + spawn_point.rotation.pitch = 0.0 + return spawn_point + + def _get_random_spawn_point(self): + """获取随机生成点""" + spawn_points = self.map.get_spawn_points() + + if not spawn_points: + print('There are no spawn points available in your map/town.') + print('Please add some Vehicle Spawn Point to your UE4 scene.') + sys.exit(1) + + return random.choice(spawn_points) + + def _setup_sensors(self, cam_index, cam_pos_id): + """设置所有传感器""" self.collision_sensor = CollisionSensor(self.player, self.hud) self.lane_invasion_sensor = LaneInvasionSensor(self.player, self.hud) self.gnss_sensor = GnssSensor(self.player) - self.camera_manager = CameraManager(self.player, self.hud, self._gamma) + + self.camera_manager = CameraManager(self.player, self.hud, self.args.gamma) self.camera_manager.transform_index = cam_pos_id self.camera_manager.set_sensor(cam_index, notify=False) + + # 通知玩家类型 actor_type = get_actor_display_name(self.player) self.hud.notification(actor_type) def next_weather(self, reverse=False): - """Get next weather setting""" + """切换到下一个天气预设""" self._weather_index += -1 if reverse else 1 self._weather_index %= len(self._weather_presets) + preset = self._weather_presets[self._weather_index] - self.hud.notification('Weather: %s' % preset[1]) - self.player.get_world().set_weather(preset[0]) + self.hud.notification(f'Weather: {preset[1]}') + self.world.set_weather(preset[0]) def tick(self, clock): - """Method for every tick""" + """每一帧的更新方法""" self.hud.tick(self, clock) def render(self, display): - """Render world""" + """渲染世界""" self.camera_manager.render(display) self.hud.render(display) def destroy_sensors(self): - """Destroy sensors""" - self.camera_manager.sensor.destroy() - self.camera_manager.sensor = None - self.camera_manager.index = None + """销毁所有传感器""" + if self.camera_manager and self.camera_manager.sensor: + self.camera_manager.sensor.destroy() + self.camera_manager.sensor = None + self.camera_manager.index = None def destroy(self): - """Destroys all actors""" + """销毁所有actor""" actors = [ - self.camera_manager.sensor, - self.collision_sensor.sensor, - self.lane_invasion_sensor.sensor, - self.gnss_sensor.sensor, - self.player] + self.camera_manager.sensor if self.camera_manager else None, + self.collision_sensor.sensor if self.collision_sensor else None, + self.lane_invasion_sensor.sensor if self.lane_invasion_sensor else None, + self.gnss_sensor.sensor if self.gnss_sensor else None, + self.player + ] + for actor in actors: if actor is not None: actor.destroy() + # 重置引用 + self.player = None + self.collision_sensor = None + self.lane_invasion_sensor = None + self.gnss_sensor = None + self.camera_manager = None + # ============================================================================== # -- KeyboardControl ----------------------------------------------------------- From 7dfbfeaf46b9bd20bcbff3b1efe5ae8bbc1941ed Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Fri, 19 Dec 2025 17:59:32 +0800 Subject: [PATCH 3/8] =?UTF-8?q?PID=E6=8E=A7=E5=88=B6=E5=99=A8=E5=86=8D?= =?UTF-8?q?=E5=BA=A6=E6=8F=90=E5=8D=87=E6=B8=85=E6=99=B0=E5=BA=A6=E4=BC=98?= =?UTF-8?q?=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- .../object_detection.py | 116 ++++++++++++------ 1 file changed, 77 insertions(+), 39 deletions(-) diff --git a/src/Object_Tracking_Planning/object_detection.py b/src/Object_Tracking_Planning/object_detection.py index a05617ff4c..27cc7819dc 100644 --- a/src/Object_Tracking_Planning/object_detection.py +++ b/src/Object_Tracking_Planning/object_detection.py @@ -1267,7 +1267,8 @@ def run_step(self, waypoint): -1 = maximum steering to left +1 = maximum steering to right """ - return self._pid_control(waypoint, self._vehicle.get_transform()) + vehicle_transform = self._vehicle.get_transform() + return self._pid_control(waypoint, vehicle_transform) def _pid_control(self, waypoint, vehicle_transform): """ @@ -1280,58 +1281,95 @@ def _pid_control(self, waypoint, vehicle_transform): Returns: float: Steering control in range [-1, 1] """ - # Calculate vehicle direction vector - v_begin = vehicle_transform.location - yaw_rad = math.radians(vehicle_transform.rotation.yaw) - v_end = v_begin + carla.Location( - x=math.cos(yaw_rad), - y=math.sin(yaw_rad) + # 计算当前角度误差 + angle_diff = self._calculate_angle_error(waypoint, vehicle_transform) + + # 更新误差缓冲区 + self._error_buffer.append(angle_diff) + + # 计算PID输出 + pid_output = self._calculate_pid_value(angle_diff) + + # 限制输出范围 + return np.clip(pid_output, -1.0, 1.0) + + def _calculate_angle_error(self, waypoint, vehicle_transform): + """计算车辆当前方向与目标点方向之间的角度误差""" + # 获取车辆位置和方向 + vehicle_pos = vehicle_transform.location + vehicle_yaw = math.radians(vehicle_transform.rotation.yaw) + + # 计算车辆方向向量 + vehicle_direction = carla.Location( + x=math.cos(vehicle_yaw), + y=math.sin(vehicle_yaw) ) + vehicle_vec_end = vehicle_pos + vehicle_direction + + # 计算目标方向向量 + target_pos = waypoint.transform.location + + # 创建向量 + vehicle_vec = np.array([ + vehicle_vec_end.x - vehicle_pos.x, + vehicle_vec_end.y - vehicle_pos.y, + 0.0 + ]) - # Calculate vectors - v_vec = np.array([v_end.x - v_begin.x, v_end.y - v_begin.y, 0.0]) - w_vec = np.array([ - waypoint.transform.location.x - v_begin.x, - waypoint.transform.location.y - v_begin.y, + target_vec = np.array([ + target_pos.x - vehicle_pos.x, + target_pos.y - vehicle_pos.y, 0.0 ]) - # Calculate angle difference - v_norm = np.linalg.norm(v_vec) - w_norm = np.linalg.norm(w_vec) - dot_product = np.dot(w_vec, v_vec) / (v_norm * w_norm) + # 计算角度 + return self._calculate_signed_angle(vehicle_vec, target_vec) + + def _calculate_signed_angle(self, vec1, vec2): + """计算两个向量之间的有符号角度""" + # 归一化向量 + vec1_norm = np.linalg.norm(vec1) + vec2_norm = np.linalg.norm(vec2) + + # 避免除以零 + if vec1_norm < 1e-6 or vec2_norm < 1e-6: + return 0.0 + + # 计算点积和夹角 + dot_product = np.dot(vec1, vec2) / (vec1_norm * vec2_norm) dot_product_clipped = np.clip(dot_product, -1.0, 1.0) - angle_diff = math.acos(dot_product_clipped) + angle = math.acos(dot_product_clipped) - # Determine sign based on cross product - cross_product = np.cross(v_vec, w_vec) + # 根据叉积确定方向(正负) + cross_product = np.cross(vec1, vec2) if cross_product[2] < 0: - angle_diff *= -1.0 + angle = -angle - # Update error buffer and calculate PID terms - self._error_buffer.append(angle_diff) + return angle - # Calculate derivative and integral terms - derivative_error = self._calculate_derivative_error() - integral_error = self._calculate_integral_error() + def _calculate_pid_value(self, current_error): + """计算PID控制器的输出值""" + # 比例项 + proportional = self._k_p * current_error - # PID calculation with clamping - pid_output = ( - self._k_p * angle_diff + - self._k_d * derivative_error + - self._k_i * integral_error - ) + # 微分项 + derivative = self._k_d * self._get_derivative_error() - return np.clip(pid_output, -1.0, 1.0) + # 积分项 + integral = self._k_i * self._get_integral_error() - def _calculate_derivative_error(self): - """Calculate derivative error term.""" - if len(self._error_buffer) >= 2: - return (self._error_buffer[-1] - self._error_buffer[-2]) / self._dt - return 0.0 + return proportional + derivative + integral + + def _get_derivative_error(self): + """获取微分误差项""" + if len(self._error_buffer) < 2: + return 0.0 + return (self._error_buffer[-1] - self._error_buffer[-2]) / self._dt - def _calculate_integral_error(self): - """Calculate integral error term.""" + def _get_integral_error(self): + """获取积分误差项""" + if not self._error_buffer: + return 0.0 return sum(self._error_buffer) * self._dt From ae3ff1e4c3bb66c3604b9560f2d1ad54994578e0 Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Fri, 19 Dec 2025 19:00:41 +0800 Subject: [PATCH 4/8] =?UTF-8?q?FadingText=E9=80=8F=E6=98=8E=E5=BA=A6?= =?UTF-8?q?=E8=AE=A1=E7=AE=97=E4=BC=98=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- .../object_detection.py | 54 +++++++++++++++---- 1 file changed, 45 insertions(+), 9 deletions(-) diff --git a/src/Object_Tracking_Planning/object_detection.py b/src/Object_Tracking_Planning/object_detection.py index ce1e890a4b..3526889a37 100644 --- a/src/Object_Tracking_Planning/object_detection.py +++ b/src/Object_Tracking_Planning/object_detection.py @@ -463,7 +463,13 @@ def render(self, display): class FadingText(object): - """ Class for fading text """ + """Class for fading text""" + + # 常量定义 + ALPHA_MULTIPLIER = 500.0 # 透明度计算系数 + TEXT_OFFSET = (10, 11) # 文本偏移量 + DEFAULT_COLOR = (255, 255, 255) # 默认文本颜色 + DEFAULT_SECONDS = 2.0 # 默认显示时间 def __init__(self, font, dim, pos): """Constructor method""" @@ -471,25 +477,56 @@ def __init__(self, font, dim, pos): self.dim = dim self.pos = pos self.seconds_left = 0 + self._init_surface() + + def _init_surface(self): + """初始化Surface""" self.surface = pygame.Surface(self.dim) + self._clear_surface() + + def _clear_surface(self): + """清空Surface""" + self.surface.fill((0, 0, 0, 0)) - def set_text(self, text, color=(255, 255, 255), seconds=2.0): + def set_text(self, text, color=None, seconds=None): """Set fading text""" + # 使用默认值 + if color is None: + color = self.DEFAULT_COLOR + if seconds is None: + seconds = self.DEFAULT_SECONDS + + # 渲染文本 text_texture = self.font.render(text, True, color) + + # 准备Surface self.surface = pygame.Surface(self.dim) self.seconds_left = seconds - self.surface.fill((0, 0, 0, 0)) - self.surface.blit(text_texture, (10, 11)) + self._clear_surface() + + # 绘制文本 + self.surface.blit(text_texture, self.TEXT_OFFSET) def tick(self, _, clock): """Fading text method for every tick""" - delta_seconds = 1e-3 * clock.get_time() + # 计算经过的时间 + delta_seconds = clock.get_time() / 1000.0 # 转换为秒 + + # 更新时间 self.seconds_left = max(0.0, self.seconds_left - delta_seconds) - self.surface.set_alpha(500.0 * self.seconds_left) + + # 更新透明度 + self._update_alpha() + + def _update_alpha(self): + """更新Surface的透明度""" + alpha_value = self.seconds_left * self.ALPHA_MULTIPLIER + self.surface.set_alpha(alpha_value) def render(self, display): """Render fading text method""" - display.blit(self.surface, self.pos) + if self.seconds_left > 0: + display.blit(self.surface, self.pos) # ============================================================================== @@ -1267,8 +1304,7 @@ def run_step(self, waypoint): -1 = maximum steering to left +1 = maximum steering to right """ - vehicle_transform = self._vehicle.get_transform() - return self._pid_control(waypoint, vehicle_transform) + return self._pid_control(waypoint, self._vehicle.get_transform()) def _pid_control(self, waypoint, vehicle_transform): """ From d49bb12066dbd8685683034cd26fdba6481b6604 Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Sat, 20 Dec 2025 14:53:50 +0800 Subject: [PATCH 5/8] =?UTF-8?q?=E6=A0=B9=E6=8D=AE=E5=AE=9E=E9=99=85?= =?UTF-8?q?=E6=83=85=E5=86=B5=E5=AF=B9=E4=BA=8E=E7=8E=AF=E5=A2=83=E9=85=8D?= =?UTF-8?q?=E7=BD=AE=E7=9A=84=E7=9B=B8=E5=BA=94=E8=B0=83=E6=95=B4=E5=9C=A8?= =?UTF-8?q?readme=E4=B8=AD=E6=9B=B4=E6=96=B0?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/Object_Tracking_Planning/README.md | 16 ++++++++++++++++ 1 file changed, 16 insertions(+) diff --git a/src/Object_Tracking_Planning/README.md b/src/Object_Tracking_Planning/README.md index 72ed89f513..23ddabd6fb 100644 --- a/src/Object_Tracking_Planning/README.md +++ b/src/Object_Tracking_Planning/README.md @@ -1,2 +1,18 @@ 这是一个关于利用yolov3和carla模拟器进行·自主车辆目标检测与轨迹规划,与模拟器相结合,以提升车辆的感知与决策能力。 +使用说明: +使用YOLOv3算法进行物体检测 +与CARLA模拟器集成,实现真实的自动驾驶场景 +基于探测到的物体和环境约束的轨迹规划 +使用TensorBoard的性能监控与可视化 +安装 +先修条件: +Python 3.7 或更高版本(本人使用的为py3.7.9) +CARLA 模拟器 0.9.11(由于pycharm可能不支持0.9.11,也可自行切换成0.9.12,但同时版本也不可过于高。) + +项目结构: +object_detection.py: Python主脚本,用于对象检测和轨迹规划 +requirements.txt: 必备 Python 库列表 +models/: 包含训练好的YOLOv3模型权重的目录 +config/: 包含训练过的YOLOv3模型配置的目录 +logs/: TensorBoard 日志文件用于性能监控 \ No newline at end of file From cabea024708fd9a24d092f71067f3b46a47cfbd9 Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Sun, 21 Dec 2025 14:53:54 +0800 Subject: [PATCH 6/8] =?UTF-8?q?=E4=BB=A3=E7=90=86=E6=8E=A7=E5=88=B6?= =?UTF-8?q?=E6=B5=81=E7=A8=8B=E8=BF=9B=E8=A1=8C=E4=BC=98=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- .../object_detection.py | 40 +++++++++---------- 1 file changed, 18 insertions(+), 22 deletions(-) diff --git a/src/Object_Tracking_Planning/object_detection.py b/src/Object_Tracking_Planning/object_detection.py index 3526889a37..1c4b0567cf 100644 --- a/src/Object_Tracking_Planning/object_detection.py +++ b/src/Object_Tracking_Planning/object_detection.py @@ -1927,6 +1927,7 @@ def run_step(self, debug=False): def game_loop(args): """ Main loop for agent""" + # 初始化部分保持不变 pygame.init() pygame.font.init() world = None @@ -1942,13 +1943,9 @@ def game_loop(args): pygame.HWSURFACE | pygame.DOUBLEBUF) hud = HUD(args.width, args.height) - - # selected_world = client.load_world("Town01") # KK Changes world to Town04 selected_world = client.get_world() - world = World(client.get_world(), hud, args) controller = KeyboardControl(world) - agent = BehaviorAgent(world.player, behavior=args.behavior) spawn_points = world.map.get_spawn_points() @@ -1963,57 +1960,56 @@ def game_loop(args): clock = pygame.time.Clock() + # 主循环开始 while True: clock.tick_busy_loop(60) + + # 统一处理事件 if controller.parse_events(world): return - # As soon as the server is ready continue! + # 等待世界更新 if not world.world.wait_for_tick(10.0): continue - if args.agent == "Roaming" or args.agent == "Basic": - if controller.parse_events(world): - return - - # agent.update_information(world) - # as soon as the server is ready continue! - world.world.wait_for_tick(10.0) - + # 根据代理类型执行不同的逻辑 + if args.agent in ["Roaming", "Basic"]: + world.world.wait_for_tick(10.0) # 等待服务器 world.tick(clock) world.render(display) pygame.display.flip() + + # 为Roaming/Basic代理生成控制 control = agent.run_step() control.manual_gear_shift = False world.player.apply_control(control) - else: - agent.update_information(world) + continue # 跳过后续的控制应用 - world.tick(clock) - world.render(display) - pygame.display.flip() + # 其他代理类型的逻辑 + agent.update_information(world) + world.tick(clock) + world.render(display) + pygame.display.flip() - # Set new destination when target has been reached + # 检查是否到达目的地 if len(agent.get_local_planner().waypoints_queue) < num_min_waypoints and args.loop: agent.reroute(spawn_points) tot_target_reached += 1 world.hud.notification("The target has been reached " + str(tot_target_reached) + " times.", seconds=4.0) - elif len(agent.get_local_planner().waypoints_queue) == 0 and not args.loop: print("Target reached, mission accomplished...") break + # 设置速度限制并应用控制 speed_limit = world.player.get_speed_limit() agent.get_local_planner().set_speed(speed_limit) - control = agent.run_step() world.player.apply_control(control) finally: if world is not None: world.destroy() - pygame.quit() From 9c24d5ab3ef59cd3c20438d7376b4f44f387aeec Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Sun, 21 Dec 2025 20:31:47 +0800 Subject: [PATCH 7/8] 1 --- src/Object_Tracking_Planning/README.md | 17 ----------------- 1 file changed, 17 deletions(-) diff --git a/src/Object_Tracking_Planning/README.md b/src/Object_Tracking_Planning/README.md index 23ddabd6fb..7a87c8b2e8 100644 --- a/src/Object_Tracking_Planning/README.md +++ b/src/Object_Tracking_Planning/README.md @@ -1,18 +1 @@ 这是一个关于利用yolov3和carla模拟器进行·自主车辆目标检测与轨迹规划,与模拟器相结合,以提升车辆的感知与决策能力。 -使用说明: -使用YOLOv3算法进行物体检测 -与CARLA模拟器集成,实现真实的自动驾驶场景 -基于探测到的物体和环境约束的轨迹规划 -使用TensorBoard的性能监控与可视化 - -安装 -先修条件: -Python 3.7 或更高版本(本人使用的为py3.7.9) -CARLA 模拟器 0.9.11(由于pycharm可能不支持0.9.11,也可自行切换成0.9.12,但同时版本也不可过于高。) - -项目结构: -object_detection.py: Python主脚本,用于对象检测和轨迹规划 -requirements.txt: 必备 Python 库列表 -models/: 包含训练好的YOLOv3模型权重的目录 -config/: 包含训练过的YOLOv3模型配置的目录 -logs/: TensorBoard 日志文件用于性能监控 \ No newline at end of file From 2c60ec9eedfed93f03e888f9fc89e3325b4e60a7 Mon Sep 17 00:00:00 2001 From: 0023csw <3485741830@qq.com> Date: Mon, 22 Dec 2025 08:15:32 +0800 Subject: [PATCH 8/8] =?UTF-8?q?=E8=A7=84=E6=95=B4=E4=BB=A3=E7=A0=81?= =?UTF-8?q?=E7=BB=93=E6=9E=84=E3=80=81=E7=BB=9F=E4=B8=80=E9=A3=8E=E6=A0=BC?= =?UTF-8?q?=E3=80=81=E6=B6=88=E9=99=A4=E5=86=97=E4=BD=99?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/Object_Tracking_Planning/object_detection.py | 8 +++----- 1 file changed, 3 insertions(+), 5 deletions(-) diff --git a/src/Object_Tracking_Planning/object_detection.py b/src/Object_Tracking_Planning/object_detection.py index 1c4b0567cf..644566f6c8 100644 --- a/src/Object_Tracking_Planning/object_detection.py +++ b/src/Object_Tracking_Planning/object_detection.py @@ -1643,13 +1643,13 @@ def __init__(self, vehicle): vehicle: Actor to apply local planner logic onto """ self._vehicle = vehicle - self._proximity_tlight_threshold = 5.0 # meters - self._proximity_vehicle_threshold = 10.0 # meters + self._proximity_tlight_threshold = 5.0 + self._proximity_vehicle_threshold = 10.0 self._local_planner = None self._world = self._vehicle.get_world() self._last_traffic_light = None + self._map = None - # 初始化地图,处理可能的错误 self._init_map() def _init_map(self): @@ -1673,7 +1673,6 @@ def get_local_planner(self): """Get method for protected member local planner""" return self._local_planner - # 也可以同时提供属性访问方式 @property def local_planner(self): """Get the local planner instance (property version).""" @@ -1693,7 +1692,6 @@ def run_step(debug=False): control = carla.VehicleControl() if debug: - # 设置调试模式下的默认控制参数 control.steer = 0.0 control.throttle = 0.0 control.brake = 0.0