Invention Grant
- Patent Title: Method for supervision of the movement control of a manipulator
- Patent Title (中): 操纵器运动控制监控方法
-
Application No.: US09403612Application Date: 2000-03-07
-
Publication No.: US06218801B1Publication Date: 2001-04-17
- Inventor: Torgny Brogårdh , Staffan Elfving , Ingvar Jonsson , Stig Moberg , Fredrik Skantze
- Applicant: Torgny Brogårdh , Staffan Elfving , Ingvar Jonsson , Stig Moberg , Fredrik Skantze
- Priority: SE9701796 19970515
- Main IPC: G05B2302
- IPC: G05B2302

Abstract:
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.
Information query