Electricity: motive power systems – Positional servo systems – Program- or pattern-controlled systems
Patent
1988-09-13
1990-02-27
Shoop, Jr., William M.
Electricity: motive power systems
Positional servo systems
Program- or pattern-controlled systems
318615, 318618, 318632, 31856824, 364513, 901 23, G05B 1300
Patent
active
049049151
DESCRIPTION:
BRIEF SUMMARY
BACKGROUND OF THE INVENTION
1. Field of the Invention
This invention relates to a velocity control apparatus for controlling the velocity of the distal end of a load, such as the arm of a robot, by a status observing apparatus.
2. Description of the Related Art
Servomotors are used in control systems for driving various mechanical loads in machine tools and the like. In the case of a servomotor for driving a load having little rigidity such as a robot arm, it is required that velocity be controlled and not just position.
FIG. 2 is a block diagram illustrating an example of a conventional servo-control system having a mechanical load with little rigidity. A servo-controller a is included in a control system constructed such that a servomotor b and a mechanical load c are connected by a spring constant (K) d.
In FIG. 2, Kt denotes a torque constant, Jm rotor inertia, K the spring constant, J.sub.L load inertia and l/s an integration term. In a case where the mechanical load c having little rigidity is driven by the servomotor b, a current command u(k) applied to the control system is converted into a torque command by the torque constant Kt and a deviation signal between this torque command and an actual torque value is applied to the servomotor b as a command. This deviation signal is converted into an acceleration command by the rotor inertia term Jm, and this command is passed through the integration term once to obtain a motor velocity command signal V for driving and controlling the servomotor b to indirectly control the mechanical load c.
The motor velocity command signal V is passed through the integration term to obtain a position command signal .theta., which is used to determine velocity V.sub.L and position .theta..sub.L for the mechanical load c. Connected to an output shaft of the servomotor b is a rotary encoder e or the like for detecting, as a command signal y, the commanded position of the mechanical load c commanded by the servomotor b.
The operating states of the servomotor b and mechanical load c constituting the actual control system as an actuator cannot be fed back to the servocontroller upon measuring all of the variables thereof on-line. Accordingly, the necessary status data regarding the object under control must be estimated upon stipulating the state of the control system based solely on utilizable data from the rotary encoder e or the like. It is therefore necessary to detect the motor velocity command signal V, the actual velocity V.sub.L at the distal end of the mechanical load and control velocity in dependence upon the deviation with respect to the command signal V. In general, a sensor for detecting the velocity V.sub.L of the mechanical load c is high in cost and is difficult to mount on every axis of a robot. For these reasons, velocity control in the servo-control system shown in FIG. 2 is performed by estimating velocity by means of an observer (status observing device).
In cases where status variables cannot be measured directly, the status variables are reproduced by the observer from a control input and a measurement output. However, in the foregoing servo-control system, the estimated value of velocity based on the servomotor b and the position of the distal end of the mechanical load c are computed and discrete value control is carried out by a microprocessor (now shown). The following computation equations serve as a basis for estimated values .theta., V of position and velocity of the motor and estimated values .theta..sub.L, V.sub.L of the position and velocity of the load used in this computation: .theta..sub.L (K) +0.sub.14 V.sub.L (K)+h.sub.1 u(K)}+K.sub.1y (K+1)(1) 0.sub.12)V(K)+(0.sub.23 31 K.sub.2 0.sub.13).theta..sub.L (k) +(0.sub.24 -K.sub.2 0..sub.14)VL(K)+(h.sub.2 -K.sub.2 H.sub.1)U(K) +K.sub.2y (K+1)(2) 0.sub.12)V(K)+(0.sub.23 -K.sub.3 0.sub.13).theta.L(K) +(0.sub.34 -K.sub.3 0.sub.14)VL(K)+(h.sub.3 -K.sub.3 h.sub.1)U(K) +K.sub.3y (K+1)(3) 0.sub.12)V(K)+(0.sub.43 -K.sub.4 0.sub.13).theta.L(K) +(0.sub.44 -K.sub.4 0.sub.14)VL(K)+(h.sub.4 -k.sub.4 h.sub
REFERENCES:
patent: 3845284 (1974-10-01), Taguchi et al.
patent: 4156835 (1979-05-01), Whitney et al.
patent: 4243923 (1981-01-01), Whitney et al.
patent: 4331910 (1982-05-01), Kohzai et al.
patent: 4507594 (1985-03-01), Takemoto
patent: 4535277 (1985-08-01), Kurakake
patent: 4547858 (1985-10-01), Horak
patent: 4587469 (1986-05-01), Ikebe et al.
patent: 4603284 (1986-07-01), Perzley
patent: 4621332 (1986-11-01), Sugimoto et al.
patent: 4665352 (1987-05-01), Bartelt et al.
patent: 4680518 (1987-07-01), Kurakake et al.
patent: 4695780 (1987-09-01), Kurakake et al.
patent: 4788482 (1988-11-01), Tachibana et al.
Fanuc Ltd.
Ip Paul
Shoop Jr. William M.
LandOfFree
Velocity control apparatus does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Velocity control apparatus, we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Velocity control apparatus will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-175898