AN ANGULAR POSITION MEASURING EQUIPMENT IN ROBOTICS, WHERE IT DETERMINES THE ANGLE OF THE JOINTS

Abstract: The invention concerns a robot arm for industrial robots, comprising one or several jointd arms (1, 1c) that are mutually connected to each other by means of rotary joints (1a, 1b), and a jointed arm (1) connected to a base ((3), in which an angle transducer is arranged in the rotary joints (1a, 1b) in order to measure exactly the angular relationship between the jointed arms (1, 1c) or between the jointed arm (1) and the base (3), in order to make possible adjustment of the robot arm into the desired angular position.

Description: An angular position measuring equipment in robotics, where it determines the angle ofthe joints The present invention relates to a robot arm for industrial robots, and to be more specific, it relates to a precise regulation of an angular relationship in one or several joints in the robot arm. There are currently no suitable arrangements for adjustment of robot arms in order to be able, through exact measurement of the angular relationship in one or several of the joints of the robot arm, to make an exact adjustment of the outer end of the robot arm, that is, its working point. It has instead been necessary to depend on being able to control the gear or other driving system that achieves turning of the joint,' based on a defined initial condition, such that the working point adopts the desired position. There is no possibility of verifying the setting at a particular joint. The aim of the present invention, therefore, is to achieve a robot arm in which it is possible to measure exactly the angular relationship in one or several joints of the robot arm in order to be able to make an exact adjustment of its working point, and to be able to verify the angular relationship in a particular joint. The above aim is achieved with a robot arm for industrial robots, comprising one or several jointed arms that are mutually connected to each other by means of rotary joints, and a jointed arm connected to a base, where an angle transducer is arranged in the rotary joint in order to measure exactly the angular relationship between the jointed arms or between the jointed arm and the base, in order to make possible adjustment of the robot arm into the desired angular position. According to claim 2, the angle transducer comprises a first disk, the rotor, with circularly arranged and radially directed receiver electrodes and a second disk, the stator, equipped with circularly arranged and radially directed transmitter electrodes arranged at the same radius as the receiver electrodes and with a fixed separation between the receiver electrodes and the transmitter electrodes on the two disks, whereby the disks are arranged coaxially and rotatable relative to each other, and the disks are further separated by a thin air-gap that makes possible a capacitive or an inductive coupling between the electrode systems on the receiver disk and the transmitter disk, whereby the transmitter electrodes are each supplied with an alternating voltage with different phases for neighbouring electrodes, whereby the number of supply phases, Φ, is greater than two, and the separation of transmitter electrodes = the separation of receiver electrodes/Φ, and where the transmitter electrodes of the stator are geometrically arranged such that errors in their geometry relative to the geometry of the receiver electrodes produces equal but opposite error signals in the receiver electrodes of the rotor. An angle transducer of the type described above is the sub- ject of a separate patent application that is being submitted simultaneously with the present one, and a description of current angle transducers and the problems that are associated with them is presented in the separate application, as is a more detailed description of the theory behind these angle transducers . The invention will now be described with the aid of a non- limiting embodiment, illustrated in the attached drawings, in which Fig. 1 shows a ' sketch of the principle of a robot arm with different setting positions, Fig. 2 shows an example of a complete rotor disk for an angle transducer in a robot arm according to the invention, Fig. 3 shows a magnified section of Fig. 2, Fig. 4 shows an example of a complete stator disk according to the invention, without means of measuring play, Fig. 5 shows a magnified section of Fig. 4, Fig. 6 shows the interaction between the stator and the rotor electrodes, Fig. 7 shows an example of a possible appearance of signals in the two differential receiver electrode fields 5 and 5', Fig. 8 shows a detail when the robot arm of Fig. 1 is subject to tilt, Fig. 9 shows radial displacement of the robot arm according to Fig. 1, Fig. 10 shows additional electrodes in order to check radial deviation (wobble) from the centre of rotation in the joints of the robot arm, Fig. 10a shows a side view of the electrodes according to Fig. 10, Fig. 11 shows additional electrodes in order to check angular deviation (axial movement, wobble) relative to the centre of rotation in the joints of the robot arm, Fig. 12 shows an im- proved arrangement of the electrodes in Fig. 10 and Fig. 11. Thus Fig. 1 shows a robot arm for, for example, an industrial robot. Angle transducers are built into the rotary joints la and lb of the robot arm 1. This gives the advantage that the angles are read directly and no distortion of the value occurs through, for example, periodic errors in gear-boxes. The outer end 2 of the robot arm can be equipped with, for example, a robot grip claw. In this description, we have chosen to denote the end 2 as "the working point" of the system. The robot arm 1 is attached to the support by means of a stationary base 3. The working point 2 can adopt freely chosen positions 2, 2a, 2b, 2c, etc., through different angles of the rotary joints. In the case shown in Fig. 1, these positions lie solely in the plane of the paper. The working point 2 can adopt a freely chosen position in a three-dimensional system by adding further rotary joints. A complete rotor disk 4 for use in an angular transducer for a robot arm according to the invention is shown in Fig. 2. One of the properties of capacitive measurement systems designed according to the Swedish patent 7714010-1 is that of directly and with high precision being able to determine the magnitude of a relative angular rotation that is less than the separation of the receiver electrodes, which in the example below is 1/81 parts of a revolution. On the other hand, no information is obtained about which of the receiver electrode separations (in the example this is which of the 81 possible separations) is the current one. The transducer is, therefore, equipped with a second angular measurement system with a receiver electrode separation of 360°, i.e. one complete revolution. This second system, known as the "coarse measurement system" only serves to determine which of the 81 receiver electrode separations in the example is the current one . Fig. 2 shows the rotor disk 4, the receiver electrodes 5 and 5' and the inner receiver electrodes 5c and 5c' intended to receive signals from the coarse measurement system (Figs. 4 and 5) . The outer receiver electrodes 5 and 5' thus form, together with the corresponding electrodes 6 on the stator disk 7, the high-resolution angular measurement system, while the inner receiver electrodes 5c and 5c' form, together with the corresponding electrodes 6' on the stator disk 7, the coarse measurement system, which determines the angular position within the revolution of 360°. Fig. 3 shows a section of the rotor disk at a higher scale. The disk is coated with a conducting coating that is preferably constituted by a thin rolled copper foil. The black lines show insulating lines that can be achieved by means of, for example, photolithographic etching. The lines 8,9 in Fig. 3, which form the polar lines of limitation for the receiver electrodes, are directed towards a centre that is common for all circular and polar elements that are present on the disk. The width of the electrodes is, therefore, preferably chosen such that the width of the electrodes is equal in size to the spacing between the electrodes. As Fig. 2 makes clear, and as can be seen in more detail in Fig. 3, a preferably thin strip 21 of conducting material is left behind above the upper limit of the electrodes 5. In this way, all electrodes 5 on the rotor disk will be in electrical contact in the form of parallel connection, which means that the very weak signal strength that is received in an individual rotor electrode is multiplied by a factor that principally depends of the number of rotor electrodes on the disk 4. In one possible embodiment, the angular separation between the rotor electrodes can be chosen such that 81 electrodes are present around one complete revolution, 360°. In order to increase further the strength of the signal received, and, in particular, with the aim of reducing the sensitivity of the transducer for external sources of disturbance that produce alternating electrical fields that can be collected by the electrodes 5 of the rotor disk, the rotor disk is equipped with a second system of rotor electrodes 5' , Figs. 2 and 3. The second set of electrodes 5' is created by the same line of electrical insulation as forms the first set of electrodes 5, and since the width of the electrodes has been preferably chosen such that the width of the electrodes is equal to the size of the spacing between electrodes, the shape, area and width of the second set of electrodes 5' will be identical to those of the first set of electrodes 5. This second set of electrodes 5' is also in electrical connection in the same way as the first set of electrodes 5 through a thin strip of conducting material 11 being left behind below the electrodes. In one preferred embodiment, the signals produced in the electrode fields 5 and 5' are transferred via through-plated holes 12 and 13, Fig. 3, to arrangements present on the reverse side of the disk in order to be connected to electronic circuits for signal processing, such as a differential ampli- fier. Four supply signals R, S,T,U are used in the preferred system that is described here. These are displaced in phase relative to each other according to the Swedish patent 7714010-1 as shown in the following pattern: The table shows that the supply signals R and T are displaced in phase relative to each other by 180°. In the same way, the supply signals S and U are displaced in phase relative to each other by 180°. Fig. 6 is intended to explain the formation of differential signals in the sets of electrodes 5 and 5' on the rotor disk. Both the rotor disk and the stator disk are shown as "X-ray" images in Fig. 6, in the position in which they are located in an assembled angle transducer. The rotor disk 4 with the arrays 5 and 5' of receiving arrays of rotor electrodes is thus shown with thin lines, while the stator disk 7, which is equipped with the "transmitting" heart-shaped stator electrodes R,S,T,U, is shown with thicker lines. The differential signal geometry can be most simply seen from the electrodes in Fig. 6 that are supplied with alternating voltage with the phases S and U. Fig. 6 shows that at a certain position, all stator (transmitter) electrodes with phase S are located directly above the rotor electrodes 5 that are directed inwards towards the centre. At the same time, all stator electrodes with phase U are located directly above the rotor electrodes 5' that are directed outwards. As has been described above, the two sets of rotor electrodes are displaced geometrically by 1/2 of a rotor electrode separation relative to each other. Since the transmitter electrodes S and U are supplied with voltages that are equal in magnitude and displaced in phase by 180° relative to each other, the signals received in the rotor electrodes 5 and 5' will be equal in magnitude but of opposite sign. This is illustrated in principle in Fig. 7. The two diagrams show how the amplitude U of the signal received by the receiver elec- trodes 5 and 5' of the rotor varies with a relative change of angle α between the rotor and the stator. The upper diagram shows in principle the amplitude of the signal that is produced in the rotor electrodes 5, while the lower diagram shows the equivalent for the signal that is produced in the rotor electrodes 5' . As the diagram makes clear, the signals that are received from the set 5' of electrodes constitute a mirror image of the signal in the set 5 of electrodes. This means that it is highly appropriate to apply the two signals each to one input of a differential amplifier as has been mentioned above. In this way, the effect is achieved that the two signals are added, and the resulting output signal from the amplifier has an amplitude that is twice as large. Furthermore, the influence of dis- turbing signals produced in the receiver electrodes 5 and 5' due to external electrical alternating fields is in this way reduced using the property of the differential amplifier that depresses signals on its inputs that have the same phase (Common Mode Rejection) . When using robot arm systems containing one or several linked arms, 1, lc in Fig. 1, heavy demands are placed when using traditional types of angle transducer on the bearings of the arms if the precision of the system at its working point 2 is to be maintained. Poor precision in the bearings can lead to stochastic tilts of the type shown in Fig. 8, or to radial displacements according to Fig. 9. This leads to the working point 2 of the jointed arm system 1 being subject to a cosine error depending on the tilt illustrated in Fig. 8 and/or the radial and axial displacement illustrated in Fig. 9. When using the invention described here, however, the effects of tilts of the rotor 4 relative to the stator 7, Fig. 4, or of purely radial displacements of the rotor relative to the stator, Fig. 9, are compensated and eliminated, with respect to the angle of rotation that is read off directly through the special design of the pattern of electrodes 5 and 6 in Fig. 9. It is also a characteristic of the first part of the invention that cosine errors or radial displacements of the electrode systems can be neglected. However, when applied in a real system according to the example in Fig. 1, the influence on the working point 2 of the system must also be con- sidered. For complete control of the motion of the system at its working point 2, the system must also collect information concerning stochastic angular errors of the type shown in Fig. 8 and stochastic radial displacements according to Fig. 9, together with stochastic axial displacements according to Figs. 8 and 9. These phenomena are usually denoted by one common term: "play". According to the invention, the electrode systems can be supplemented by one further system, Figs. 10 and 10a. A cir- cular transmitter electrode 14 is located on the stator disk 7. Receiver electrodes 15 and 16 are located on the rotor disk 4, and collect a signal from the transmitter electrode 14 by capacitive transmission. The amplitude of the signal received at 15 and 16 depends on the relative positions between 15/16 and the transmitter electrode 14. The amplitudes in the electrodes 15 and 16 will be equally large in the symmetrical case. In the event of displacement from the sym- metrical position, the amplitude will increase in one of the electrodes 15, 16 and decrease in the other. By placing at least three pairs of electrodes 15,16 equally spaced around the perimeter of the angle transducer, the radial displacement of the jointed arm 1 can be calculated with the aid of suitable mathematical processing of the amplitude values from the electrodes 15 and 16. In order to determine an erroneous angle setting according to Fig. 8, the electrode systems are supplemented by a further system, Fig. 11. A circular transmitter electrode 17 is located on the stator disk 7. At least three receiver electrodes 18 are located on the rotor disk 4 evenly distributed around the perimeter of the angle transducer. The radial extent of the electrodes 18 is less than the radial extent of the electrode 17 with the intention that the capacitive coupling of the electrode 18 with the electrode 17 is to remain uninfluenced at all possible radial displacements. The receiver electrodes 18 each collect a signal from the transmitter electrode 17 by capacitive transmission. The amplitude of the signal received at the electrodes 18 depends on the relative distance between 18 and the transmitter electrode 17. The amplitudes in all electrodes 18 will be equally large in the symmetrical case. In the event of tilt of the jointed arm 1 according to Fig. 8, the signal amplitude at each electrode 18 will depend on the magnitude and direction of the error. The angular error and the axial displacement of the jointed arm 1 can be calculated with the aid of appropriate mathematical processing of the amplitude values from the electrodes 18. Fig. 12 shows one preferred embodiment. The transmitter electrodes 14 and 17 are located at the same radius in the preferred embodiment, and are constituted by one and the same electrode 19. The receiver electrodes 15, 16 and 18, are preferably located such that every second position around the perimeter of the angle transducer is occupied by an electrode group 15, 16 and every second position by an electrode 18. This arrangement minimises the use of space in the radial direction. In the case in which the radial space is of minor significance, it is an alternative to make the transmitter electrode 19 sufficiently broad that the electrodes 15, 16 and 18 can be distributed independently of each other around the perimeter of the angle transducer. The transmitter electrodes for a capacitive system of the principle described here, 4-phase, must satisfy the condition that the separation between these electrodes must be equal to (the separation of the rotor (receiver) electrodes) /Φ, i.e. in this case it must be equal to (the separation of the rotor (receiver) electrodes) /4. This means in the example that the separation of the transmitter electrodes must be 1/81 * 1/4, i.e. 1/324 parts of a revolution. Thus, by permutation of the phase supply electrodes of the stator as is described in the second patent application submitted simultaneously, PCT/SE01/01773, the primary functional separation of 1/4 of a rotor electrode separation between subsequent phase supply electrodes R, S,T,U is maintained. This is illustrated in Fig. 6 in which, in the position s shown, transmitter electrode R is located halfway over a receiver electrode 5' and halfway over a receiver electrode 5. Transmitter electrode S is located directly over a receiver electrode 5 and is in this way displaced in function by 1/4 of the separation of the receiver electrodes relative 0 to electrode R. The next electrode, T, is located halfway over a receiver electrode 5 and halfway over a receiver electrode 5' , and is thus displaced by 1/2 of the separation of the receiver electrodes relative to the electrode R and by 1/4 of the separation of the receiver electrodes relative to 5 the electrode S. It can be demonstrated in this way that all electrodes are still functionally distributed with a separation that is 1/4 of the separation of the receiver electrodes relative to one of the receiver electrodes. 0 Although the angle transducer for the robot arm eliminates errors in specification of angles that arise from shortcomings in the bearings of the machine element onto which the transducer is mounted, positioning accuracy is still influenced mechanically and geometrically in the overall system by 5 play and wobble in its bearings. Even if the angular position has been correctly read by the angular measurement system, the position of the working point 2, Fig. 1, is influenced by play or displacements of the type shown in Figs. 8 and 9. 0 Such errors can also be measured and compensated for in real-time by adding a further electrode system. Such electrode systems are shown in Figs. 10, 11 and 12, where Figs. 10 and 11 individually demonstrate how radial wobble and axial displacement are measured, respectively. Fig. 12 shows how these two systems can be combined into one common system. The fact that the output signals from each individual plate 15, 16 in Figs. 10 and 12 are connected to an electronic unit should be added to the original description of this function. The electronic unit can instantaneously determine the magnitude and direction of any radial wobble present by measuring the amplitudes present at the six plates 15, 16. Each individual plate 18 in Figs, 11 and 12 is, in the same way, connected to an electronic unit that can instantaneously determine the magnitude of the axial displacement and also its angle, if any, according to Fig. 8.

Claims: Claims 1. A robot arm for industrial robots, comprising one or several jointed arms (1, lc) that are mutually connected to each other by means of rotary joints (la, lb) , and a jointed arm (1) connected to a base (3), c h a r a c t e r i s e d in that an angle transducer (4-7) is arranged in the rotary joints (la, lb) in order to measure exactly the angular relationship between the jointed arms (1, lc) or between the jointed arm (1) and the base (3), in order to make possible adjustment of the robot arm into the desired angular position. 2. The robot arm according to claim 1, c h a r a c t e r i - s e d in that the angle transducer comprises a first disk, the rotor (4), with circularly arranged and radially directed receiver electrodes (5) and a second disk, the stator (7), equipped with circularly arranged and radially directed transmitter electrodes (6) arranged at the same radius as the receiver electrodes (5) and with a fixed separation between the receiver electrodes and the transmitter electrodes on the two disks, whereby the disks (4, 7) are arranged coaxially and rotatable relative to each other, and the disks are further separated by a thin air-gap that makes possible a ca- pacitive or an inductive coupling between the electrode systems (5, 6) on the rotor disk (4) and the stator disk (7), whereby the transmitter electrodes (6) are each supplied with an alternating voltage with different phases for neighbouring electrodes, whereby the number of supply phases, Φ, is greater than two, and the separation of transmitter electrodes = the separation of receiver electrodes/Φ, in which, according to the invention, the transmitter electrodes (6) of the stator are geometrically arranged such that errors in their geometry relative to the geometry of the receiver electrodes (5) produce equal but opposite error signals in the receiver electrodes (5) of the rotor. 3. The robot arm according to claim ■ * c h a r a c t e r i s e d in that n receiver electrodes (5) are evenly distributed over the complete perimeter of the rotor (4) , whereby n is an integer, and that n * Φ transmitter electrodes (6) are evenly distributed over the complete perimeter of the stator (7) . 4. The robot arm according to claim 2 or 3, c h a r a c t e r i s e d in that the rotor disk (4) and the stator disk (7) comprise a second system of electrodes in order to measure directly the angular position of the rotor disk (4) within one complete revolution of 360°. 5. The robot arm according to any one of the preceding claims, c h a r a c t e r i s e d in that it further com- prises a special system of electrodes (14-18) to measure the motions of an included mechanical part that arise from play in the system. 6. The robot arm according to claim 5, c h a r a c t e r i - s e d in that the special system of electrodes comprises electrodes (18; 17) integrated in the rotor and stator disks (4; 7) that are excited by a transmitter electrode (17) on the stator disk for measurement of movements in the radial direction. 7. The robot arm according to claim 5, c h a r a c t e r i s e in that the special system of electrodes comprises electrodes (15, 16; 14) integrated in the rotor and stator disks (4; 7) that are excited by a transmitter electrode (14) on the stator disk for measurement of movements in the axial direction. 8. The robot arm according to either claim 6 or 7, c h a r a c t e r i s e d in that the transmitter electrode is a common transmitter electrode (19) .

Inventors: GUSTAFSSON CARL-ERIK, PETTERSSON BO, GUSTAFSSON, CARL-ERIK, PETTERSSON, BO
Applicants: GUSTAFSSON CARL ERIK, JOHANSSON AB C E, PETTERSSON BO, C E JOHANSSON AB, GUSTAFSSON, CARL-ERIK, PETTERSSON, BO
Application year: 2001
Main classification: B25J19
IPC codes: B25J19, G01B7, G01D5