[发明专利]机器人的控制方法、装置及机器人有效
申请号: | 201810314389.5 | 申请日: | 2018-04-09 |
公开(公告)号: | CN108555906B | 公开(公告)日: | 2021-03-23 |
发明(设计)人: | 梁惺;徐小涵;江世欢;罗阳;查沛 | 申请(专利权)人: | 重庆东渝中能实业有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 北京超凡志成知识产权代理事务所(普通合伙) 11371 | 代理人: | 魏彦 |
地址: | 400000 重庆市江*** | 国省代码: | 重庆;50 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 控制 方法 装置 | ||
1.一种机器人的控制方法,其特征在于,应用于机器人,所述机器人包括主控芯片和电机,所述电机上设置有编码器,所述电机通过所述编码器与所述主控芯片连接,所述主控芯片包括处理器、第一定时器和第二定时器,所述电机通过所述编码器与所述处理器电连接,所述处理器与所述第一定时器和所述第二定时器电连接,所述方法包括:
所述处理器基于在所述第一定时器的中断触发下,当前时刻读取到的所述第二定时器中的方向位值,确定所述电机的旋转方向;所述第一定时器和所述第二定时器均开启溢出中断;
所述处理器获取所述当前时刻所述第二定时器的计数器中的当前检测脉冲值和所述当前时刻之前的上一个时刻所述第二定时器的计数器中的上一次检测脉冲值;
所述处理器基于在所述上一个时刻至所述当前时刻之间的时间段内读取到的所述第二定时器中的溢出中断次数,获得所述电机在所述旋转方向下的过零点次数;
所述处理器基于所述当前检测脉冲值、所述上一次检测脉冲值和所述过零点次数,获得所述电机所述时间段内产生的脉冲数,以获取所述机器人的运行距离。
2.根据权利要求1所述的方法,其特征在于,在所述处理器基于在所述第一定时器的中断触发下,当前时刻读取到的所述第二定时器中的方向位值,获得所述电机的旋转方向之前,所述方法还包括:
所述处理器控制所述第一定时器和所述第二定时器均开启溢出中断,其中,所述第一定时器配置为定时模式,所述第二定时器配置为定时器正交编码模式。
3.根据权利要求1所述的方法,其特征在于,所述处理器基于在所述第一定时器的中断触发下,当前时刻读取到的所述第二定时器中的方向位值,确定所述电机的旋转方向,包括:
所述处理器在所述第一定时器的中断触发下,读取所述第二定时器中的一个寄存器中的方向位值;
所述处理器若判断得出所述方向位值为第一预设方向值,确定所述电机的旋转方向为正转;
所述处理器若判断得出所述方向位值为第二预设方向值,确定所述电机的旋转方向为反转。
4.根据权利要求3所述的方法,其特征在于,当所述处理器确定所述电机的旋转方向为正转,所述处理器基于所述当前检测脉冲值、所述上一次检测脉冲值和所述过零点次数,获得所述电机所述时间段内产生的脉冲数,以获取所述机器人的运行距离,包括:
所述处理器将所述当前检测脉冲值减去所述上一次检测脉冲值后,加上预先获取到的所述电机旋转一周产生脉冲数与所述过零点次数的乘积,获得所述电机所述时间段内正转产生的脉冲数,以获取所述机器人的运行距离。
5.根据权利要求3所述的方法,其特征在于,当所述处理器确定所述电机的旋转方向为反转,所述处理器基于所述当前检测脉冲值、所述上一次检测脉冲值和所述过零点次数,获得所述电机所述时间段内产生的脉冲数,以获取所述机器人的运行距离,包括:
所述处理器将所述当前检测脉冲值减去所述上一次检测脉冲值后,减去预先获取到的所述电机旋转一周产生脉冲数与所述过零点次数的乘积,获得所述电机所述时间段内反转产生的脉冲数,以获取所述机器人的运行距离。
6.一种机器人的控制装置,其特征在于,运行于机器人,所述机器人包括主控芯片和电机,所述电机上设置有编码器,所述电机通过所述编码器与所述主控芯片连接,所述主控芯片包括处理器、第一定时器和第二定时器,所述电机通过所述编码器与所述处理器电连接,所述处理器与所述第一定时器和所述第二定时器电连接,所述装置包括:
确定单元,用于基于在所述第一定时器的中断触发下,当前时刻读取到的所述第二定时器中的方向位值,确定所述电机的旋转方向;所述第一定时器和所述第二定时器均开启溢出中断;
第一获取单元,用于获取所述当前时刻所述第二定时器的计数器中的当前检测脉冲值和所述当前时刻之前的上一个时刻所述第二定时器的计数器中的上一次检测脉冲值;
第二获取单元,用于基于在所述上一个时刻至所述当前时刻之间的时间段内读取到的所述第二定时器中的溢出中断次数,获得所述电机在所述旋转方向下的过零点次数;
计算单元,用于基于所述当前检测脉冲值、所述上一次检测脉冲值和所述过零点次数,获得所述电机所述时间段内产生的脉冲数,以获取所述机器人的运行距离。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于重庆东渝中能实业有限公司,未经重庆东渝中能实业有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201810314389.5/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种可群体工作的三足机器人
- 下一篇:机器人运行状况评价方法