Supporting device.

This invention relates to a supporting device for supporting or holding an article with the aid of resilient means. More particularly, it relates to a supporting device comprising resilient means in which the effective spring force can be changed in accordance with the movement or situation of the article to be supported by controlling the displacement of the resilient means which is moved in response to the force applied to the article. The present invention is especially useful when applied to connection means located between an arm and a hand of an industrial robot.

A supporting device comprising resilient means in which the spring force can be varied in response to the force applied to the article to be supported is required in various industrial fields. For example, a supporting device is used in a paper feed apparatus. A paper to be fed is pressed on to a paper feed by a spring so as to avoid scattering. The spring force of the supporting device of the prior art is constant, irrespective of the kind and number of papers to be fed. Therefore, if a stiff spring is chosen so as to deal with a thick and hard paper or corrugated paper, a thin paper may be torn by the spring. On the other hand, if a soft spring is chosen so as to deal with a thin paper, the pressing force thereof is not sufficient to avoid scattering of thick papers. Therefore, the type of paper is limited depending upon the spring force of the resilient means used in the paper feed apparatus or, alternatively, the entire resilient means has to be replaced by another one so as to deal with another kind of paper.

A supporting device comprising a resilient means is also used in a robot for manufacturing magnetic heads or record player arms. The operation of assembling the magnetic head or record player arm should be carried out accurately and conducted by a weak force so as to avoid damage of the arm or head, which necessitates an expensive control means of high accuracy.

Industrial robots are disposed along an assembly line for the automatic production of various articles. For example, an industrial robot is used to insert a rod member into a hole which has a close clearance of the order of several microns. In such an insertion operation, the position of the rod member with respect to the hole must be precisely adjusted before the rod member is inserted into the hole, so as to achieve smooth insertion thereof and so as to prevent damaging of the rod member and the hole. Therefore, a robot is required which can easily and precisely position a rod member to be handled in the above-mentioned insertion operation.

An industrial robot is used in order to produce articles automatically with a high reliability and at a high speed, which production requires a precise position-control system. The assembly of products with a high accuracy cannot be achieved simply by increasing the accuracy of positioning of the robot itself. An important thing is that the relative position between the members to be assembled must be accurately adjusted. This is especially important in a process where a rod member is inserted into a hole of a close clearance of several microns. A robot used in such an insertion operation comprises an arm and a hand for gripping the rod member, attached to the end of the arm. The rod member is conveyed above the hole by the horizontal movement of the arm. Then the rod member is inserted into the hole by the vertical movement of the arm. The hand of the conventional robot is rigidly secured to the arm end. Therefore, it is impossible to insert the rod member into the hole unless the rod member is precisely aligned with the hole. If the rod member is misaligned with the hole, the rod member and the member to receive the rod member are damaged by the vertical movement of the robot arm for insertion of the rod member. In order to prevent such damaging of the members, a control means for precisely controlling the position of the robot arm is necessary. However, this control means increases the cost of the robot.

The applicant has proposed a compliance means, comprising resilient means such as a leaf spring or a coil spring, so as to achieve smooth insertion of the rod member into the hole by applying such compliance means to the wrist portion between the hand and the arm of the robot. Such compliance means compensates for the misalignment between the rod member and the hole. However, in a robot having a wrist structure which comprises such a compliance means, if the compliance of the wrist is increased so as to increase the compensation for misalignment of the rod member with respect to the hole, the stiffness of the wrist portion for insertion of the rod member into the hole is weakened, with the result that a sufficient insertion force cannot be generated. Also, the large compliance of the wrist portion causes the rod member grasped by the robot hand to vibrate when movement of the robot arm is started and stopped. Therefore, the robot cannot be operated at a high speed.

An industrial robot achieving the above-mentioned insertion operation and equipped with the compliance device located between the wrist and the hand is also used in the process of manufacturing magnetic discs.

As is illustrated in Fig. 60, a magnetic disc 401 comprises a flat ring plate substrate 402 of aluminum, on which a magnetic layer 403 is formed as a recording medium by a coating method or a sputtering method, the inner periphery 404 of the magnetic disc 401 being uncoated and exposing the aluminum substrate 402. The magnetic disc 401 is assembled with a spindle which is inserted into an opening 420 of the magnetic disc 401 so as to constitute a magnetic disc device. During the process of assembling the magnetic disc device, the magnetic layer 403 of the magnetic disc 401 must not be touched so as to prevent magnetic or mechanical damaging of the magnetic layer 403 and contamination of the disc surface with finger prints or dust.

A conventional hand structure of the robot for handling a magnetic disc is illustrated in Fig. 61.

A hand 406 is attached to the end of an arm 405. The hand 406 comprises fingers 406a. A piece 407 is provided at the end of the finger 406a. The outer periphery of the magnetic disc 401 is received and held in a V-shaped groove (not shown) of each piece 407 of the finger 406a. This type of conventional hand of the robot is large and heavy, with the result that high speed control cannot be easily achieved. Also, the magnetic disc 401 and the hand 406 may be damaged if the magnetic disc 401 is misaligned with the spindle (not shown) or if the magnetic disc 401 is inclined with respect to spindle when the spindle is inserted into the opening 420 of the magnetic disc 401. Therefore, the conventional robot necessitates a control means of a high accuracy for controlling the position and angle of the magnetic disc 401 with respect to the spindle.

The present invention obviates the above-mentioned drawbacks of the prior art and provides a supporting device which makes it possible to vary the springy force thereof in response to the movement or situation of the article to be supported by controlling the displacement of the springy means thereof in response to the force applied to the article.

In accordance with a first aspect of the present invention, there is provided a supporting device comprising a first member which supports resilient means for resiliently supporting a second member, characterised by detection means for detecting displacement of the resilient means with respect to the first member in accordance with the movement of the second member; and biasing means which applies a force to the resilient means from the same direction as, or from a direction opposite to, that of the displacement, for changing the elasticity of the resilient means in accordance with the movement of the second member.

In accordance with another aspect of the invention, there is provided a supporting device comprising a first member which supports resilient means for resiliently supporting a second member, characterised in that the resilient means comprises a first pair of parallel leaf springs, an end of which is connected to the first member, and a second pair of parallel leaf springs, an end of which is connected to the second member, the other end of the first pair of leaf springs and the other end of the second pair of leaf springs being interconnected in such a manner that the direction of displacement of the first pair of leaf springs with respect to the first member is perpendicular to the direction of displacement of the second pair of leaf springs with respect to the first member.

Preferably, the supporting means further comprises a cross-shaped leaf spring (diaphragm) which is disposed at the connecting portion between the resilient means and the first or second member and which permits the second member to incline with respect to the first member and shift the second member with respect to the first member in a direction perpendicular to the direction of displacement of the first and second pair of leaf springs.

