Abstract:
A collision detecting method, in which a collision of a driven body driven by a servomotor is detected by a disturbance estimating observer. The method obtains a disturbance component which can be known in advance, subtracts the disturbance component from an input torque to generate a modified torque, and inputs the modified torque to a distrubance estimating observer.
Abstract:
A method of obtaining a very robust adaptive PI control method irrespective of fluctuation of parameters of a control object, wherein (speed command r-actual speed y) is used as a state variable Suf. Estimated values J*, A*, Gr*, and C* of inertia, coefficient of dynamic friction, gravitational disturbance depending on a robot angle, and Coulomb's friction, respectively, are obtained and a torque command .tau. is obtained in accordance with the following equation so as to cancel an error between each of the estimated values and its actual value to zero. .tau.=K2.multidot.Suf+(K1/s).multidot.Suf+J*.multidot.r'+A*.multidot.y+Gr*.multidot.sin .theta.+Cf*+.tau.1. The first and second terms of the right side of the above equation are identical with a torque command obtained by the PI control. Furthermore, r' represents an acceleration of command; .theta. represents a rotational angle of a robot arm; and .tau.1 represents a switching input corresponding to miscellaneous disturbance. As an error between each of the estimated values and its actual value becomes zero, a relationship of speed command r=actual speed y is obtained and therefore an adaptive PI control of a transfer function "1" is obtained.
Abstract:
A method for accurately detecting an abnormal load caused, e.g., by adhesion of the distal end of a spot gun. A flag F2 is set to "1" when a move command is outputted to move a movable part of a machine and is reset to "0" upon lapse of a predetermined very short period of time, and, while the flag F2 remains "0" during stoppage of the movable part, a disturbance torque T0, estimated by a disturbance estimation observer, is stored and successively updated. When a move command is thereafter outputted, and the flag F2 is set to "1", an estimated disturbance torque T1 is obtained, and if the absolute value .vertline.T1-T0.vertline. of the difference between the disturbance torque T1 and the disturbance torque T0, estimated immediately before the movable part is moved, is greater than a reference value Ts, it is determined that an abnormal load is applied, whereupon an alarm is outputted, a flag F1 is set to "1", and the motion is stopped. The disturbance torque T0 estimated during stoppage indicates a value of the load then acting on the movable part, such as gravity. Consequently, the value .vertline.T1-T0.vertline. represents a disturbance torque during movement of the movable part, which is free from the influence of gravity, and a comparison between this value and the reference value Ts permits accurate detection of a force acting on the movable part, not including gravity or frictional force, whereby the occurrence of adhesion or the like can be accurately detected.
Abstract:
An adaptive proportional-plus-integral control system for controlling a robot or a machine tool which is subject to large load variation. The PI control system comprises a speed control loop and a pre-compensator provided in the speed control loop. The pre-compensator is equivalent to a system which is the combination of a reference model and an inverse system of a servomotor, and has adaptivity. Since the pre-compensator is incorporated into the speed control loop, robust control can be made even if the inertia of a load is largely variable.
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.
Abstract:
The feedback gain for motor control for a control system in which the inertia of a load is greatly variable is adjusted. First, a feedback gain (K1) is determined. The value of feedback gain is calculated from a servomotor itself or the like, and selected so that the control loop will not oscillate (S1). A feed-forward gain (K) is determined according to a learning process with the feedback gain (K1) (S2). Then, a feedback gain (K1) is calculated from the feed-forward gain (K) (S3). Thereafter, a feed-forward gain (K) is determined again according to a learning process based on the feedback gain (S4). The second feed-forward gain (K) and the feedback gain (K1) are used to establish a control system. In this manner, a control system having an optimum feed-forward gain and an optimum feedback gain can be established.
Abstract:
A collision detecting method is provided which is capable of promptly detecting a collision of robot operating parts driven by servomotors, e.g., robot arms, with a foreign object. Prompt detection of such collisions aids in preventing or limiting damage to a machine, etc. by the collision. A digital signal processor of an axis controller (2) of FIG. 1, as part of a software servo system, calculates a velocity command and a torque command in accordance with a movement command supplied from a main computer (1), to periodically carry out servo control for individual axes of the robot. The digital signal processor also determines whether the torque command or a velocity deviation between the velocity command and an actual velocity of a servomotor (13b) is greater than a respective predetermined value. When the torque command or velocity deviation becomes greater than the respective predetermined value, the collision detecting method determines that a collision of the robot operating part (13a) with a foreign object or the like has occurred, and the operation of the servomotor is stopped.
Abstract:
A robot control system provided in a machining system including a robot and a machine tool. The robot control system includes a robot controller controlling the robot, a portable teach pendant connected to the robot controller, and a communication network adapted to connect the robot controller to a machine tool controller controlling the machine tool. The teach pendant includes a display section configured to display information relating to the robot and the machine tool. The robot controller includes a processing section configured to obtain information relating to the machine tool from the machine tool controller through the communication network, make the display section of the teach pendant display a machine tool-related screen in accordance with a given screen program, and make the machine tool-related screen of the display section of the teach pendant display the information, as obtained, relating to the machine tool.
Abstract:
A camera a has an image sensor; an exposure controller that conducts a main exposure and a dark exposure, in order, when a long-exposure shooting is carried out; an image signal processor that processes image-pixel signals that are generated by the main exposure and are read from the image sensor; and a noise reduction processor that reduces dark current components in the image-pixel signals on the basis of dark current components in the dark exposure. The exposure controller operates the image sensor for heating between the main exposure and the dark exposure.
Abstract:
A taught point correcting device for correcting a taught point in an operation program of a robot. The device includes a judging section judging whether position data of any of a plurality of different taught points, previously taught and included in an operation program, has been corrected or not; and a data correcting section correcting, when the judging section judges that position data of a first taught point among the different taught points has been corrected, position data of a correlative taught point having a relative positional relationship with the first taught point, in accordance with a taught-point rule previously prescribing the relative positional relationship between the different taught points. The device may also include a storing section storing the taught-point rule. The taught-point rule may include a rule prescribing a distance between any two taught points among the different taught points.