[发明专利]机器人控制器脉冲同步调整方法及装置有效
申请号: | 201210003545.9 | 申请日: | 2012-01-06 |
公开(公告)号: | CN103197577A | 公开(公告)日: | 2013-07-10 |
发明(设计)人: | 李崇;曲道奎;徐方;邹风山;宋吉来;刘晓帆;董状;甘戈 | 申请(专利权)人: | 沈阳新松机器人自动化股份有限公司 |
主分类号: | G05B19/042 | 分类号: | G05B19/042 |
代理公司: | 沈阳科苑专利商标代理有限公司 21002 | 代理人: | 许宗富 |
地址: | 110168 辽*** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 控制器 脉冲 同步 调整 方法 装置 | ||
1.一种机器人控制器脉冲同步调整方法,其特征在于,包括以下步骤:
接收机器人控制器发送的进行同步调整的指令;
获取机器人控制器的指令时间;
根据所述指令时间与机器人控制器的周期值进行对比的结果进行脉冲同步调整;
根据所述同步调整的结果进行脉冲的输出运算;
所述根据指令时间与机器人控制器的周期值进行对比的结果进行脉冲同步调整具体为:
若所述指令时间小于设定的机器人控制器的周期最小值,修改定时器同步时间,进行正常的时钟同步和脉冲发送;
若机器人控制器指令时间大于设定的机器人控制器的周期最小值小于机器人控制器的周期最大值,不修改定时器同步时间,脉冲通过系统中断程序进行发送;
若机器人控制器指令时间大于机器人控制器的周期最大值,开启下电保护和脉冲输出禁止功能。
2.如权利要求1所述的机器人控制器脉冲同步调整方法,其特征在于,所述获取机器人控制器的指令时间,具体为:
所述DSP事件管理器内部设置一计数寄存器,所述计数寄存器采用增计数的模式每过一个DSP事件管理器模块内部时钟周期操作一次,每接收到一次同步调整的指令,所述计数寄存器将前后两次计数的差值乘以所述DSP事件管理器模块内部时钟周期,所得的值即为机器人控制器的指令时间。
3.如权利要求1所述的机器人控制器脉冲同步调整方法,其特征在于,所述DSP数字信号处理器进行调整次数统计,定义次数统计变量,系统初始化时将统计变量清零,在规定时间内接收到同步帧,认为同步正常不进行计数,否则认为同步异常将统计变量加1。
4.根据权利要求1所述的机器人控制器脉冲同步调整方法,其特征在于,所述机器人控制器给上动力电指令时使能定时器,开启所述计数寄存器,当第一次同步帧来时,此时所述计数寄存器将计数值赋给变量T1CNT_old,同步再来时,得所述计数寄存器的计数值给变量T1CNT_new,每次调整后,将T1CNT_new的值赋给T1CNT_old。
5.一种机器人控制器脉冲同步调整装置,其特征在于:包括一机器人控制器、一设置于机器人脉冲控制器中的DSP数字信号处理器,
所述机器人控制器用于向所述DSP数字信号处理器发送同步调整的指令;
所述DSP数字信号处理器用于根据机器人控制器的指令时间与机器人控制器的周期值进行对比的结果进行脉冲的同步调整,并根据同步调整的结果进行脉冲的输出运算;
所述根据指令时间与机器人控制器的周期值进行对比的结果进行脉冲同步调整具体为:
若所述指令时间小于设定的机器人控制器的周期最小值,修改定时器同步时间,进行正常的时钟同步和脉冲发送;
若机器人控制器指令时间大于设定的机器人控制器的周期最小值小于机器人控制器的周期最大值,不修改定时器同步时间,脉冲通过系统中断程序进行发送;
若机器人控制器指令时间大于机器人控制器的周期最大值,开启下电保护和脉冲输出禁止功能。
6.如权利要求5所述的同步调整装置,其特征在于,所述装置还包括一设于所述DSP事件管理器内部的计数寄存器,用于获取机器人控制器的指令时间,具体为:
所述DSP事件管理器内部设置一计数寄存器,所述计数寄存器采用增计数的模式每过一个DSP事件管理器模块内部时钟周期操作一次,每接收到一次同步调整的指令,所述计数寄存器将前后两次计数的差值乘以所述DSP事件管理器模块内部时钟周期,所得的值即为机器人控制器的指令时间。
7.如权利要求5所述的同步调整装置,其特征在于,所述装置还包括一驱动器、一电机和一机器人本体,所述驱动器接收所述DSP数字信号处理器发送的运算结果,用以控制电机的转动,所述电机用以控制机器人本体的运动。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于沈阳新松机器人自动化股份有限公司,未经沈阳新松机器人自动化股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210003545.9/1.html,转载请声明来源钻瓜专利网。
- 上一篇:公共交通系统及公共交通计费方法
- 下一篇:一种柔性连接器