返回首页 hi, 欢迎来到机器人在线 请登录/ 免费注册 扫码关注

agv搬运机器人之惯性导航模块数据采集与处理程序设计

时间:2017-09-20 来源:机器人在线 阅读:13581

 4.2.3惯性导航模块数据采集与处理程序设计

本文通过RS232串口读取惯导器件Xsens中提取的偏航角信息,此信息用于仓储搬运机器人的惯性导航。
(1)定位算法设计
文中惯导信号的处理是指将惯导器件输出的偏航角信息与编码器采集的速度信息相融合,推算出仓储搬运机器人相对于行驶路线的偏移量。定时器可以每隔15ms采集一次,采集仓储搬运机器人速度与偏航角的信息,采集后对其进行累计推算。如图4.11所示,图中坐标系为机器人导航坐标系,由于惯导采样频率远远高于机器人移动位移姿态变化的频率,假设采样时间间隔为T,机器人在极短时间内航向角的变化很小,近似为零,每段的速度近似不变,分别为Vo. V1...Vk。点(X0,Y0 )、( X1,Y1)、( X2,Y2 )…  ( Xk,Yk)处的偏角为θ0、θ1、θ2……θk,可推算各点的位置如下。鉴于惯导模块有累积误差,如果不加以矫正,行驶的方向会向一个方向一直偏差。
搬运机器人 
(2)位置误差计算
如图4.12所示,假设仓储搬运机器人向其本身坐标系的Y轴的前进方向行驶,可以得到机器人行进偏移路线的误差值为机器人的质心方向在x轴方向的投影0x。在机器人移动过程中,如果能够预测机器人下一个点的位置偏移量,并对机器人位置偏移量进行矫正,搬运机器人的运动控制就具有了一定的前瞻性。
搬运机器人 
搬运机器人
搬运机器人,仓储搬运机器人控制系统设计与实现 技术干货

好的文章,需要您的鼓励

12

  • 最新资讯
  • 最新问答