System for and method of equivalent circuit reference type control

Abstract: In a technique of monitoring whether a physical system is normal or abnormal by continuously comparing a phenomenon taking place in the system and a phenomenon taking place in a model and also in a technique of control adopting evaluation functions using an error quantity in the model, the phenomena in both the physical system and model can be optimized. An equivalent electric circuit to the physical system is produced, and an input is provided to both of the system and the circuit. In this state, the output of the physical system and the reference value of the equivalent electric circuit are compared. The use of the equivalent electric circuit permits solving the problem inherent in the prior art that the time necessary for analog-to-digital conversion and numerical calculations is longer than the time of the actual phenomenon and disables real time simulation.

Description: BACKGROUND OF THE INVENTION 1. Field of the Invention This invention relates to techniques of controlling physical systems as the subject of control, such as uniaxial robots, multiaxial robots, crankshaft mechanisms, gear trains, acoustical transducers, acoustical filters, closed U-shape tubes, radiator fins, etc. and, more particularly, to techniques of controlling the output of a physical system through control of the input thereto. For example, the invention concerns the techniques of controlling the output of a uniaxial robot, such as the rotational position, rotational speed and rotational acceleration of a joint of the robot, through control of input current fed to a joint drive motor, controlling the stroke direction force of a crankshaft mechanism through momentum control, controlling the output sound pressure of an acoustical transducer through input sound pressure control, controlling the head level of a closed U-shape tube on one end side thereof through control of pressure applied to the other end side, and controlling the distal end temperature of a radiator fin through root temperature control thereof. 2. Description of the Prior Art Japanese Laid-Open Patent Publication No. 63-23693 discloses one type of the above techniques. The disclosed technique comprises the steps of analyzing the relation holding between the input to and the output from a physical system as the subject of control, completing a mathematical model of the physical system according to the analyzed relation, carrying out computer simulation of the operation of the physical system concurrently and in parallel to the operation of the physical system by using the mathematical model, comparing the actual output of the physical system and the result of the simulation, and providing the display of abnormality when the compared data are not in accord. This technique permits detection of occurrence of abnormality of some or other type, thus permitting a fail-and-safe process. Further, from document EP-A-0251 514 a control system according to the preamble of claim 1 is known. The control system is applied to an industrial multi-joint arm robot. The analog values detected from the joints of the robot are compared with reference values calculated by a computer on the basis of a dynamical simulation model. However, in both cases the computer simulation is carried out digitally and requires analog-to-digital conversion. In addition, the rate of sampling input values is determined in conformity to computer specifications and can not be indiscriminately increased. What is more, the simulation involves calculations which require operations of solving differential equations and/or equations concerning deviations. This process takes considerable time. Moreover, comparison of actual value and calculated value requires digital-to-analog conversion. Due to the requirement of the various times as noted above, frequently, a high speed actual phenomenon can not be followed up by the computer processing. In such a case, the fail-and-safe process is not executed. Particularly, a complicated behavior of a physical system necessitates a considerably long simulation time, thus making real time simulation difficult even at an actual phenomenon speed which is not so high. This problem can not be ignored when actually using a personal computer or like close-at-hand computer. Besides, it requires great deals of time and labor to establish a mathematical model and complete a simulation program. A further problem is that in computer simulation using a mathematical model, cases of erroneous simulation inevitably result from program bugs or like causes. Therefore, highly reliable fail-and-safe processes can not always be ensured. SUMMARY OF THE INVENTION The object of the invention is to solve the problem of the disability of following up an actual phenomenon due to long time involved in simulating a complex physical system. Further, it is aimed at solving the problem of the low reliability of such a simulation and the excessive time and labor required for producing a simulation program. The above object is solved by a control system according to claim 1 and a control method according to claim 2 which comprises a preparation step for establishing a control system according to claim 1. According to the invention, a control system is provided, which controls the output of a physical system as a subject of control through control of the input to the physical system. The control system, as schematically shown in FIG. 1, comprises an input controller 10 for controlling an input 11 to the physical system 12 as the subject of control, an equivalent electric circuit 18 which is constructed to be equivalent to the physical system 12, output detecting means 15 for detecting the output 13 of the physical system 12 during the presence of the input 11 to the physical system 12, reference value detecting means 17 for detecting a reference value of the equivalent electric circuit 18 during the presence of the input to the equivalent electric circuit 18, and comparator means 16 for comparing the detected value of the output detecting means 15 and the detected value of the reference value detecting means 17. To the equivalent electric circuit 18 is inputted the same value as inputted to the physical system 12. In the circuit 18, no analog-to-digital conversion process is required. This means that there do not arise the prior art problems that restrictions of the time taken in the analog-to-digital conversion process and input sampling interval may cause time-wise deviation of the input to the physical system 12 and the input in the computer simulation using a mathematical model. The present system does not ignore input value variations in a shorter period than a sampling interval. According to the invention, in the equivalent electric circuit 18, an equivalent phenomenon to that in the physical system 12 takes place concurrently and in parallel. This permits elimination of the prior art problem that simulation calculations lag behind the actual phenomenon. A further advantage of the invention is that the output of the physical system 12 is an analog value while the reference value of the equivalent electric circuit 18 is also an analog value. That is, it is necessary only to compare these two analog values, and neither requires analog-to-digital or digital-to-analog conversion. It is a yet further advantage of the invention that the equivalent electric circuit 18 can be produced easily compared to the production of a mathematical model even when the behavior of the physical system 12 is complicated, thus permitting preclusion of the requirement of long time until completion of the mathematical model. According to the invention, a control method is also provided. As shown in FIG. 1, the control method is carried out by executing a step 19 of measuring parameters of the physical system by measuring the input to and the output from the physical system a number of times, a step 20 of calculating electric parameters equivalent to the parameters measured in the measuring step, and a step 21 of producing an equivalent electric circuit by using parts which are provided with the calculated electric parameters, executing actual control by inputting the input to the physical system also to the equivalent electric circuit, and executing a step 22 of continuously comparing the output of the physical system and the reference value of the equivalent electric circuit. The steps 19 to 21 are executed in preparation and the step 22 is executed during the actual control. In this method, the equivalent electric circuit 18 is produced in the steps 19 to 21, and in actual control, both the physical system 12 and equivalent electric circuit 18 are controlled concurrently and in parallel. The result of control is also continuously compared, so that it is possible to obtain real time detection of occurrence of control abnormality or the like. In a technique of monitoring whether a physical system is normal or abnormal by continuously comparing a phenomenon taking place in the system and a phenomenon taking place in a model and also in a technique of control adopting evaluation functions using an error quantity in the model, the invention allows the phenomena in both the physical system and model to be optimized. An equivalent electric circuit to the physical system is produced, and an input is provided to both of the system and the circuit. In this state, the output of the physical system and the reference value of the equivalent electric circuit are compared. The use of the equivalent electric circuit permits solving the problem inherent in the prior art that the time necessary for analog-to-digital conversion and numerical calculations is longer than the time of the actual phenomenon and disables real time simulation. Further, the control system according to claim 1 and the control method according to claim 2 can be employed for controlling a two-axial robot as set out in claim 3. BRIEF DESCRIPTION OF THE DRAWINGS The above and other objects, features and advantages of the invention will become more apparent from the following detailed description of the preferred embodiments of the invention when the same is read with reference to the accompanying drawings, in which: FIG. 1 is a view schematically illustrating the principles underlying the invention; FIG. 2 is a schematic representation of a first embodiment of the invention; FIG. 3 is a view showing an equivalent electric circuit of a second embodiment of the invention; FIGS. 4(A) and 4(B) are views showing a crankshaft mechanism and an equivalent electric circuit therefor, respectively; FIGS. 5(A) and 5(B) are views showing a gear train and an equivalent electric circuit therefor, respectively; FIGS. 6(A) and 6(B) are views showing an acoustical transducer and an equivalent electric circuit therefor, respectively; FIGS. 7(A) and 7(B) are views showing an acoustical filter and an equivalent electric circuit therefor, respectively; FIGS. 8(A) and 8(B) are views showing a closed U-shape tube and an equivalent electric circuit therefor, respectively; and FIGS. 9(A) and 9(B) are views showing a radiator fin and an equivalent electric circuit therefor, respectively. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS FIG. 2 shows a first embodiment of the invention as applied to a two-axial robot 39. The robot 39 has a base 45 which rotatably supports a first arm 44 around a first axis 48. The rotation angle q 1 of the first arm 44 is adjusted by a first motor 40. The first arm 44 has a free end which rotatably supports a second arm 46 around a second axis 50. The rotation angle q 2 of the second arm 46 is adjusted by a second motor 42. The first and second motors 40 and 42 respectively generate torques τ 1 and τ 2 which are proportional to input currents I 1 and I 2 (τ 1 = k 1 · I 1 , τ 2 = k 2 · I 2 ). The input currents I 1 and I 2 are controlled by a two-axial controller 30. The two-axial controller 30 controls the input currents I 1 and I 2 with the lapse of time according to a working program for the robot 39. The robot 39 thus executes such operation as revolution at a low speed, revolution at a high speed or revolution in the reverse direction according to the working program. The two-axial controller 30 comprises a digital computer having a built-in interface and can control analog values of the input currents I 1 and I 2 . A tachometer generator 36 is provided in the first motor 40, and another tachometer generator 38 is provided in the second motor 42. These tachometer generators 36 and 38 provide outputs 80 and 82 which are proportional in value to the angular speeds of rotation. More specifically, the tachometer generator 36 outputs an analog value which is proportional to the revolution speed of the first arm 44, while the tachometer generator 38 outputs an analog value proportional to the revolution speed of the second arm 46. These analog values proportional to the revolution speeds are inputted to one input terminal of respective operational amplifiers 70 and 74. The input currents I 1 and I 2 which are controlled by the two-axial controller 30 are also inputted to an equivalent electric circuit 52. The equivalent electric circuit 52 includes a pair of resistors 54 and 56. A voltage k 1 • I 1 proportional to the input current I 1 is generated across the resistor 54, while a voltage k 2 • I 2 proportional to the input current I 2 is generated across the resistor 56. The resistor 54 forms a first closed loop 67 together with a resistor 62 and a coil 58 connected thereto. The resistor 56 forms a second closed loop 69 together with a resistor 64 and a coil 60 connected thereto. The mutual inductance between the coils 58 and 60 is M. The first closed loop 67 has a first current detector 66 which outputs an analog value 84 proportional to a current i 1 in the first loop 67. The second closed loop 69 has a second current detector 68 which outputs an analog value 86 proportional to a current i 2 in the second closed loop 69. The value 84 proportional to the current i 1 in the first closed loop 67 is inputted to the other input terminal of the operational amplifier 70. Likewise, the value 86 proportional to the current i 2 in the second closed loop 69 is inputted to the other input terminal of the operational amplifier 74. The operational amplifier 70 compares the analog value 80 proportional to the revolution speed of the first arm 44 and the analog value 84 proportional to the current i 1 in the first closed loop 67, and operates an alarm 72 when the difference between the compared values exceeds a predetermined value. The operational amplifier 74 compares the analog value 82 proportional to the revolution speed of the second arm 46 and the analog value 86 proportional to the current i 2 in the second closed loop 69, and operates an alarm 76 when the difference between the compared values exceeds a predetermined value. The alarms 72 and 76 are connected to the two-axial controller 30 which stops the operation of the robot 39 when at least either of the alarms 72 and 76 is operated. As an alternative of stopping the robot 39, it is possible to cause the operational amplifiers 70 and 74 to detect differences and correct the input currents I 1 and I 2 by the detected differences. Denoting the mass of the first arm 44 by m 1 , the distance between the centroid of the first arm 44 and the first axis 48 by r 1 , the mass of the second arm 46 by m 2 , the distance between the centroid of the second arm 46 and the second axis 50 by r 2 , the distance between the first and the second axes 48 and 50 by l 1 , the moment of inertia of the first arm 44 by I 1 , the moment of inertia of the second arm 46 by I 2 , the friction coefficient around the first axis 48 by d 1 , and the friction coefficient around the second axis 50 by d 2 , the equation (1) in FIG. 2 concerning the torque k 1 ·I 1 applied by the first motor 40 is satisfied, and the equation (4) concerning the torque k 2 ·I 2 applied by the second motor 42 is satisfied. The equations (1) and (4) are approximate functions which are obtained by removing non-linear term from Lagrangean function. Denoting the resistance of the resistor 62 by R 1 , the inductance of the coil 58 by L 1 , the resistance of the resistor 64 by R 2 , the inductance of the coil 60 by L 2 , the mutual inductance between the coils 58 and 60 by M, the equation (2) concerning the first closed loop 67 is satisfied, and the equation (3) concerning the second closed loop 69 is satisfied. As is obvious from the form of the equations (1), (2), (3) and (4), perfect proportionality of the revolution speeds (i.e., single differentials of the rotation angles q 1 and q 2 ) and the currents i 1 and i 2 to one another can be obtained by setting the values of the inductances L 1 , L 2 and M and resistances R 1 and R 2 to be proportional to the coefficients in the equations (1) and (4). In other words, it is obvious that the behavior of the multiaxial robot 39 as expressed by the equations (1) and (4) and the electrical behavior of the equivalent electric circuit 52 are physically equivalent to each other. In this embodiment, the angle, speed and acceleration of revolution of the multiaxial robot 39 are preliminarily measured by giving various values of the input currents I 1 and I 2 to the robot 39. The coefficients in the equations (1) and (4) are obtained from the values of the input current and the output at this time by the least square method. Electric parameters of the coils 58 and 60, resistors 62 and 64, etc. are selected from the coefficients obtained in this way. In this case, the analog values 80 and 84 inputted to the operational amplifier 70 are set to be equal to each other, and also the analog values 82 and 86 inputted to the operational amplifier 74 are set to be equal to each other. It is possible to provide separate operational amplifiers for analog value adjustment. It is well recognized in the art that the behavior occurring in a mechanical system and that occurring in an electric system can be made equivalent to each other. In the preparation stage, the coefficients (or parameters) in the equations (1) and (4) which describe the motion of the physical system are measured, and the equivalent electric circuit 52 for bringing about an equivalent electric phenomenon is produced. That is, a system shown in the upper half of FIG. 2 is preliminarily built up. In the actual control, the input currents I 1 and I 2 are continuously inputted to the equivalent electric circuit 52. During this time, the tachometer generators 36 and 38 continuously detect outputs from the physical system (i.e., revolution speeds) while current detectors 66 and 68 continuously detect reference values (i.e., currents in this case) in the equivalent electric circuit 52. Each of the operational amplifiers 70 and 74 continuously detects the two values inputted thereto. When no abnormality is produced in the control system, an equivalent phenomenon to that in the physical system is produced in the equivalent electric circuit 52, the two analog values inputted to each of the operational amplifiers 70 and 74 are equal, and neither of the alarms 72 and 76 is operated. When some abnormality occurs, for instance when an obstacle collides with the robot 39 to prevent the scheduled operation, the behavior in the physical system and that in the equivalent electric circuit 52 fails to be in accord with each other. For example, when the movement of the first arm 44 is unexpectedly restricted, the revolution speed of the first arm 44 and the current in the first closed loop 67 are no longer proportional. This results in failure of accord of the levels of the inputs to the first operational amplifier 70, thus causing the alarm 72 to operate. Likewise, when the movement of the second arm 46 is unexpectedly restricted, the revolution speed of the second arm 46 and the current in the second closed loop 69 are no longer proportional, so that the levels of the inputs to the second operational amplifier 74 fails to be in accord, thus causing the alarm 76 to operate. In this embodiment, as described above, in the actual control, the same input data is given to the physical system and also to the equivalent electric circuit 52 to cause equivalent phenomena concurrently and in parallel. It is thus possible to real time monitor for any abnormality or monitor the operation as scheduled. In FIG. 2, the phenomena taking place outside the two-axial controller 30 all utilize analog values, and the process of monitoring does not require any analog-to-digital or digital-to-analog conversion. The equivalent electric circuit 52 is an analog circuit, and in this circuit, a behavior equivalent to that in the robot 39 is obtained concurrently and in parallel. In other words, in this embodiment, the concurrence of equivalent phenomena is maintained. Furthermore, in a prior art mathematical model simulation technique, quick change of the input currents I 1 and I 2 is ignored when the change of the input currents is rapid compared with the sampling rate. In this embodiment, the equivalent electric circuit 52 maintains equivalent behavior to that of the robot 39 even if the input currents I 1 and I 2 change quickly. As described above, the equations (1) and (4) are approximate functions free from non-linear term. The circuit shown in FIG. 2 shows an approximate equivalent electric circuit in this case, whereas shown in FIG. 3 is an equivalent electric circuit in which non-linear terms as well are taken into consideration. Using coefficients in the equations (5) to (7) among the equations (5) to (13) shown below, the motion around the first axis is given by the equation (8), and the motion around the second axis is given by the equation (9). These equations (8) and (9) of motion contain non-linear terms and reflect influence of Coriolis' force, centrifugal force and posture changes of the robot 39. The equation (10) is a transformation of the equation (8), and the equation (13) is a transformation of the equation (9). The equations (11) and (12) are satisfied with the electric circuit shown in FIG. 3, that is, an electric circuit in which the first loop has electric parameters of the self inductance L 3 , mutual inductance M 2 and resistance R 3 and the second loop has parameters of the self inductance L 4 , mutual inductance M 2 and resistance R 4 . C 1 =I 1 +I 2 +m 1 r 1 2 +m 2 l 1 2 +m 2 r 2 2 C 2 =I 2 +m 2 r 2 2 C 3 =m 2 l 1 r 2 As is obvious, assuming that the coefficients in the equations of motion of the robot are proportional to the coefficients in the electric circuit, the mechanical behavior taking place in the robot and the electrical phenomenon in the electric circuit are equivalent to each other. In this case, the speed of revolution around the first axis and the current i 1 in the first loop are equivalent, and the speed of revolution around the second axis and the current i 2 in the second loop are equivalent. In the consideration of the non-linear terms as well, the electric parameters of one of the loops must be varied according to the current in the other loop. To meet this requirement, a reactance transistor is used for the resistor 102 and the coil 104 in the first loop. A reactance transistor is also used for the coil 106 for the mutual inductance. These reactance transistors have properties that their resistance and inductance are varied according to the inputted current. They permit production of an electric circuit, the behavior of which is equivalent to that expressed by the equations (10) and (13), by setting the inputted currents as shown in FIG. 3. Current-to-voltage transducers 108 and 110 in FIG. 3 control the voltages applied to the first and second loops according to the inputted currents. Current signals for electric parameter control are controlled in the FIG. 3 circuit. A current detector 112 detects the current i 2 in the second loop (which is equivalent to the single differential of q 2 ). An integrator 114 integrates the output of the current detector 112. The output of the integrator 114 is inputted to the reactance transistors, so that inductances of the coils 104 and 106 are controlled according to the cosine of the integral of the current in the quadratic circuit. The elements shown as "SQUARE" each output a current corresponding to the square of the input. The elements shown as "MULTIPLY" each multiply two input currents by each other and output the product. The element shown as "sin" outputs the sine of the input. Thus, the coefficients in the equations (10) and (11) can be made proportional to one another, and the coefficients in the equations (12) and (13) can be made proportional to one another. This means that with the FIG. 3 circuit, it is possible to make the robot and the electric circuit to be equivalent to each other. It is thus possible to make the current i 1 in the first loop and the speed of revolution around the first axis to be equivalent to each other and also make the current i 2 in the second loop and the speed of revolution around the second axis to be equivalent to each other. By comparing these data by the FIG. 2 operational amplifiers 70 and 74, it is possible to obtain monitoring as to whether the equivalent phenomena are taking place as scheduled or some abnormality is taking place. The FIG. 3 equivalent electric circuit permits closer approximation than the FIG. 2 equivalent electric circuit. However, as a result of various experiments conducted by the inventor, it was confirmed that the FIG. 2 approximate equivalent circuit, i.e., the circuit 52 which is free from any non-linear term, can produce phenomena which may actually be made equivalent, and that a monitoring process as to whether any abnormality is taking place is possible with an arrangement that the alarms 72 and 76 are not operated when the differences inputted to the operational amplifiers 70 and 74, respectively, are in predetermined ranges. FIGS. 4(A) and 4(B) show a crank mechanism and an equivalent electric circuit therefor, respectively. In this case, by making the voltage applied to the first closed loop 102 to be proportional to the moment M 1 of the crankshaft, making the voltage applied to the second closed loop 104 to be proportional to stroke force F 2 and making electric parameters of the first and second closed loops 102 and 104 to correspond to mechanical parameters of the crankshaft mechanism, relations can be obtained that the speed or revolution about the crankshaft is equivalent to the current in the first closed loop 102 and that the stroke speed is equivalent to the current in the second closed loop 104. Again in this case, like the FIG. 2 case, it is possible to obtain monitoring as to whether the crankshaft mechanism is normal or abnormal. FIGS. 5(A) and 5(B) show a gear train and an equivalent electric circuit therefor, respectively. In this case, by making the voltage applied to the first closed loop 106 to be proportional to the moment of a first gear 110, making the voltage applied to the second closed loop 108 to be proportional to the moment of a second gear 112 and making electric parameters of the first and second closed loops 106 and 108 to correspond to mechanical parameters of the gear train, the speed of revolution of the first gear 110 is made equivalent to the current in the first closed loop 106, and the speed of revolution of the second gear 112 is made equivalent to the current in the second closed loop 108. Again in this case, like the FIG. 2 case, it is possible to obtain monitoring as to whether the gear train is normal or abnormal. FIGS. 6(A) and 6(B) show an acoustical transducer comprising a large diameter cylinder and a small diameter cylinder and an equivalent electric circuit therefor, respectively. In this case, by setting mechanical parameters of the physical system (i.e., acoustical transducer) to circuit parameters of the equivalent electric circuit and applying a voltage proportional to the sound pressure q 1 at the large diameter cylinder inlet between terminals A and B, the sound pressure q 2 at the small diameter cylinder outlet can be made equivalent to the voltage between terminals C and D. Again in this case, the phenomenon in the physical system and that in the equivalent electric circuit can be made equivalent. Thus, like the FIG. 2 case, by comparing the two phenomena, it is possible to obtain monitoring as to whether the acoustical transducer is normal or abnormal. FIGS. 7(A) and 7(B) show an acoustical filter and an equivalent electric circuit therefor, respectively. In this case, by applying a voltage proportional to input sound pressure P 1 between terminals E and F, a voltage proportional to an output sound pressure P 2 is generated between terminals G and H. FIGS. 8(A) and 8(B) show a closed U-shape tube and an equivalent electric circuit therefor, respectively. In this case, by applying a voltage proportional to a pressure P applied to one end of the tube between terminals I and J, a current proportional to the head level at the other end of the tube is caused to flow in the circuit. FIGS. 9(A) and 9(B) show a radiator fin and an equivalent circuit therefor, respectively. In this case, by applying a voltage proportional to the root temperature T 1 of the fin, a voltage proportional to the distal end temperature T 2 of the fin is generated between terminals M and N. The above examples of the physical system and equivalent electric circuit therefor were introduced in literatures. According to the invention, equivalent phenomena are produced concurrently in a physical system and an equivalent electric circuit therefor, and it is possible to obtain comparison as to whether the equivalence is maintained, thus permitting real time monitoring of whether or not any abnormality is taking place in the physical system. Besides, it is possible to eliminate time taken in the analog-to-digital conversion, sampling and numerical calculation that are necessary for simulation with a mathematical model, thus eliminating the possibilities of lagging of the simulation behind the actual phenomena and the simulation with input of a different value. According to the invention, it is thus possible to obtain real time monitoring of the behavior of complicated physical systems. Besides, the production of an equivalent electric circuit has a merit that it requires a short time compared to the development of a program of simulation using a mathematical model. Moreover, the reliability can be improved. While some preferred embodiments of the invention have been described in the foregoing, it is to be understood that changes and modifications may be made in the details of the design without departing from the scope of the invention as defined in the appended claims.

