专利快速检索-快速检索全球专利，免费商用专利数据库-IPRDB

1. 发明授权

US06218801B1 Method for supervision of the movement control of a manipulator 有权
标题翻译：操纵器运动控制监控方法
公开(公告)号：US06218801B1
公开(公告)日：2001-04-17
申请号：US09403612
申请日：2000-03-07
申请人： Torgny Brogårdh , Staffan Elfving , Ingvar Jonsson , Stig Moberg , Fredrik Skantze
发明人： Torgny Brogårdh , Staffan Elfving , Ingvar Jonsson , Stig Moberg , Fredrik Skantze
IPC分类号： G05B2302
CPC分类号： B25J9/1674 , G05B2219/39178 , G05B2219/39187 , G05B2219/39194 , G05B2219/39237 , G05B2219/40226 , G05B2219/42307
摘要： A method for supervision of the movement control of a manipulator. The manipulator comprises at least one movement axis, a servo (9) for controlling the axis in accordance with supplied reference values for position, speed and acceleration (&psgr;ref, {dot over (&psgr;)}ref, {umlaut over (&psgr;)}ref). A plurality of dynamic parameters (dyn-par) are calculated in dependence on reference values for the position and speed of the axis and a dynamic model (7) which describes the static and dynamic properties of the robot. A torque signal (&tgr;mr) is generated by the servo in dependence on the control error torque (&tgr;err) of the servo. An alarm value (LV) is calculated as a function of the current acceleration ({umlaut over (&psgr;)}m), at least any of the dynamic parameters and one or more of the following signals: the control error torque (&tgr;err) of the servo, the reference value for the acceleration ({umlaut over (&psgr;)}ref) and the torque signal from the servo (&tgr;mr), and while using one or more signal filters. An alarm limit (LG) is calculated as a function of one or more of the following parameters: a constant, the current position (&psgr;m), the current speed ({dot over (&psgr;)}m), the current acceleration ({umlaut over (&psgr;)}m) any of the dynamic parameters, the control error torque (&tgr;err) of the servo, the reference value for the acceleration ({umlaut over (&psgr;)}ref) and the torque signal from the servo (&tgr;mr). The alarm value is compared with the alarm limit and an alarm signal (ALARM) is generated in dependence on the comparison.
摘要翻译：一种用于监视机械手的运动控制的方法。操纵器包括至少一个移动轴线，伺服机构（9），用于根据提供的位置，速度和加速度的参考值（psiref，{dot over（psi）} ref，{umlaut over（psi）} ref ）。根据轴的位置和速度的参考值和描述机器人的静态和动态属性的动态模型（7）来计算多个动态参数（dyn-par）。根据伺服的控制误差转矩（＆Tgr; err），伺服产生转矩信号（＆tgr; mr）。计算报警值（LV）作为当前加速度（{umlaut over（psi）} m）的函数，至少动态参数和以下信号中的一个或多个：控制误差转矩（＆tgr; err ），加速度的参考值（{umlaut over（psi）} ref）和来自伺服（＆tgr; mr）的转矩信号，以及使用一个或多个信号滤波器时。根据一个或多个以下参数计算报警极限（LG）：常数，当前位置（psim），当前速度（{dot over（psi）} m），当前加速度（{umlaut 超过（psi）} m）任何动态参数，伺服的控制误差转矩（＆Tgr; err），加速度的参考值（{umlaut over（psi）} ref）和来自伺服的转矩信号＆tgr; mr）。将报警值与报警限值进行比较，并根据比较生成报警信号（ALARM）。

IPRDB

热门服务

关于我们

友情链接

联系方式