Invention Grant
- Patent Title: Collision detecting method using an observer
- Patent Title (中): 使用观察者的碰撞检测方法
-
Application No.: US177342Application Date: 1994-01-04
-
Publication No.: US5440213APublication Date: 1995-08-08
- Inventor: Soichi Arita , Tetsuaki Kato , Osamu Yoshida
- Applicant: Soichi Arita , Tetsuaki Kato , Osamu Yoshida
- Applicant Address: JPX Yamanashi
- Assignee: Fanuc, Ltd.
- Current Assignee: Fanuc, Ltd.
- Current Assignee Address: JPX Yamanashi
- Priority: JPX1-334967 19891226
- Main IPC: G05B19/4061
- IPC: G05B19/4061 ; G05B5/00
Abstract:
A collision detecting method for quickly securely detecting a collision between a driven body driven by a servomotor and an obstacle by using an observer, thereby preventing machine components from be damaged by the collision. An estimated disturbance torque (y) is obtained in accordance with a torque command (I) and an actual motor speed (.theta.) by means of the observer (50) formed of blocks (S1 to 54) having transfer functions (Kt/J, K3, K4/S, 1/S), which depend individually on a torque constant, inertia, and parameters corresponding thereto, and a multiplier (61) having a transfer function (J.multidot.A) equivalent to the product of the inertia and a unit system conversion constant. The drive of the servomotor is stopped before any of the components of the machine is broken, in response to an alarm delivered from a comparator (62) when the estimated disturbance torque exceeds a threshold value (Ts) which is set at a value smaller than servomotor output torques corresponding to the breaking limits of the machine components.
Public/Granted literature
- US6037223A Stack gate flash memory cell featuring symmetric self aligned contact structures Public/Granted day:2000-03-14
Information query
IPC分类: