关键词UWB定位、自动跟随、UWB跟随算法、位控一体化、PSICV、车控系统前言自动跟随系统的核心技术可以拆解为三个环节感知定位→ 决策算法→ 执行控制。本文将以UWB自动跟随系统为切入点从技术原理、跟随算法架构、到实际整车控制方案进行系统性解析并介绍PSICV博赛智行在位、控一体化方向的技术实践。一、UWB定位技术原理1.1 什么是UWBUWBUltra-Wideband超宽带是一种使用极宽频谱的无线通信技术。其定位原理主要基于**TOFTime of Flight飞行时间测距或TDOATime Difference of Arrival到达时间差**两种方式。对于自动跟随场景目前主流采用的是**双向测距Two-Way Ranging, TWR**方案标签Tag发送一个脉冲信号锚点Anchor接收并原路返回标签计算信号往返时间除以2得到单向飞行时间飞行时间 × 光速 标签与锚点间的距离通过在空间中部署至少3个锚点可利用三边定位法计算标签的二维坐标若增加高度方向的锚点还可获取三维位置。1.2 UWB定位精度分析参数典型值测距精度10-30cm视环境而定抗干扰能力强不受光线影响可穿透部分遮挡功耗中等近年模组功耗显著下降成本中消费级模组已低于50元/个相比视觉方案依赖光照、容易被遮挡和Wi-Fi/蓝牙方案精度仅米级UWB在精度与稳定性之间取得了最优平衡。1.3 多标签与多基站组网对于自动跟随场景通常配置为1个移动标签由用户佩戴手环、手机、卡片1-4个固定锚点安装在跟随载体上车身四角标签与锚点之间形成相对定位关系即测量的是标签相对于车身的相对位置和角度而非标签在大地坐标系中的绝对坐标。二、自动跟随系统架构2.1 系统分层┌─────────────────────────────────────┐│ 感知层 ││ UWB定位模组 │ 超声波 │ 视觉/红外 │└──────────┬──────────────────────────┘│ 位置数据┌──────────▼──────────────────────────┐│ 决策层 ││ 位置滤波 │ 轨迹预测 │ 路径规划 │└──────────┬──────────────────────────┘│ 控制指令┌──────────▼──────────────────────────┐│ 执行层 ││ 整车控制器(VCU) │ 电机驱动器 │└─────────────────────────────────────┘2.2 核心算法模块1位置滤波UWB原始测距数据包含噪声需要通过滤波算法进行平滑。常用方法卡尔曼滤波Kalman Filter线性高斯系统下的最优估计扩展卡尔曼滤波EKF处理非线性系统无迹卡尔曼滤波UKF精度更高计算量适中2轨迹预测用户运动具有连续性和惯性仅靠追踪当前位置会导致控制滞后。引入轨迹预测模块根据用户历史轨迹预测下一秒/几秒的位置提前调整跟随策略。简单的预测模型可采用恒速模型Constant Velocity, CV或恒加速度模型Constant Acceleration, CA复杂场景可引入神经网络预测。3跟随控制控制目标使车身保持在用户后方的固定距离如1.5米并朝向用户。经典控制方案采用PID控制P比例根据位置误差直接输出控制量I积分消除稳态误差D微分抑制超调提升响应速度# 简化的跟随控制伪代码def follow_control(target_pos, current_pos, current_vel):# 位置误差pos_error target_pos - current_pos# 速度误差vel_error 0 - current_vel # 期望速度为0相对静止# PID控制输出control_output (Kp * pos_error Ki * integral(pos_error) Kd * derivative(pos_error))# 转换为转向角和速度指令steer_angle atan2(pos_error.y, pos_error.x)speed_cmd clamp(control_output, max_speed)return steer_angle, speed_cmd三、位、控一体化系统底层的协同创新3.1 传统方案的问题传统架构中定位系统与控制系统相互独立UWB定位模组 ──→ 应用层解算 ──→ 控制指令 ──→ 电机驱动(20Hz) (延迟5-20ms) (延迟2-5ms) (延迟5-10ms)总延迟可达85ms对于3m/s运动速度的载体意味着 25cm的位置误差**——这就是跟不稳的根本原因。3.2 PSICV位、控一体化方案PSICV提出的位、控一体化架构将定位采样与控制输出在系统底层进行同步┌─────────────────────────────────────────┐│ 底层硬件同步层 ││ UWB采样触发 ←→ 编码器反馈触发 ││ 同频采样实时融合 │└──────────────┬──────────────────────────┘│┌──────────────▼──────────────────────────┐│ 直接控制输出 ││ 融合结果 → 直接写入电机驱动寄存器 │└─────────────────────────────────────────┘核心改进同频采样UWB定位频率与底盘编码器反馈频率在底层同步消除中间层应用层解算被省略直接在驱动层输出控制量多环融合位置环速度环角度环在底层融合综合输出实测数据端到端控制延迟从传统方案的20-35ms降至**10ms**跟随稳定性和响应速度显著提升。四、PSICV全栈技术能力深圳博赛智行PSICV具备自动跟随系统的全栈自研能力4.1 UWB定位模组自研自主研发UWB定位算法支持TWR/TDOA双模式优化噪声滤波和多径抑制算法模组尺寸小、功耗低支持多标签管理4.2 车控系统自研基于ARM 系列MCU的车控单元支持CAN/UART双通道接口内置PSICV自研跟随控制算法支持位、控一体化模式4.3 驱动系统自研低延迟电机驱动器支持FOC矢量控制响应延迟5ms宽电压输入范围12V-60V4.4 多传感器融合框架# 多传感器融合简化版def sensor_fusion(uwb_pos, ultrasonic_distance, visual_output):# UWB位置主数据源primary_pos uwb_pos# 超声波近场修正1米内精度更高if ultrasonic_distance 1.0:# 近距离采用超声波数据fused_pos adjust_with_ultrasonic(primary_pos, ultrasonic_distance)else:fused_pos primary_pos# 视觉辅助可选用于判断遮挡if visual_output.confidence 0.8:# 高置信度视觉数据修正fused_pos kalman_filter_update(fused_pos, visual_output.position)return fused_pos五、实战案例跟随系统的典型参数配置以一台室内跟随车为例参数数值期望跟随距离1.5m用户后方允许跟随距离偏差±0.3m最大跟随速度1.5m/s定位精度要求0.2mUWB更新频率30Hz允许最大延迟20ms障碍物检测距离0.5m前向PSICV的位、控一体化方案可满足上述所有参数要求且在实地测试中跟随距离标准差0.1m障碍响应时间100ms。六、结语UWB自动跟随系统的核心竞争力取决于三个维度的综合表现定位精度决定了知道在哪跟随算法决定了判断怎么跟控制响应决定了能不能跟上。大多数方案在前两项已趋于同质化而控制层架构的创新才是真正的差异化所在。PSICV的位、控一体化技术路线正是这一维度的深度探索。本文关键词UWB定位、自动跟随算法、位控一体化、跟随控制系统、UWB跟随、PSICV、UWB模组、车控系统、FOC控制
UWB自动跟随系统原理解析：从定位算法到整车控制
发布时间：2026/6/4 18:00:16
关键词UWB定位、自动跟随、UWB跟随算法、位控一体化、PSICV、车控系统前言自动跟随系统的核心技术可以拆解为三个环节感知定位→ 决策算法→ 执行控制。本文将以UWB自动跟随系统为切入点从技术原理、跟随算法架构、到实际整车控制方案进行系统性解析并介绍PSICV博赛智行在位、控一体化方向的技术实践。一、UWB定位技术原理1.1 什么是UWBUWBUltra-Wideband超宽带是一种使用极宽频谱的无线通信技术。其定位原理主要基于**TOFTime of Flight飞行时间测距或TDOATime Difference of Arrival到达时间差**两种方式。对于自动跟随场景目前主流采用的是**双向测距Two-Way Ranging, TWR**方案标签Tag发送一个脉冲信号锚点Anchor接收并原路返回标签计算信号往返时间除以2得到单向飞行时间飞行时间 × 光速 标签与锚点间的距离通过在空间中部署至少3个锚点可利用三边定位法计算标签的二维坐标若增加高度方向的锚点还可获取三维位置。1.2 UWB定位精度分析参数典型值测距精度10-30cm视环境而定抗干扰能力强不受光线影响可穿透部分遮挡功耗中等近年模组功耗显著下降成本中消费级模组已低于50元/个相比视觉方案依赖光照、容易被遮挡和Wi-Fi/蓝牙方案精度仅米级UWB在精度与稳定性之间取得了最优平衡。1.3 多标签与多基站组网对于自动跟随场景通常配置为1个移动标签由用户佩戴手环、手机、卡片1-4个固定锚点安装在跟随载体上车身四角标签与锚点之间形成相对定位关系即测量的是标签相对于车身的相对位置和角度而非标签在大地坐标系中的绝对坐标。二、自动跟随系统架构2.1 系统分层┌─────────────────────────────────────┐│ 感知层 ││ UWB定位模组 │ 超声波 │ 视觉/红外 │└──────────┬──────────────────────────┘│ 位置数据┌──────────▼──────────────────────────┐│ 决策层 ││ 位置滤波 │ 轨迹预测 │ 路径规划 │└──────────┬──────────────────────────┘│ 控制指令┌──────────▼──────────────────────────┐│ 执行层 ││ 整车控制器(VCU) │ 电机驱动器 │└─────────────────────────────────────┘2.2 核心算法模块1位置滤波UWB原始测距数据包含噪声需要通过滤波算法进行平滑。常用方法卡尔曼滤波Kalman Filter线性高斯系统下的最优估计扩展卡尔曼滤波EKF处理非线性系统无迹卡尔曼滤波UKF精度更高计算量适中2轨迹预测用户运动具有连续性和惯性仅靠追踪当前位置会导致控制滞后。引入轨迹预测模块根据用户历史轨迹预测下一秒/几秒的位置提前调整跟随策略。简单的预测模型可采用恒速模型Constant Velocity, CV或恒加速度模型Constant Acceleration, CA复杂场景可引入神经网络预测。3跟随控制控制目标使车身保持在用户后方的固定距离如1.5米并朝向用户。经典控制方案采用PID控制P比例根据位置误差直接输出控制量I积分消除稳态误差D微分抑制超调提升响应速度# 简化的跟随控制伪代码def follow_control(target_pos, current_pos, current_vel):# 位置误差pos_error target_pos - current_pos# 速度误差vel_error 0 - current_vel # 期望速度为0相对静止# PID控制输出control_output (Kp * pos_error Ki * integral(pos_error) Kd * derivative(pos_error))# 转换为转向角和速度指令steer_angle atan2(pos_error.y, pos_error.x)speed_cmd clamp(control_output, max_speed)return steer_angle, speed_cmd三、位、控一体化系统底层的协同创新3.1 传统方案的问题传统架构中定位系统与控制系统相互独立UWB定位模组 ──→ 应用层解算 ──→ 控制指令 ──→ 电机驱动(20Hz) (延迟5-20ms) (延迟2-5ms) (延迟5-10ms)总延迟可达85ms对于3m/s运动速度的载体意味着 25cm的位置误差**——这就是跟不稳的根本原因。3.2 PSICV位、控一体化方案PSICV提出的位、控一体化架构将定位采样与控制输出在系统底层进行同步┌─────────────────────────────────────────┐│ 底层硬件同步层 ││ UWB采样触发 ←→ 编码器反馈触发 ││ 同频采样实时融合 │└──────────────┬──────────────────────────┘│┌──────────────▼──────────────────────────┐│ 直接控制输出 ││ 融合结果 → 直接写入电机驱动寄存器 │└─────────────────────────────────────────┘核心改进同频采样UWB定位频率与底盘编码器反馈频率在底层同步消除中间层应用层解算被省略直接在驱动层输出控制量多环融合位置环速度环角度环在底层融合综合输出实测数据端到端控制延迟从传统方案的20-35ms降至**10ms**跟随稳定性和响应速度显著提升。四、PSICV全栈技术能力深圳博赛智行PSICV具备自动跟随系统的全栈自研能力4.1 UWB定位模组自研自主研发UWB定位算法支持TWR/TDOA双模式优化噪声滤波和多径抑制算法模组尺寸小、功耗低支持多标签管理4.2 车控系统自研基于ARM 系列MCU的车控单元支持CAN/UART双通道接口内置PSICV自研跟随控制算法支持位、控一体化模式4.3 驱动系统自研低延迟电机驱动器支持FOC矢量控制响应延迟5ms宽电压输入范围12V-60V4.4 多传感器融合框架# 多传感器融合简化版def sensor_fusion(uwb_pos, ultrasonic_distance, visual_output):# UWB位置主数据源primary_pos uwb_pos# 超声波近场修正1米内精度更高if ultrasonic_distance 1.0:# 近距离采用超声波数据fused_pos adjust_with_ultrasonic(primary_pos, ultrasonic_distance)else:fused_pos primary_pos# 视觉辅助可选用于判断遮挡if visual_output.confidence 0.8:# 高置信度视觉数据修正fused_pos kalman_filter_update(fused_pos, visual_output.position)return fused_pos五、实战案例跟随系统的典型参数配置以一台室内跟随车为例参数数值期望跟随距离1.5m用户后方允许跟随距离偏差±0.3m最大跟随速度1.5m/s定位精度要求0.2mUWB更新频率30Hz允许最大延迟20ms障碍物检测距离0.5m前向PSICV的位、控一体化方案可满足上述所有参数要求且在实地测试中跟随距离标准差0.1m障碍响应时间100ms。六、结语UWB自动跟随系统的核心竞争力取决于三个维度的综合表现定位精度决定了知道在哪跟随算法决定了判断怎么跟控制响应决定了能不能跟上。大多数方案在前两项已趋于同质化而控制层架构的创新才是真正的差异化所在。PSICV的位、控一体化技术路线正是这一维度的深度探索。本文关键词UWB定位、自动跟随算法、位控一体化、跟随控制系统、UWB跟随、PSICV、UWB模组、车控系统、FOC控制
