基于惯性导航的扫地机器人系统设计

针对扫地机器人行进中姿态控制难和无规划式清扫等问题,设计了一种以STM32F030R8T6微控制器为主控制器,以单轴陀螺仪GGPM01为姿态角检测传感器及以弓字形清扫方式为路径规划法的扫地机器人系统。因陀螺仪数据存在随机误差和噪声干扰,故采用卡尔曼滤波算法对陀螺仪和光电编码器数据进行融合,计算出机器人当前的偏航角最优估计值。再以最优偏航角和机器人速度为反馈量构成串级比例、积分、微分(PID)控制,实现机器人的直线行驶,最后采用弓字形算法实现路径规划。通过系统的仿真及软件测试,机器人以10.2～12.6 m/min的速度完成弓字形路径规划,最大角度偏移量为0.4°,验证了扫地机器人的功能特性及算法的有效性。     

基于串级模糊PID的四旋翼姿态控制器设计

为解决四旋翼飞行器姿态控制器存在的响应速度慢和鲁棒性差等问题,通过串级模糊PID控制算法来实现飞行姿态的稳定性。建立起四旋翼飞控系统的数学模型后,设计了外环角度P控制器和内环角速度模糊PID控制器。利用Matlab/Simulink通过阶跃信号输入对比仿真传统PID控制器和串级PID控制器、串级模糊PID控制器3种控制方法。仿真结果表明:串级模糊PID控制器使系统抗干扰性能提高,同时加快系统的响应性和准确性;飞行实验表明:串级模糊PID控制算法的鲁棒性好。可见改进后的算法对于四旋翼控制系统是有效的。