机器人的行走控制方法、装置及系统与流程

文档序号:11863886阅读:来源:国知局

技术特征:

1.一种机器人的行走控制方法,其特征在于,所述方法包括:

在机器人第一侧里程计失效时,实时获取所述机器人的偏航角;

根据所述偏航角及所述机器人第二侧里程计控制所述机器人的行走。

2.如权利要求1所述的方法,其特征在于,所述根据所述偏航角及所述机器人第二侧里程计控制所述机器人的行走,进一步包括:

获取所述机器人第二侧里程计所测量的第二速度值,根据所述偏航角及第二速度值调节所述机器人左右行动轮的驱动脉冲信号,从而完成对机器人行走的控制。

3.如权利要求2所述的方法,其特征在于,所述根据所述偏航角及第二速度值调节所述机器人左右行动轮的驱动脉冲信号,进一步包括:

判断所述偏航角是否处于预设角度范围内,在所述偏航角未处于预设角度范围时,判断所述第二速度值是否处于预设速度范围内;

在所述第二速度值未处于预设速度范围内时,调整所述第二侧里程计对应行动轮的驱动脉冲信号;

在所述第二速度值处于预设速度范围内时,调整所述第一侧里程计对应行动轮的驱动脉冲信号。

4.如权利要求1~3中任一项所述的方法,其特征在于,所述在机器人第一侧里程计失效时,实时获取所述机器人的偏航角之前,所述方法还包括:

获取机器人两侧里程计分别测量的第一速度值,在满足下式时,认定所述第一侧里程计失效,

SPEEDb<k*SPEEDa

其中,SPEEDb为第一侧里程计所测量的第一速度值,SPEEDa为第二侧里程计所测量的第一速度值,k为大于0且小于1的常数。

5.一种机器人的行走控制装置,其特征在于,所述装置包括:

数据获取单元,用于在机器人第一侧里程计失效时,实时获取所述机器人的偏航角;

行走控制单元,用于根据所述偏航角及所述机器人第二侧里程计控制所述机器人的行走。

6.如权利要求5所述的装置,其特征在于,所述行走控制单元,进一步用于获取所述机器人第二侧里程计所测量的第二速度值,根据所述偏航角及第二速度值调节所述机器人左右行动轮的驱动脉冲信号,从而完成对机器人行走的控制。

7.如权利要求6所述的装置,其特征在于,所述行走控制单元,进一步用于判断所述偏航角是否处于预设角度范围内,在所述偏航角未处于预设角度范围时,判断所述第二速度值是否处于预设速度范围内;在所述第二速度值未处于预设速度范围内时,调整所述第二侧里程计对应行动轮的驱动脉冲信号;在所述第二速度值处于预设速度范围内时,调整所述第一侧里程计对应行动轮的驱动脉冲信号。

8.如权利要求5~7中任一项所述的装置,其特征在于,所述装置还包括:失效判断单元,用于获取机器人两侧里程计分别测量的第一速度值,在满足下式时,认定所述第一侧里程计失效,

SPEEDb<k*SPEEDa

其中,SPEEDb为第一侧里程计所测量的第一速度值,SPEEDa为第二侧里程计所测量的第一速度值,k为大于0且小于1的常数。

9.一种机器人的行走控制系统,其特征在于,所述系统包括:权利要求5~8中任一项所述的装置。

10.如权利要求9所述的系统,其特征在于,所述系统还包括:机器人两侧里程计和机器人左右行动轮,所述机器人两侧里程计和机器人左右行动轮分别与所述装置连接。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1