Embodiments of the invention will now be described, by way of example, with reference to the accompanying drawings, in which <ul id="ul0001" list-style="none"><li>Figure 1 is a perspective view of a mechanical compliance means comprising a parallel leaf spring assembly relating to the present invention.</li><li>Figure 2 is a perspective view of a robot including the parallel leaf spring assembly of Figure 1,</li><li>Figures 3 and 4 show respective stages in an insertion operation carried out by the robot of Figure 2.</li><li>Figure 5 is a perspective view of a parallel leaf spring assembly showing an arrangement of strain gauges attached thereon,</li><li>Figure 6 is a perspective view of a parallel leaf spring assembly showing another arrangement of strain gauges attached thereon,</li><li>Figures 7 to 9 are diagrams of bridge circuits comprising strain gauges, each diagram showing a different bridge circuit,</li><li>Figure 10 is a perspective view of a robot comprising a parallel leaf spring assembly provided with the strain gauges,</li><li>Figure 11 is a control circuit diagram of the robot of Figure 10,</li><li>Figure 12 is a perspective view of a mechanical compliance means relating to the present invention,</li><li>Figures 13 to 16 show respective stages in an insertion operation carried out by the robot of the present invention provided with the compliance means of Figure 12,</li><li>Figure 17 is a perspective view of a cross-shaped leaf spring (diaphragm) showing an arrangement of strain gauges attached thereon.</li><li>Figure 18 is a block diagram of a circuit comprising the strain gauges of Figure 17,</li><li>Figure 19 shows the forces and torques applied to the compliance means,</li><li>Figure 20 is a perspective view of another example of a robot relating to the present invention,</li><li>Figure 21 is a control circuit diagram of the robot of Figure 20,</li><li>Figure 22 is a perspective view of the cross-shaped leaf spring,</li><li>Figure 23 is a plan view of the cross-shaped leaf spring of Figure 22,</li><li>Figure 24 is a side view of the cross-shaped leaf spring of Figure 22,</li><li>Figure 25 is a perspective view of an example of a shortened structure of the compliance means located on the wrist portion of the robot relating to the present invention,</li><li>Figure 26 is a perspective view of another example of the shortened structure of the compliance means located on the wrist portion of the robot relating to the present invention,</li><li>Figure 27 is a partial,detailed view of the wrist portion of the robot of Figure 26,</li><li>Figure 28 is a perspective view of another example of the shortened structure of the compliance means located on the wrist portion of the robot relating to the present invention,</li><li>Figure 29 is a perspective view of an example of the robot relating to the present invention,</li><li>Figures 30 and 31 are sectional views of the compliance means located on the wrist portion of the robot showing respective stages in an insertion operation carried out by the robot,</li><li>Figure 32 is a perspective view of yet another example of the wrist portion of the robot relating to the present invention,</li><li>Figure 33 is a partial sectional view of the wrist portion of Figure 32,</li><li>Figure 34 is another partial sectional view of the wrist portion of Figure 32,</li><li>Figure 35 is a perspective view of one pair of parallel leaf springs of the wrist portion of Figure 32 provided with strain gauges thereon,</li><li>Figure 36 is a perspective view of the other pair of parallel leaf springs of the wrist portion of Figure 32 provided with strain gauges thereon,</li><li>Figure 37 is a perspective view of the cross-shaped leaf spring of the wrist portion of Fig. 32 provided with strain gauges thereon,</li><li>Figure 38 is a perspective view of the wrist portion of the robot in accordance with the present invention seen from the upper side thereof,</li><li>Figure 39 is a perspective view of the wrist portion of Fig. 38 seen from the lower side thereof,</li><li>Figure 40 is a graph of the output voltage of the strain gauges relating to the present invention,</li><li>Figure 41 is a block circuit diagram showing control of the wrist portion of the robot relating to the present invention,</li><li>Figure 42 is another block circuit diagram showing control of the wrist portion of the robot relating to the present invention,</li><li>Figure 43 is a partial, detailed circuit diagram of the circuit of Fig. 42,</li><li>Figure 44 is a block diagram showing control of the wrist portion of the robot relating to the present invention,</li><li>Figure 45 is a circuit diagram showing control of the wrist portion of the robot relating to the present invention,</li><li>Figure 46 is a further block diagram showing control of the wrist portion of the robot relating to the present invention,</li><li>Figure 47 is a graphical view of the gain characteristic of the differential term of the diagram of Fig. 46,</li><li>Figure 48 is a graphical view of the gain characteristic of the integral term of the diagram of Fig. 46,</li><li>Figure 49 is a graphical view of the gain characteristic of a combination of the differential term and the integral term of the diagram of Fig. 46,</li><li>Figure 50 is a perspective view of another example of the compliance means relating to the present invention,</li><li>Figure 51 is a sectional view of the wrist portion of the robot provided with the compliance means of Fig. 50,</li><li>Figure 52 is a perspective view of the wrist portion of the robot provided with the compliance means of Fig. 50,</li><li>Figure 53 is a top view of a supporting device (wrist porton of the robot) to which the compliance means relating to the present invention is applied,</li><li>Figure 54 is a side view of the supporting device of Fig. 53,</li><li>Figure 55 is a plan view of a biasing means relating to the present invention,</li><li>Figure 56 is a top view of a holder relating to the present invention,</li><li>Figure 57 is a side view of the holder of Fig. 56,</li><li>Figure 58 is a sectional view of the wrist portion of the robot assembled with the parts of Figs. 53 to 57,</li><li>Figure 59 is a plan view seen in the direction X-X in Fig. 58,</li><li>Figure 60 is an outer view of a magnetic disc,</li><li>Figure 61 is an outer view of the hand of a conventional robot for manufacturing a magnetic disc device,</li><li>Figure 62 is a perspective view of a robot for manufacturing a magnetic disc device relating to the present invention,</li><li>Figure 63 is a perspective view of the wrist portion of the robot relating to the present invention,</li><li>Figure 64 is a perspective view of the parallel leaf spring assembly relating to the present invention,</li><li>Figure 65 is a side view of the deformed parallel leaf spring assembly of Fig. 64,</li><li>Figure 66 is another side view of the deformed parallel leaf spring assembly of Fig. 64,</li><li>Figure 67 is a perspective view of a cross-shaped leaf spring relating to the present invention.</li><li>Figure 68 is a sectional view of the cross-shaped leaf spring (diaphragm) of Fig. 67 showing a manner of deformation of the spring,</li><li>Figure 69 is a sectional view of the cross-shaped leaf spring of Fig. 67 showing another manner of deformation of the spring,</li><li>Figure 70 shows the function of the robot relating to the present invention,</li><li>Figure 71 also shows the function of the robot relating to the present invention,</li><li>Figure 72 is a sectional view of a vacuum suction device relating to the present invention,</li><li>Figure 73 is a block diagram showing control of the robot relating to the present invention, and</li><li>Figure 74 is a sectional view of an example of a vacuum detector which can be applied to the present invention.</li></ul>

Figure 1 is a perspective view of an example of a mechanical compliance means comprising a parallel leaf spring assembly relating to the present invention. The compliance means comprises a parallel leaf spring assembly 3 which comprises a first pair of parallel leaf springs 1 which is movable only in the direction X and a second pair of parallel leaf springs 2 which is movable in only the direction Y perpendicular to the direction X. Each pair of parallel leaf springs 1 and 2 comprises two sheets of leaf springs disposed parallel to each other and facing each other. For example, if a force is applied to the parallel leaf spring assembly 3 from the direction Y, the second pair of parallel leaf springs 2 deforms and moves in the direction Y, as is illustrated by the broken lines in Fig. 1.

A robot 4 provided with the above-mentioned parallel leaf spring assembly 3 is illustrated in Fig. 2. The parallel leaf spring assembly 3 is secured to an end of an arm 5 of the robot 4. A hand 6 is attached to the lower end of the parallel leaf spring assembly 3. The arm 5 can be rotated in a forward direction and in a reverse direction, as is shown by the arrows E, and can be extended and retracted, as is shown by the arrows F. The arm 5 can also be shifted vertically, as is shown by the arrows G. A cylindrical rod member 7 is picked up and held by the hand 6 at a predetermined station (not shown) and is conveyed to a position above a hole 9 of a block 8. Then the rod member 7 is inserted into the hole 9 by a downward movement of the arm 5. The inlet edge of the hole 9 is chamfered so as to form an inclined surface 10. If the rod member 7 is misaligned with the hole 9 within the range of the chamfer 10, the rod member 7 abuts against the chamfer 10 when it is lowered, as is illustrated in Fig. 3. At this point, horizontal force components in the direction X and the direction Y are generated in accordance with the vertical insertion force H. Therefore, the parallel leaf spring assembly 3 is deformed and moved in the direction X and the direction Y, as is illustrated in Fig. 4, so that the rod member 7 is inserted into the hole 9, sliding downward along the chamfer 10.