Claims: A control system adapted for the control of the output (13) of a physical system (12) as a subject of control through control of the input (11) to the physical system (12) the behavior of which is described by an at least two-dimensional differential equation system, said control system comprising an input controller (10) for controlling the input (11) to the physical system (12); output detecting means (15) for detecting the output (13) of the physical system (12) and providing an analog value while the input (11) to the physical system (12) prevails; reference value providing means for providing a reference value for the physical system on the basis of the input (11) to the physical system (12); and comparator means (16) for comparing the analog value of the output detecting means (15) and the reference value of the reference value providing means, characterized in that the reference value providing means comprises an equivalent electric circuit (18) to which the input (11) to said physical system (12) is input as well; and reference value detecting means (17) for detecting the output of the equivalent electric circuit (18) and providing an analog reference value as said reference value while the input (11) to the equivalent electric circuit (18) prevails, wherein the analog reference value of the reference value detecting means (17) is equivalent to the analog value of the output detecting means (15) in case the physical system (12) operates in a normal state. A method adapted for controlling the output (13) of a physical system (12) as a subject of control through control of the input (11) to the physical system (12) the behavior of which is described by an at least two-dimensional differential equation system, said method comprising in a preparation stage for establishing a control system according to claim 1 a step (19) of measuring the parameters of the physical system (12) by measuring the input (11) to and the output (13) from the physical system (12) a number of times; a step (20) of calculating electric parameters of an equivalent electric circuit (18) which are equivalent to the parameters of the physical system (12) measured in the parameter measuring step; and a step (21) of producing the equivalent electric circuit (18) of the control system by using parts with the calculated electric parameters, and further comprising in the actual control a step (22) of inputting the input (11) to the physical system (12) as well as to the equivalent electric circuit (18) to continuously compare, in this state, the analog value of the output detecting means (15) and the analog reference value of the reference value detecting means (17). A control system according to claim 1 for the control of a two-axial robot (39) having a base (45), a first arm (44) mounted on and rotatable relative to the base (45), a second arm (46) mounted on the free end of and rotatable relative to the first arm (44), a first motor (40) for rotating the first arm (44) and a second motor (42) for rotating the second arm (46), said control system comprising as the equivalent electric circuit (10; 52) a first closed loop (67) including a resistor (54) having a grounded terminal, a voltage proportional to the current (32) in the first motor (40) being generated across the resistor (54), and a series connection of a resistor (62) and a coil (58), the series connection being connected between the opposite terminals of the resistor (54), and a second closed loop (69) including a resistor (56) having a grounded terminal, a voltage proportional to the current (34) in the second motor (42) being generated across the resistor (56), and a series connection of a resistor (64) and a coil (60), the series connection being connected between the opposite terminals of the resistor (56), wherein the coil (58) in the first closed loop (67) and the coil (60) in the second closed loop (69) are inductively coupled; as the reference value detecting means (17) a first current detector (66) for detecting the current in the first closed loop (67) and providing a first analog reference value (84), and a second current detector (68) for detecting the current in the second closed loop (69) and providing a second analog reference value (86); as the output detecting means (15) a first tachometer generator (36) for outputting an analog value (80) proportional to the speed of revolution of the first arm (44), and a second tachometer generator (38) for outputting an analog value (82) proportional to the speed of revolution of the second arm (46); and as the comparator means (16) a first comparator (70) for comparing the analog reference value (84) of the first current detector (66) and the analog value (80) of the first tachometer generator (36), and a second comparator (74) for comparing the analog reference value (86) of the second current detector (68) and the analog value (82) of the first tachometer generator (38); wherein the resistance R 1 of the resistor (62) and the inductance L 1 of the first closed loop (67), the resistance R 2 of the resistor (62) and the inductance L 2 of the second closed loop (69), and the mutual inductance M between the coil (58) of the first closed loop (67) and the coil (60) of the second closed loop (69) are given as R 1 = d 1 , L 1 = I 1 + I 2 + m 1 r 1 2 + m 2 ℓ 1 2 + m 2 r 2 2 , R 2 = d 2 , L 2 = I 2 + m 2 r 2 2 , and M = I 2 + m 2 r 2 2 , where d 1 is a friction coefficient of the first arm (44), d 2 is a friction coefficient of the second arm (46), I 1 is the moment of inertia of the first arm (44), I 2 is the moment of inertia of the second arm (46), m 1 is the mass of the first arm (44), m 2 is the mass of the second arm (46), ℓ 1 is the distance between the center of rotation of the first arm (44) and the center of rotation of the second arm (46), r 1 is the distance of the center of rotation of the first arm (44) and the centroid thereof, and r 2 is the center of rotation of the second arm (46) and the centroid thereof.

Inventors: IMAI KOJI, SUITA KAZUTSUGU, TSUCHIDA NUIO, YAMADA YOJI, IMAI, KOJI, SUITA, KAZUTSUGU, TSUCHIDA, NUIO, YAMADA, YOJI
Applicants: TOYOTA MOTOR CO LTD, TOYOTA SCHOOL FOUNDATION, TOYOTA JIDOSHA KABUSHIKI KAISHA
Application year: 1996
Main classification: G05B17
IPC codes: G05B17, G05B13, G05B23