基于超宽带测距的异构移动机器人轨迹跟踪控制

针对超宽带(UWB)测距过程中随机出现的奇异值,设计了改进的基于最小协方差的马氏距离奇异值检测模块;针对全向机器人的运动学和动力学特点,提出了一种基于滑模+ PID控制的逆动力学前馈轨迹跟踪算法;针对UWB定位算法中出现的坐标跳动、边缘效应以及微型四旋翼的运动学特点,设计了基于扩展卡尔曼滤波(EKF)的轨迹跟踪控制算法;并在MATLAB和Gazebo仿真软件中分别进行了验证.为在实际环境验证轨迹跟踪控制算法的速度闭环控制和位置闭环控制以及UWB定位的实时性、准确性,搭建了基于UWB的异构多机器人系统,完成了四旋翼定点悬停、单个全向机器人轨迹跟踪、异构多机器人协同控制实验.实验结果表明,UWB定位系统和机器人控制算法能够满足控制的实时性和稳定性要求.