Position control of the arm 5 in response to displacement of the parallel leaf spring assembly 3 is described hereinafter.

Strain gauges 11 are attached to each leaf spring of the parallel leaf spring assembly 3, as is illustrated in Fig. 5. The moment due to deformation of the leaf spring when a force is applied thereto is minimum at the center thereof and maximum at the ends thereof. Therefore, it is desirable to attach the strain gauges 11 to the upper and the lower ends of each leaf spring. In Fig. 5, the strain gauges 11 are attached to the four corners of each leaf spring.

Four strain gauges may be attached to the rear surface of each leaf spring in addition to the four strain gauges attached to the front surface thereof, as is illustrated in Fig. 6. Strain gauges lla to llh are attached to the front surface of each leaf spring, and strain gauges lla' to llh' are attached to the rear surface of each leaf spring and correspond to the strain gauges lla to llh attached to the front surface. The strain gauges are arranged in such a manner that the strain value detected by a strain gauge attached to the front surface of one of the pair of leaf springs is the same as that detected by the strain gauge attached to the rear surface of the other of the pair of leaf springs at a position which corresponds to that of the former strain gauge. For example, the strain value detected by the strain gauge lla is equal to that detected by the strain gauge lle', and the strain value detected by the strain gauge llf is equal to that detected by the strain gauge llb'. The force components which act upon the parallel leaf spring assembly can be detected on the basis of the output of the strain gauges. The force components in the direction X and the direction Y correspond to the displacement of the parallel leaf spring assembly in the direction X and the direction Y, respectively. Therefore, the displacement of the parallel leaf spring assembly in the direction X and the direction Y can be determined by the output of the strain gauges. Examples of a bridge circuit for obtaining an output in response to a change of resistance of the strain gauges are illustrated in Figs. 7 to 9. Figures 7, 8, and 9 are bridge circuits using four, eight, and sixteen strain gauges, respectively. Fig. 7 shows a bridge circuit for obtaining an output in response to a change of resistance of the minimum number of the strain guages. In this case, two pairs of strain gauges (lla/lla' and llb/llb^l) are used. It is desirable that the number of strain gauges be increased since the change of resistance of each strain gauge accumulates and nonuniformity of the output of each strain gauge due to a temperature difference in different places is compensated for, which increases the reliability of detection of the strain value by the strain gauges.

Figure 10 is a perspective view of a robot 4 whose arm 5 can be moved in the direction X, the direction Y, and the direction Z. The robot 4 comprises the parallel leaf spring assembly 3 to which strain gauges are attached. Figure 11 is a circuit diagram showing control of the position of the arm 5 in the direction X and the direction Y using the strain gauges. The arm 5 is moved to a predetermined position by a positioning signal so that the rod member 7 held by the hand 6 is positioned above the hole 9 of the block 8. Then the operation of inserting the rod member 7 into the hole 9 is carried out by the robot 4. If the parallel leaf spring assembly 3 is moved with respect to the arm 5 in the direction X and the direction Y in the insertion operation in which the arm 5 is moved in the direction Z, the displacement of the parallel leaf spring assembly 3 in the direction X and the direction Y is detected by the strain gauges, as was previously mentioned. The strain gauges generate signals a and b in response to the displacement of the parallel leaf spring assembly 3 in the direction X and the direction Y, respectively. The signals a and b are amplified by amplifiers 40 and 41, respectively, for enhancing the gain of the signals and are introduced into a compensation circuit 14 via a switch means 13, the contacts of which are connected as is illustrated by the broken lines. The compensation circuit 14 compensates for the positional error of the arm. Then the signals a and b are introduced into a direction-X controller 16 and a direction-Y controller 17, respectively, via a current amplifier 15. The direction-X controller 16 carries out feedback control of the arm 5 by actuating a direction-X actuator 18 so that the displacement of the parallel leaf spring assembly 3 in the direction X is rendered zero. Also, the direction-Y controller 17 carries out feedback control of the arm 5 by actuating a direction-Y actuator 19 so that the displacement of the parallel leaf spring assembly 3 in the direction Y is rendered zero. The signals a and b may be used for compensation of the position of the arm 5 in the preceding operation of inserting a new rod member into a hole of a new block by compensating the original positioning signal for positioning the arm 5 above the hole 9.

The arm 5 is positional at a predetermined position by the original positioning signal as follows. The positioning signals e and f, in the direction X and the direction Y, respectively, are forwarded from a central processing unit 12 to a comparator 48, where the signals e and f are compared with output signals c and d of detectors (not shown) for detecting the actual position of the arm 5 in the direction X and the direction Y, respectively. The outputs of the comparators 48 are introduced into the direction-X controller 16 and the direction-Y controller 17, respectively, via the switch means 13, the compensation circuit 14, and the current amplifier 15. The actuators 18 and 19 are actuated by the controllers 16 and 17 so that the output of the comparators 48 is rendered zero. Thereby, the arm 5 is positioned at a predetermined position defined by the original positioning signals e and f. During this operation, the contacts of the switch means 13 are interconnected, as is illustrated by the solid lines in Fig. 11, by a control line circuit 42. In this way, the rod member is positioned above the hole. Then the rod member is inserted into the hole by the downward movement of the arm 5 controlled in the afore-mentioned manner using the signals a and b generated by the strain gauges attached to the parallel leaf spring assembly 3. If the rod member is positioned out of the range of the chamfer 10 of the hole 9, the CPU 12 detects this misalignment from the signals c and d and actuates the arm 5, using the positioning signals e and f, so that it is positioned at the predetermined position. By the above mentioned control method the rod member 7 is positioned above the hole 9 within the range of the chamfer 10. Then the rod member 7 is moved downward and contacts with the chamfer 10 of the hole 9, this situation being detected by the information signal from the strain gauges. And then, the arm 5 is precisely controlled so that the rod member 7 accurately aligns with the hole 9 in response to the signals corresponding to the displacement of the parallel leaf spring assembly 3 in the direction X and the direction Y.

Another example of the mechanical compliance means in accordance with the present invention is illustrated in Fig. 12. The mechanical control means comprises a parallel leaf spring assembly 22 which comprises a first pair of parallel leaf springs 1 movable in the direction X, a second pair of parallel leaf springs 2 movable in the direction Y, and a cross-shaped leaf spring (diaphragm) 20 disposed at the bottom thereof. Reference numeral 21 designates a connection bar for connecting a hand to the parallel leaf spring assembly 22. The connection bar 21 can universally incline with respect to the vertical axis (longitudinal axis) of the parallel leaf spring assembly 22 and is shiftable in the direction Z (vertical direction) due to the function of the cross-shaped leaf spring 20. This parallel leaf spring assembly 22 is useful in an insertion operation in which the axis 60 of the robot arm 5 is misaligned with and inclined with respect to the axis of the hole 9, as is illustrated in Fig. 13. When the arm 5 is moved downward, the rod member 7 held by the hand 6 abuts against the chamfer 10 of the hole 9. When the arm 5 is moved further downward, the parallel leaf spring assembly 22 deforms, as is illustrated in Fig. 14, so that the axis 70 of the hand 6 parallelly shifts away from the axis 60 of the arm 5, thereby enabling the rod member 7 to move downward along the chamfer 10. The rod member 7 can be inserted into the hole 9 to a depth corresponding to the clearance between the rod member 7 and the hole 9 and the inclination of the rod member 7, with the axis 70 of the hand 6 being parallel with the axis 60 of the arm 5, as is illustrated in Fig. 15. When the arm 5 is moved yet further downward, the axis 70 of the hand 6 inclines with respect to the axis 60 of the arm 5 due to the function of the cross-shaped leaf spring 20 (Fig. 12), with the result that the rod member 7 can be further inserted into the hole 9, with the axis 70 of the hand 6 gradually approaching a vertical line so as to coincide with the axis 50 of the hole 9, as is illustrated in Fig. 16.

Strain gauges are attached to the cross-shaped leaf spring 20, as is illustrated in Fig. 17. A main purpose of the cross-shaped leaf spring is to achieve smooth insertion of a member into a hole by absorbing and compensating for the relative inclination between the axis of the member and the axis of the hole. Strain gauges are attached to the cross-shaped leaf spring so as to detect deformation of the cross-shaped leaf spring due to a force applied thereto, which deformation corresponds to the relative inclination (angle misalignment) between the rod member and the hole. A signal indicating the relative inclination can be used in feedback control of the robot so as to achieve the insertion operation with the relative inclination being kept at zero. When a bending moment is applied to the cross-shaped leaf spring, maximum deformation occurs at the center thereof. Therefore, it is desirable to attach the strain gauges in the vicinity of the center of the cross-shaped leaf spring. It is also desirable to attach a plurality of strain gauges to both sides of each of four leaf spring pieces A, B, C, and D of the cross-shaped leaf spring 20, as is illustrated in Fig. 17, so that the temperature difference due to a difference of place can be compensated for and so that the S/N ratio can be upgraded. Strain gauges 23a to 23h are attached to the upper surface of the cross-shaped leaf spring, and strain gauges 23a' to 23h' are attached to the lower surface of the cross-shaped leaf spring and correspond to the strain gauges 23a to 23h attached to the upper surface thereof. These strain gauges constitute a bridge circuit, as is illustrated in Fig. 18. An output corresponding to the moment M a of the leaf spring piece A is obtained by using strain gauges 23c, 23c', 23d, and 23d' as resistances R₁, R₂, R₃, and R₄, respectively, in the bridge circuit. Similarly, the moments M_b, M_c, and M_d of the leaf spring pieces B, C, and D, respectively, can be detected by replacing the resistances R, , R₂, R₃, and R₄ with: 23a, 23a', 23b, and 23b' (moment M_b); 23g, 23g', 23h, and 23h' (moment M_c); and 23e, 23e', 23f, and 23f' (moment M_d).

It is possible to simply calculate the force applied to the robot hand in the direction X, the direction Y, and the direction Z and the moment (torques) about the X axis and Y axis on the basis of the output of the strain gauges attached to the cross-shaped leaf spring (diaphragm) and the parallel leaf spring assembly. As is shown in Fig. 19, the moment of each leaf spring piece of the cross-shaped leaf spring is represented by M_a, ^M_b, M_c, and M_d, and the moment of each pair of parallel leaf springs is represented by M_e and M_f.

The moments are defined by the following equations:<maths id="math0001"><img file="EP0104871A2_D0001.tif" /></maths><maths id="math0002"><img file="EP0104871A2_D0002.tif" /></maths><maths id="math0003"><img file="EP0104871A2_D0003.tif" /></maths><maths id="math0004"><img file="EP0104871A2_D0004.tif" /></maths><maths id="math0005"><img file="EP0104871A2_D0005.tif" /></maths><maths id="math0006"><img file="EP0104871A2_D0006.tif" /></maths>in which: F_X, F_Y, and F_Z are force components applied to the robot hand in the direction X, the direction Y, and the direction Z, respectively; M_X and My are moment components applied to the robot hand about the X axis and Y axis, respectively; A is the length between the center of the cross-shaped leaf spring and the connecting end of the robot hand connected to the parallel leaf spring assembly; n is the length between the strain gauge attached to the leaf spring movable in the direction X and the center of the leaf spring; m is the length between the strain gauge attached to the leaf spring movable in the direction Y and the center of the leaf spring; and a is the length between the strain gauge attached to the cross-shaped leaf spring and the center of the cross-shaped leaf spring. The direction of each moment is depicted by the arrows in Fig. 19.

The afore-mentioned equations can be modified as follows:<maths id="math0007"><img file="EP0104871A2_D0007.tif" /></maths><maths id="math0008"><img file="EP0104871A2_D0008.tif" /></maths><maths id="math0009"><img file="EP0104871A2_D0009.tif" /></maths><maths id="math0010"><img file="EP0104871A2_D0010.tif" /></maths><maths id="math0011"><img file="EP0104871A2_D0011.tif" /></maths>

The moment (torque) components and force components applied to the robot hand can be calculated by using such simple equations.

The calculation results M_X and M_Y can be used in feedback control of the insertion operation in such a manner that the rod member is inserted into the hole with the relative inclination between the rod member and the hole being kept at zero. A robot comprising a means for compensating for the relative inclination between the rod member and the hole is illustrated in Fig. 20. The robot comprises a direction-X articulation 30a, which is actuated by a direction-X actuator 30, and a direction-Y articulation 31a, which is actuated by a direction-Y actuator 31. In the insertion operation using this robot, the relative inclination can be compensated for by actuating the direction-X articulation 30a in response to a signal, which corresponds to the moment M_X, from the strain gauges of the cross--shaped leaf spring and by actuating the direction-Y articulation 31a in response to a signal, which corresponds to the moment My , from the strain gauges of the cross-shaped leaf spring. The operation for compensation for the relative inclination in the direction X and for that in the direction Y can be carried out either simultaneously or alternately. A block diagrram of the compensation means is illustrated in Fig. 21. The output signal from the strain gauges attached to each of the leak spring pieces A, B, C, and D of the cross-shaped leaf spring 20 is introduced into a calculation circuit 25 through a high-gain amplifier 24. In the calculation circuit 25, the moments M_X and My are calculated on the basis of the output signals from the strain gauges. The signal output by the calculation circuit 25 and corresponding to the moment M_X is introduced into a direction-X controller 29 through a compensation circuit 26 and an amplifier 27 so as to actuate the direction-X articulation 30a in accordance with the relative inclination between the rod member and the hole until the relative inclination concerning the direction X becomes zero. Similarly, the signal output by the calculation circuit 25 and corresponding to the moment My is introduced into a direction-Y controller 28 so as to actuate the direction-Y articulation 31a in accordance with the relative inclination between the rod member and the hole until the relative inclination concerning the direction Y becomes zero. The rod member shifts in the direction X and the direction Y due to the rotational movement of the articulations 30a and 31a in this compensation operation. However, such displacement of the rod member in the direction X and the direction Y can be compensated for by feedback control in accordance with the output signals from the strain gauges attached to the parallel leaf spring assembly, as was mentioned before.

Another example of the cross-shaped leaf spring is illustrated in Figs. 22 to 24. A pivot 32 is provided at an end of each leaf spring piece of the cross-shaped leaf spring 20. The axis of the pivot is aligned with the longitudinal axis of each leaf spring piece. The cross-shaped leaf spring 20 is attached to the parallel leaf spring assembly 22 in such a manner that each leaf spring piece of the cross-shaped leaf spring 20 is supported by the side wall of the parallel leaf spring assembly 22 via the pivot 32 and the bearing 33 disposed on each pivot 32. With this arrangement, the deformation of one leaf spring piece does not cause other leaf spring pieces perpendicular to it to deform, with the result that the force components in the direction X and the direction Y can be accurately detected without interfering with each other, resulting in an increase of reliability of calculation of the moments M_X and M_x.

Figure 25 is a perspective view of another example of the mechanical compliance means relating to the present invention. A wrist portion 201 comprises a first pair of parallel leaf springs 203a and 203b which is movable in the direction X and a second pair of parallel leaf springs 204a and 204b which is movable in the direction Y perpendicular to the direction X. The upper end of each of the leaf springs 203a, 203b, 204a, and 204b is demountably secured with screws 210 to a common square connection plate 202. The lower end of the first pair of parallel leaf springs 203a and 203b is secured with screws 210 to a first bottom plate 206, and the lower end of the second pair of parallel leaf springs 204a and 204b is secured with screws 210 to a second bottom plate 205. A connection rod 207 is secured to the second bottom plate 205. The connection rod 207 penetrates through a center hole 208 and connects with a robot arm (not shown). Reference numeral 209 designates a screw hole into which a screw means of the arm is screwed so as to interconnect the arm and the rod 207. Each of the leaf springs 203a, 203b, 204a, and 204b is interchangeable with another leaf spring of a different spring constant so that the resiliency of the wrist portion 201 can be changed. If a force F is applied to the connection rod 207, the first pair of parallel leaf springs 203a and 203b is forced to move in the direction X-in accordance with the force component F_x of the force F in the direction X, and the second pair of parallel leaf springs 204a and 204b is forced to move in the direction Y in accordance with the force component Fy of the force F in the direction Y. Thereby, the force F is absorbed by the wrist portion 201. The movable range of the pairs of parallel leaf springs 203a, 203b, 204a, and 204b is limited by the diameter of the hole 208 since the connection rod 207 can move only within the hole 208.

Another example of the mechanical compliance means relating to the present invention is illustrated in Fig. 26. The first bottom plate 206 of the first pair of parallel leaf springs 203a and 203b comprises a recess 206a, as is illustrated in Fig. 27, so as to form a U-shaped bottom plate. Similarly, the second bottom plate 205 of the second pair of parallel leaf springs 204a and 204b comprises a recess 205a. The recesses 205a and 206a face each other so that one of the bottom plates is received within the recess of the other bottom plate. The movable range of the leaf springs is determined by the difference between the width W₁ of the recess and the width W₂ of the bottom plate to be received within the recess. With this structure, the length L_Xof the springy portion of the first pair of parallel leaf springs 203a and 203b can be made equal to the length Ly of the springy portion of the second pair of parallel leaf springs 204a and 204b. Therefore, leaf springs of the same size and the same spring constant can be used as the first and the second pairs of leaf springs 203a, 203b, 204a, and 204b. The construction and function of the example of Fig. 26, except for the above points, are the same as those of the example of Fig. 25.

A further example of the mechanical compliance means relating to the present invention is illustrated in Fig. 28. In this example, the level of the connection portion of the first pair of parallel leaf springs 203a and 203b having the connection plate 202 is lowered with respect to the level of the connection portion of the second pair of parallel leaf springs 204a and 204b, with the result that the length L_X of the springy portion of the first pair of parallel leaf springs 203a and 203b is equal to the length L of the springy portion of the second pair of parallel leaf springs 204a and 204b. The construction and function of the example of Fig. 28, except for the above point, are the same as those of the

example of Fig. 25.

A robot 214 provided with the above-mentioned wrist portion 201 comprising a parallel leaf spring assembly is illustrated in Fig. 29. The wrist portion 201 comprising a parallel leaf spring assembly is disposed between the arm 215 and the hand 216 of the robot 214. The arm 215 can be rotated in a forward direction and in a reverse direction, as is shown by the arrows E, and can be extended and retracted, as is shown by the arrows F. The arm 215 can also be shifted vertically, as is shown by the arrows G. A cylindrical rod member 217 is picked up and held by the hand 216 at a predetermined station (not shown) and is conveyed to a position above a hole 219 of a block 218. Then the rod member 7 is inserted into the hole 219 by the downward movement of the arm 215. The inlet edge of hole 219 is bevelled so as to form an chamfer 220. If the rod member 217 is misaligned with the hole 219 within the range of the inclined surface 220, the rod member 217 abuts against the inclined surface 220 when it is lowered, as is illustrated in Fig. 30. At this point,horizontal force components in the direction X and the direction Y are generated in accordance with the vertical insertion force H. Therefore, the parallel leaf spring assembly is deformed and moved in the direction X and the direction Y, as is illustrated in Fig. 31, so that the rod member 217 is inserted into the hole 219, sliding downward along the chamfer 220. In Fig. 31, only deformation of the first pair of parallel leaf springs 203a and 203b is illustrated.

A further example of the mechanical compliance means is illustrated in Fig. 32. A cross-shaped leaf spring 221 comprising leaf spring pieces 222 and 223 which cross each other is attached to the lower end of the wrist portion 201 comprising the first pair of parallel leaf springs 203a and 203b and the second pair of parallel leaf springs 204a and 204b. The hand (not shown) is connected to the wrist portion 201 via the cross-shaped leaf spring 221. The vertical axis of the wrist portion 201 can be rotatably moved in the direction of a about the X axis due to bending of the leaf spring piece 222 and twisting of the leaf spring piece 223. Also, the vertical axis of the wrist portion 201 can be rotatably moved in the direction of a about the Y axis due to bending of the leaf spring piece 223 and twisting of the leaf spring piece 222. The wrist portion 201 can move vertically in the direction Z due to the springy function of the cross-shaped leaf spring 221. The compliance means comprising the parallel leaf spring assembly and the above-mentioned cross-shaped leaf spring is of five degrees of freedom since the parallel leaf spring assembly can move in the direction X and the direction Y.

The lower part of the above-mentioned wrist portion is illustrated in Figs. 33 and 34. As was mentioned above, each of the bottom plates 205 and 206 of the parallel leaf spring assembly comprises a recess. The movable ranges (S_X and Sy) of the robot hand with respect to the robot arm in the direction X and the direction Y are defined by the gaps 225 and 226, respectively, which correspond to the difference between the width of the recess and the width of the bottom plate received within the recess. The movable range (S z) of the robot hand with respect to the robot arm in the direction Z is defined by a gap 227 between the upper bottom plate 205 and the lower bottom plate 206. Such an arrangement protects the compliance means from being crushed.

The positioning of the robot arm can be controlled by a feedback control process in accordance with the misalignment and relative inclination between the members to be manipulated by the robot. The misalignment and relative inclination can be detected by strain gauges 224 attached to the leaf springs which constitute the wrist portion of five degrees of freedom. It is desirable to attach the strain gauges 224 at the upper and the lower ends of the parallel leaf springs 203a, 203b, 204a, and 204b, as is illustrated in Figs. 35 and 36, since deformation of the leaf springs is maximum at the end portions thereof. Also, it is desirable to attach the strain gauges 224 in the vicinity of the center of the cross-shaped leaf spring 221, as is illustrated in _Fig. 37, since deformation of the leaf springs 222 and 223 is maximum at the center of the cross-shaped leaf spring 221.

As was mentioned above, a cross-shaped leaf spring is used as a springy means for absorbing the displacement in the direction Z in the above explanation. It is possible to use another springy means, such as a Y-shaped leaf spring comprising three leaf spring pieces or an other polygonal-shaped leaf spring comprising radiating leaf spring pieces. However, the equations for calculating the force components and moment components are complicated when these springy means are used instead of a cross-shaped leaf spring. It is desirable to use a cross-shaped leaf spring from the viewpoint of easy calculation of the force components and moment components on the basis of the afore-mentioned simple equations. Such a cross-shaped leaf spring mechanism can also be composed by using a diaphragm.

Also, as was mentioned above, in accordance with the present invention, there is provided a mechanical compliance means which makes it possible to move the robot hand relative to the robot arm in accordance with the misalignment and the relative inclination between the members to be manipulated by the robot. Therefore, the operation of inserting a rod member into a hole of a block member can be smoothly carried out even if the positioning of the members is roughly controlled, with the result that damaging of the members is prevented and no expensive position-control means of a high accuracy is necessary. Also, excessive deformation of the leaf springs is prevented since a limitation means for limiting the movement of the leaf springs in the directions X, Y, and Z is provided so that damaging of the leaf springs due to excessive buckling stress or bending-stress is prevented.

Also, by using a shortened structure of the parallel leaf spring assembly of Fig. 25, 26 or 28, a compact wrist of a robot can be obtained.

An insertion operation of the robot can be performed by using above mentioned compliance means even if the positioning of the robot arm is roughly controlled. However, if the compliance of the compliance means is arranged large so as to perform a smooth insertion operation, the vibration of the compliance means when it is positioned at a predetermined place continues for a long time since the spring force of the compliance means of large compliance is weak. On the other hand, if the compliance of the compliance means is arranged small so as to shorten the attenuation time of the vibration thereof, a smooth insertion operation cannot be performed since the spring force of the compliance means of small compliance is strong. Therefore, it is desirable to vary the compliance of the compliance means so that

the spring is stiffened when the article to be handled is moved while spring is softened when the insertion operation is carried out, so as to achieve a smooth insertion operation in high speed. Such a compliance means of variable compliance will be described hereinafter. Figures 38 and 39 are perspective views of a wrist portion of the robot relating to the present invention seen from the upper side and the lower side thereof, respectively. A parallel leaf spring assembly 302 is secured to a wrist support plate 301 which is connected to an arm (not shown). The parallel leaf spring assembly 302 comprises a first pair of parallel leaf springs 303 movable in the direction X and a second pair of parallel leaf springs 304 movable in the direction Y. A hand (not shown) is connected to the lower end of the parallel leaf spring assembly 302 via a connection rod 309. In the operation of inserting a rod member into a hole, misalignment between the rod member and the hole can be compensated for by the parallel leaf spring assembly due to deformation of the leaf springs 303 and 304, in accordance with force components in the direction X and the direction Y. Strain gauges 305 are attached to the leaf springs 303 and 304 so as to detect deformation thereof. It is desirable that the strain gauges 305 be positioned at the upper or lower end of each leaf spring since deformation of each leaf spring is maximum at the ends thereof. Displacement of the robot hand with respect to the robot arm in the direction X and the direction Y can be detected on the basis of deformation of the leaf springs 303 and 304 detected by the strain gauges 305.

A plain coil plate 306 is connected to the connection rod 309. The plain coil plate 306 comprises a first plain coil (not shown) for actuating the connection rod 309 so as to bias it in the direction X and a second plain coil (not shown) for actuating the connection rod 309 so as to bias it in the direction Y. Each plain coil is disposed between upper and lower magnets 308 which are magnetically connected to each other via yokes 321. The assembly of the plain coil plate 306, the magnets 308, and the yokes 321 forms a direct-current (DC) plain motor. This DC planar motor constitutes a biassing means for adjusting the resiliency of the parallel leaf spring assembly by applying a force thereto in the direction X and the direction Y.

The graph of Fig. 40 represents the output voltage of the strain gauges 305 for detecting the force component of the direction X and that of the direction Y when force is applied to the parallel leaf spring assembly only in the direction X. As can be seen from the graph, the output voltage linearly changes with respect to the displacement, and the output voltage of the direction X and the output voltage of the direction Y do not interfere with each other. Therefore, it is possible to control the movement of the parallel leaf spring assembly 302 by independently controlling the force components in the direction X and the direction Y in accordance with the signals output by the strain gauges for detecting the force components in the direction X and the direction Y, respectively. By controlling the force components in the direction X and the direction Y, respectively, it is possible to shift the lower end of the parallel leaf spring assembly 302 to a desired position with respect to the robot arm due to the combined force of the force components of the direction X and the direction Y

so that the compliance of the parallel leaf spring assembly 302 can be changed. For exaple, when the parallel leaf spring assembly is shifted in the direction X, the compliance of the parallel leaf spring assembly can be increased by applying force thereto in the same direction as that of displacement of the parallel leaf spring assembly by actuation the plain coil of the direction X of the DC plain motor. On the other hand, the compliance of the parallel leaf spring assembly can be decreased by applying force thereto in a direction reverse to that of displacement of the parallel leaf spring assembly.

The voltage and the equation of motion of the above-mentioned DC plain motor are represented as follows.<maths id="math0012"><img file="EP0104871A2_D0012.tif" /></maths><maths id="math0013"><img file="EP0104871A2_D0013.tif" /></maths>in which <ul id="ul0002" list-style="none"><li>v: voltage between the terminals of the motor</li><li>R: resistance between the terminals of the motor</li><li>i: current of the motor</li><li>L: inductance of the motor</li><li>B: magnetic flux density of the motor</li><li>ℓ: effective length of the coil of the motor</li><li>M: mass of the movable member</li><li>S: coefficient of the viscous damping</li><li>k: spring constant of the parallel leaf spring assembly</li><li>X: displacement of the parallel leaf spring assembly</li><li>t: time</li></ul>

The above equations are represented by the block diagram of Fig. 41. Figure 42 is a position feedback control block diagram of a modification of Fig. 41, in which the displacement X is fed back into the input of the circuit through the gain A₁ and the current i is fed back into the circuit C. The transmission function of the circuit D of Fig. 42, hereinafter referred to as A₂, is as follows.<maths id="math0014"><img file="EP0104871A2_D0014.tif" /></maths>

If the circuit Am comprises the circuit of Fig. 43, it is possible that Am <img file="EP0104871A2_D0015.tif" /> ∞. Therefore,<maths id="math0015"><img file="EP0104871A2_D0016.tif" /></maths><maths id="math0016"><img file="EP0104871A2_D0017.tif" /></maths>

A₂ is represented by such a simple equation. The current rise characteristic due to the inductance L can be ignored. Therefore, the closed-loop transfer function G(S) is represented as follows.<maths id="math0017"><img file="EP0104871A2_D0018.tif" /></maths>

The condition is which the equation of (6) is stable is as follows.<maths id="math0018"><img file="EP0104871A2_D0019.tif" /></maths>

The equation of (7) represents stiffness. If A₂= 1(V/A), then the following equation is obtained from the equation (7).<maths id="math0019"><img file="EP0104871A2_D0020.tif" /></maths>

This equation (8) means that the compliance Cm of the parallel leaf spring assembly can be changed in a stable manner within the range<maths id="math0020"><img file="EP0104871A2_D0021.tif" /></maths>by changing A₁ from - <maths id="math0021"><img file="EP0104871A2_D0022.tif" /></maths> to _m. If - <maths id="math0022"><img file="EP0104871A2_D0023.tif" /></maths> &lt; A₁≦ ^0, then <maths id="math0023"><img file="EP0104871A2_D0024.tif" /></maths> ≦ Cm &lt; ∞ If 0 &lt; A₁ &lt; ∞ then 0 &lt; Cm &lt; <maths id="math0024"><img file="EP0104871A2_D0025.tif" /></maths>. Therefore, if A₁ is negative, the parallel leaf spring assembly is softened, and if A₁ is positive, the parallel leaf spring assembly is stiffened. Any desired compliance of the parallel leaf spring assembly can be obtained by changing A_land A₂ in the above-mentioned manner. The diagram D of Fig. 42 can be realized by a circuit shown in Fig. 43. In Fig. 43, F designates an equivalent circuit of the motor, R1 designates the resistance, and Am and Af designate the gain.

As is illustrated in Fig. 44, the CPU controls the signal of the position feedback gain A₁ in accordance with the operations, such as a conveying operation or assembling operation, of the robot so as to obtain an optimum compliance of the parallel leaf spring assembly by selecting a positive signal or a negative signal.

An example of the control circuit of the signal of the position feedback gain A1 is illustrated in Fig. 45. G designates a DC plain motor. Reference numeral 313 designates a transfer-type analogue switch which comprises two contacts which alternately turn on. The analogue switch 313 is controlled by the CPU so as to make the signal of the position feedback gain A₁ (+) or (-) by applying the signal from the strain gauges 305 to the terminal of (+) or (-) of the amplifier 322 by changing the contacts of the analogue switch 313.

Another example of the variable compliance circuit is illustrated in Fig. 46. In this example, integration of the signal from the strain gauges in accordance with the displacement of the parallel leaf spring assembly is used as a positive feedback term, and differentiation of the signal from the strain gauges is used as a negative feedback term. Also, a DC term is used as a positive feedback term so as to obviate the gain A₁ of a low frequency region of a differential term, which region represents slow movement of the robot. Figure 47 is a Bode diagram of a differential term, and Fig. 48 is a Bode diagram of an integral term. With respect to a differential term, in a region of frequency of more than 1/T₂Hz, the parallel leaf spring assembly is stiffened since the compliance thereof is lowered in accordance with an increase of the amount of negative feedback due to an increase of gain. With respect to an integral term, in a region of frequency between 1/T₃ and 1/T₂, the compliance is lowered to about 1/k of the compliance of the spring since the gain is decreased. The gain characteristic of a combination of the gain characteristics of Fig. 47 and Fig. 48 can be obtained by the circuit of Fig. 46. Such a combination of gain characteristics corresponds to the compliance characteristic with respect to the frequency, which is represented in Fig. 49. <ul id="ul0003" list-style="none"><li>(i) When the frequency f_Z is f_Z≦ 1/T₃, the compliance Cm is represented as Cm ≈ ∞ in the condition that A₂≈ k/Bℓ.</li><li>(ii) When l/T3 &lt; f_Z ≦ 1/T₂, the compliance Cm is represented as 1/k &lt; Cm &lt; ∞.</li><li>(iii) When 1/T₂^&lt; f_Z ≦ 1/T₁, the compliance Cm is represented as 0 &lt; Cm &lt; 1/k.</li></ul>

Therefore, it is possible to vary the compliance of the parallel leaf spring assembly so that the parallel leaf spring assembly is stiffened when the robot moves rapidly and is softened when the robot moves slowly.

Another example of the compliance means which constitutes a wrist portion of the robot in accordance with the present invention is illustrated in Fig. 50. This compliance means comprises a parallel leaf spring. assembly 302 and a cross-shaped leaf spring 314. The connection rod 309 can be inclined with respect to the vertical axis of the parallel leaf spring assembly due to the cross-shaped leaf spring 314. Therefore, the insertion operation can be achieved even if the axis of the connection rod 309 is inclined with respect to the axis of the hole into which a rod member is to be inserted. A DC plain motor for varying the compliance with respect to the inclination of the connection rod 309 is provided, in addition to the DC plain motor, for varying the compliance with respect to the displacement in the direction X and the direction Y of the parallel leaf spring assembly 302. Such an additional DC plain motor is illustrated in Figs. 51 and 52. This DC plain motor for varying the compliance with respect to the inclination of the connection rod 309 comprises a support plate 316 on which a plain coil 317 for biasing the support plate in the direction X and plain coil (not shown) for biasing the support plate in the direction Y are disposed, the plate 316 being secured to a flange 315 at the middle portion of the connection rod 309 and to magnets 308 disposed above and beneath the support plate 316. The connection rod 309 can be inclined in any direction by actuating the DC plain motor in the direction X and the direction Y. Therefore, it is possible to vary the compliance with respect to the inclination of the connection rod 309. Strain gauges 305 for detecting deformation of the cross-shaped leaf spring are attached thereto in the vicinity of the center thereof where maximum deformation can be detected. The DC plain motor is controlled in a manner similar to that of the former example.

As was mentioned above, in accordance with the present invention, the wrist portion of the robot comprises a variable compliance means so that an optimum compliance can be obtained in accordance with the movement of the robot. Therefore, the robot can smoothly and similarly manipulate both light members and heavy members without using a position control means of a high accuracy. The compliance can be decreased so that the spring can be stiffened in a rapid movement of the robot, such as in the conveying operation, which can be detected by strain gauges as a displacement of a high frequency of the wrist portion of the robot. On the other hand, . the compliance can be increased so that the spring can be softened in a slow movement of the robot, such as in the assembling operation, which can be detected by strain gauges as a displacement of a low frequency of the wrist portion of the robot. Therefore, various operations, such as an insertion operation, can be achieved smoothly at a high speed.

The application of variable compliance means of the present invention is not limited to the wrist of a robot. The variable compliance means can be applied to the afore-mentioned paper feed apparatus so that the springy force of the springy means which hold the paper is changed in response to the movement or situation thereof. The paper feed apparatus provided with the variable compliance means can deal with various type of papers by changing the springy force by changing the sign of the positional feed back gain A₁.

Also, the variable compliance means can be applied to the robot for manufacturing magnetic heads or record player arm. In this case, the springy force is strengthened when the parts are conveyed so as to convey the parts in high speed, while the springy force is weakened when the parts are assembled so as to avoid damage of the parts.

Another example of a variable compliance means which comprises another type of parallel leaf spring assembly is illustrated in Fig. 53 to Fig. 59. The parallel leaf spring assembly 350 of this example is similar in shape to that of Fig. 26. Two pairs of leaf springs 351 and 352 are secured with screws 354 to a connection member 353 at the upper end of each leaf spring. This type of parallel leaf spring assembly is short in height as compared with the afore-mentioned examples. Therefore, it is possible to make the robot wrist small in size and to uniformly control the movement of each spring.

A DC plain coil which constitutes a biasing means for varying the compliance of the parallel leaf spring assembly is illustrated in Fig. 55. Recesses 356 are formed in a disc 355 of nonmagnetic material. A plain coil 357 is disposed in each of the recesses 356, though only one coil 357 is illustrated in the drawing. The disc 355 is attached to the lower surface of the parallel leaf spring assembly 350 via attaching holes 358 and 359. The upper surface of the parallel leaf spring assembly 350 is attached to a holder 360 (Figs. 56 and 57) via holes 362. The holder 360 is secured to the robot arm (not shown) via holes 361 formed on an upper flange 363 thereof. A yoke 367 and magnets 365 are disposed above the plain coils 357, and another yoke 367 is disposed below the plain coils 357, as is illustrated in the left half of Fig. 58, so that a magnetic circuit, indicated by the looped arrow, is formed. The yokes 367, the. magnets 365, and the plain coils 357 on the disc 355 constitute a DC plain motor.

Another DC plain motor is illustrated in the right half of Fig. 58. In this example, magnets 366 and yokes 368 are symmetrically disposed on both sides of the plain coils so that a magnetic circuit, indicated by the looped arrow, is formed. Numeral 370 designates a robot hand such as a vacuum suction device which sucks e.g. magnetic disc to be manipulated.

A plan view of the disc 355 is illustrated in Fig. 59.

Figure 62 is a perspective view of a robot, in accordance with the present invention, used for assembling a magnetic disc device. A wrist 409 which comprises a mechanical compliance means is disposed at the end of an arm 405 of the robot 408. A vacuum suction device 410 is attached to the wrist 409. The vacuum suction device 410 communicates with a vacuum pump 412 through a regulator 411. Reference numeral 413 designates a control means for actuating the robot. The vacuum suction device 410 of the robot 408 sucks a magnetic disc 401 from a disc station 414, where a number of magnetic discs are stacked. The magnetic disc 401 is conveyed, as is shown by the arrow A, toward a position above a spindle 415 of a base plate 416 of the magnetic disc device. Then the magnetic disc 401 is lowered and is fitted onto the spindle 415, as is shown by the arrow B. After a predetermined number of magnetic discs 401 are disposed on the spindle 415, the base plate 416 is sealingly enclosed within a case having a magnetic head (not shown) and an access means (not shown) so as to constitute a magnetic disc device (Disc Enclosure).

The wrist 409 of the robot 408 is illustrated in detail in Fig. 63. The wrist 409 comprises two pairs of parallel leaf springs 417a and 417b which can move in a horizontal plain in the direction X and the direction Y, which directions are perpendicular to each other, and a cross-shaped leaf spring 418 which is disposed at the upper end of the wrist 409 and which makes it possible to incline and vertically move (in the direction Z) the robot hand (vacuum suction device 410) with respect to the robot arm 405. The wrist 409 is connected to the arm 405 via the connection rod 419 and to the vacuum suction device 410 via the connection rod 424. The wrist 409 constitutes a mechanical compliance means of five degrees of freedom, i.e., two degrees of freedom in the direction X and the direction Y due to the parallel leaf springs 417a and 417b and three degrees of freedom in the direction Z and angular directions a and 8 due to the cross-shaped leaf spring 418. If a horizontal . force F₁ is applied to the wrist 409, as is illustrated in Fig. 64, the force component F11 in the direction Y is compensated for by deformation of the pair of parallel leaf springs 417b, as is illustrated in Fig. 65, and the force component F₁₂ in the direction X is compensated for by.deformation of the pair of parallel leaf springs 417a, as is illustrated in Fig. 66. Thereby, misalignment in the direction X and the direction Y in the insertion operation is compensated for.

If the axis of the wrist 409 is inclined with respect to the insertion direction so that a force F₂is applied to the connection rod 419 (Fig. 67), the force F₂ is compensated for by the cross-shaped leaf spring 418 due to the bent deformation thereof, as is illustrated in Fig. 68, so that the connection rod 419 is inclined at an angle 0 with respect to the axis of the wrist 409 in accordance with the force F₂. Twist deformation of the leaf spring also occurs above the longitudinal axis thereof. Thereby, angular misalignment between the axis of the wrist and the axis of the hole in the insertion operation is compensated for.

If a vertical force F₃ is applied to the wrist 409, the force F₃ is compensated for by the cross-shaped leaf spring 418 due to the deformation thereof in the direction Z, as is illustrated in Fig. 69, so as to compensate for the error AZ in the vertical direction.

When the robot comprising the above-mentioned wrist structure is used for assembling a magnetic disc device by inserting the spindle 415 into the center hole of the magnetic disc 401, if an insertion force F is applied to the wrist 409 in the condition of misalignment of S between the center of the magnetic disc 401 and the center of the spindle 415 and angular misalignment of a between the axis of the wrist 409 and the axis of the spindle, i.e., inclination of the magnetic disc 401, as is illustrated in Fig. 70, the insertion operation can be smoothly carried out due to the compliance function of the wrist 409. As long as the inner periphery of the magnetic disc 401 is positioned above the chamfer 415a of the top of the spindle 415, the insertion force F is compensated for by the wrist 409 due to the deformation thereof, as was previously mentioned, so that the magnetic disc 401 slides down along the chamfer 415a and fits onto the spindle 415.

If, after the magnetic disc 401 is positioned at a predetermined place 415b, as is illustrated in Fig. 71, a further vertical force F is applied to the wrist 409, due to a teaching error of the robot, so as to move the arm downward by a length S₂, this erroneous positioning force F can be compensated for by the movement of the cross-shaped leaf spring in the direction Z by the length ^S₂.

The vacuum suction device 410 is illustrated in detail in Fig. 72. The magnetic disc 401 comprises a flat ring plate substrate 402 on which a magnetic layer 403 is coated. The diameter of and the thickness of the cylindrical vacuum suction device 410 correspond to the size of the uncoated inner periphery 404 of the magnetic disc 401. A groove 422 is formed along the annular lower edge of the cylindrical body 421 of the vacuum suction device 410. The groove 422 serves as a sucking mouth of the vacuum suction device 410. The uncoated inner periphery 404 of the magnetic disc 401 is sucked through the groove 422 of the vacuum suction device 410. Thereby, the magnetic disc 401 is picked up by the vacuum suction device 410.

A vacuum-sensing means may be used in order to determine whether the magnetic disc 401 is securely held by the vacuum suction device 410. Such a vacuum-sensing means comprises a vacuum sensor 426 (Fig. 73), which communicates with the groove 422 (Fig. 72) of the vacuum suction device 410 through an elbow 423, and a T-shaped pipe 425 to which the vacuum pump 412 is connected. The vacuum pressure within the groove 422 is detected by the vacuum sensor 426.

The vacuum sensor 426 may be a diaphragm-type pressure sensor, as is shown in Fig. 74. This pressure sensor comprises a diaphragm 433 of silicon disposed on a base plate 432. Resistance film is diffused on the diaphragm 433. The base plate 432 is covered by a cap (not shown) so as to form a vacuum chamber. A vacuum is introduced into the vacuum chamber through the elbow 423 and the T-shaped pipe 425. Atmospheric pressure is introduced into a space under the diaphragm 433 through a passage 434. The diaphragm 433 is deformed due to a pressure difference between the vacuum pressure which acts upon the upper surface thereof and the atmospheric pressure which acts upon the lower surface thereof. Such a deformation of the diaphragm 433 causes a change of resistance thereof. Therefore, the vacuum pressure can be detected by measuring the resistance of the diaphragm 433 between the terminals 435a and 435b. The sucking force is in proportion to the vacuum pressure. Therefore, it is possible to determine whether the magnetic disc 401 is securely held by the vacuum suction device 410 by detecting the vacuum pressure within the groove 422 of the vacuum suction device 410.

The output of the vacuum sensor 426 is amplified by a strain amplifier 427 and is introduced into the CPU 429 via an A/D converter 428, as is illustrated in Fig. 73. The CPU 429 controls the robot 408 and the vacuum pump 412 via a robot controller 413 and a vacuum pump controller 430, respectively, in accordance with the output of the vacuum sensor 426. The output of the vacuum sensor 426 is connected to an alarm means 431 via the CPU 429. With this construction, it is possible to control the robot so that it reliably holds the magnetic disc by controlling the movement of the robot arm and the vacuum pump.

As was mentioned above, in accordance with the present invention, there is provided a mechanical compliance means which makes it possible to move the robot hand relative to the robot arm in accordance with the misalignment and the relative inclination between the members to be manipulated by the robot. Therefore, the operation of inserting a rod member into a hole of a block member can be smoothly carried out even if the position of the members is roughly controlled, with the result that damaging of the members is prevented and no expensive position control means of a high accuracy is necessary.

Also, in the operation of assembling the magnetic disc device, it is possible to reliably hold the magnetic disc by using a vacuum suction device as the hand of the robot without touching the magnetic layer of the magnetic disc. Therefore, the operation of assembling the magnetic disc device can be reliably controlled at a high speed.