CA1161925A - Instrumented remote center compliance device - Google Patents
Instrumented remote center compliance deviceInfo
- Publication number
- CA1161925A CA1161925A CA000360624A CA360624A CA1161925A CA 1161925 A CA1161925 A CA 1161925A CA 000360624 A CA000360624 A CA 000360624A CA 360624 A CA360624 A CA 360624A CA 1161925 A CA1161925 A CA 1161925A
- Authority
- CA
- Canada
- Prior art keywords
- sensors
- operator member
- displacement
- displacements
- operator
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired
Links
- 238000006073 displacement reaction Methods 0.000 claims abstract description 138
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000000034 method Methods 0.000 claims description 6
- 238000012546 transfer Methods 0.000 claims description 6
- 230000014509 gene expression Effects 0.000 description 14
- 101150118300 cos gene Proteins 0.000 description 12
- 238000010586 diagram Methods 0.000 description 11
- 244000089409 Erythrina poeppigiana Species 0.000 description 4
- 235000009776 Rathbunia alamosensis Nutrition 0.000 description 4
- 238000013519 translation Methods 0.000 description 4
- 230000014616 translation Effects 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 2
- ZMRUPTIKESYGQW-UHFFFAOYSA-N propranolol hydrochloride Chemical compound [H+].[Cl-].C1=CC=C2C(OCC(O)CNC(C)C)=CC=CC2=C1 ZMRUPTIKESYGQW-UHFFFAOYSA-N 0.000 description 2
- 241001442234 Cosa Species 0.000 description 1
- 101100234408 Danio rerio kif7 gene Proteins 0.000 description 1
- 101100221620 Drosophila melanogaster cos gene Proteins 0.000 description 1
- 101100221616 Halobacterium salinarum (strain ATCC 29341 / DSM 671 / R1) cosB gene Proteins 0.000 description 1
- 101100398237 Xenopus tropicalis kif11 gene Proteins 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000002301 combined effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000003780 insertion Methods 0.000 description 1
- 230000037431 insertion Effects 0.000 description 1
- 230000013011 mating Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q1/00—Members which are comprised in the general build-up of a form of machine, particularly relatively large fixed members
- B23Q1/25—Movable or adjustable work or tool supports
- B23Q1/26—Movable or adjustable work or tool supports characterised by constructional features relating to the co-operation of relatively movable members; Means for preventing relative movement of such members
- B23Q1/34—Relative movement obtained by use of deformable elements, e.g. piezoelectric, magnetostrictive, elastic or thermally-dilatable elements
- B23Q1/36—Springs
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/26—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
- G01B11/27—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes for testing the alignment of axes
- G01B11/272—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes for testing the alignment of axes using photoelectric detection means
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
ABSTRACT OF THE DISCLOSURE
A remote center compliance device having an operator member and a remote compliance center near the end of the operator member, including one or more translational displacement sensors proximate the operator member for sensing displacement in one or more degrees of freedom of the operator mem-ber.
A remote center compliance device having an operator member and a remote compliance center near the end of the operator member, including one or more translational displacement sensors proximate the operator member for sensing displacement in one or more degrees of freedom of the operator mem-ber.
Description
This invention relates to an improved instrumented remote center compliance device, and more particularly to an instrumented system including one or more translational displacement sensors located about the operator member of the device for sensing displacement in one or more degrees of free-dom of the operator member.
A remote center compliance device (RCC) is a passive device for aid-ing insertion and mating manoeuvers in robot machines and assembly equipment.
RCC's typically include a structure which supports an operator member and establishes a remote compliance center near the functioning end of the oper-ator member. See United States Patents No. 4,098,001 and ~,155,169. In some robot and assembly applications there is a need for feedback from the RCC;
however, force measurement is not always ideal for this purpose. For example, force sensors generally cannot withstand the large forces that occur when the RCC is driven to the limit against mechanical stops. In addition, force sensors generally cannot resolve the very small forces on the RCC when it is operating in its more normal range, not at its limits. Further, the mounting of the force sensors, usually between the RCC and its support from the host machine, interfeTes with the compliance of the RCC; the compliance of the re-mote center is not simply that of the RCC but the combination of the compliance of the RCC and the compliance of the force sensor apparatus.
Typical angular deflections of an RCC are of the order of 5 and such angles are very difficult to measure using angular rotation sensors. In addition, the kinematic rotation center of the RCC is not a fixed point but rather a varying point. The general angular rotational sensor enforces a fixed axis of rotation within the sensor. In addition, the operator means of the RCC is subject to various translation. In consequence, angular rotational sensors need be connected to the operator means of the RCC by means of the - 1 - '3~
1 1~1925 kinematic equivalent of splined shaf~s accommodating either axial or lateral relative motion. This is a significant difficulty which is avoided hy the use of translational displacement sensors exclusively.
It is therefore an object of this invention to provide an improved instrumented RCC which uses only translational-displacement measuring sensors to measure position and angular displacement in one or more degrees of free-dom.
The invention is featured i-n an improved instrumented remote center compliance device which has an operator member and a remote compliance center near the end of the operator member. More specifically, the invention fea-tures one or more translational displacement sensors located proximate the op-erator member for sensing displacement in one or more degrees of freedom of the operator member. By translational displacement sensor is mean* one which measures motion of the operator member in terms of translations which can then be resolved into actual translakional and rotational displacements. The sensors are arranged so-as to produce a change in output from at least one of the sensors in response to changes in position relative to the radial axes of the operator member. In a preferred embodiment, there are first and second translational displacement sensors spaced from the operator member for sensing displacement thereof, and the first and second sensors are disposed to one another at a first angle about the axis of the operator member. There are third and fourth translational displacement sensors spaced from the operator member for sensing displacement thereof. The third and fourth sensors are spaced from the first and second sensors along the axis of the operator member and are disposed to each other at a second angle about the axis of the oper-ator member. The sensors are disposed so as to produce an output from at least one sensor for changes of position of the operator member relative to the radial axes. By displacement herein is meant both angular and transla-tional movement.
Typically, the first and second sensors are in one plane and the third and fourth are ln a second, parallel plane, and the first and second angles are equal. ln a simple case the first and second angles may both be equal to 90 and the sensor in each pair may be aligned with a sensor in the other pair.
If necessary or desirable, fewer or more translational displacement sensors may be used, for example a fifth sensor may be used to sense a fifth degree of freedom of motion of the operator member.
The invention also features means for solving the equation X = ~Xl, where ~ is a transfer matrix relating the translational displacement sensor output signals to displacement applied to the remote center compliance device which produces those output signals; Xl is the vector whose elements are the outputs of the sensors for determining X, which is a vector whose elements are the components of the displacement supplied to the device. Although the sensors illustrated in the specification are of the photo-electric type, this is not a necessary limitation of the invention, for other types of translational trans-ducers may be used and are sufficient, for example LVDT's, linear-displacement potentiometers, or any other translational displacement-sensitive transducer.
~0 This invention also features a method of measuring an unknown dis-placement on the operator member of a remote center compliance device having a remote compliance center near the end of the operator member which includes disposing one or more translational displacement centers about the device for producing output signals representative of displacements of the operator mémber Known displacements are applied to the operator member so that there exists no sensed displacement which cannot be expressed in terms of one or more applied displacements. Each of the output signals produced by each of the sensors ~=~ -3-~ 161925 in response to the applied displacements is measured. A transfer matrix ID
defined by the equation Xl = ~X as determined by the applied displacements and the corresponding sensor output signals, where X is a vector whose elements are the components of the applied displacements and Xl is a vector whose elements are the outputs of the sensors is calculated. An unknown displacement is applied to the operator member. Each of the output signals from each sensor in response to the unknown displacement is measured and the unknown displace-ment is calculated by solving the equation X - ~Xl where Xl is a vector whose elements are the sensor outputs in response to the unknown displacement and X
is a vector whose elements are the componen~s of the unknown displacement.
Other objects, features and advantages will occur from the following description of a preferred embodiment and the accompanying drawings, in which:
Figure 1 is an axonometric view of a remote center compliance device, RCC, of the type shown in United States Patent No. 4,155,169, which may be instrumented according to this invention;
Figure 2 is a more detailed sectional view of an RCC device such as shown in Figure 1 with instrumentation according to this invention taken along , - \
` -3a-` . 1 l~lg25 line 2-2 of Figure 3;
Figure 3 is a plan view of the improved instrumented RCC device of Figure 2 taken along line 3-3 of Figure 2;
Figure 4 is a block diagram of a computer circuit for resolving measured translational displacement signals into resolved translational and rotational displacements;
Figure 5 is an axonometric schematic diagram illustrating basic parameters used in resolving measured displacement signals into resolved translational and rotational displacements;
Figure 6 is a more simplified schematic of the instrumentation of an RCC where the angle between the sensors in each pair of sensors is at an angle other than 90;
Figure 7 is a diagram illustrating a basis for conversion from the axes of the sensors in Figure 6 to the X,Y axes in Figure 6;
Figure 8 is a block diagram of a computer circuit for calculating the resolved translational and rotational displacements from the measured displacement outputs of the sensors;
Figure 9 is a simplified schematic diagram of the placement of sen-sors on an instrumented RCC when each of the sensors is in a different plane and at a different angle to the X,Y axes and there is no vertical alignment between any of the sensors;
Figure 10 is a schematic diagram showing one placement of a fifth sensor, which enables monitoring of all five degrees of freedom of motion of an RCC;
Figure 11 is a block diagram of a computer circuit for resolving the measured displacement signals into the resolved translational and rota-tional displacements;
9 2 ~
Figure 12 is a block diagram of a circuit which may be constructed using calibration techniques to resolve measured displacement signals into resolved translational and rotational displacements;
Figure 13 is a schematic diagram of an RCC of the type shown in United States Patent No. 4,098,001;
Flgure 14 is a simple block diagram of a circuit for resolving the measured displacement signals into the resolved translational and rotational displacements for the RCC in Figure 13; and Figure 15 shows an alternative circuit similar to that in Figure 14 for resolving measured displacement signals into resolved translational and rotational displacements for the RCC's in Figure 13.
The invention may be accomplished by disposing a number of transla-tional displacement sensors on an RCC so that the relative angular and trans-lational displacement between the moveable or operating member and the rest of the RCC can be detected. RCC's are disclosed in United States Patents No.
4,098,001 and 4,155,169. Any number of sensors may be used, but they should be disposed so that an output is produced from at least one sensor for changes of position of the operator member rela~ive to the remainder of *he RCC. The number of sensors used may be commensurate with the number of degrees of free-dom that it is desired to monitor, for example, one sensor may be used tomonitor one degree of freedom, four sensors to measure four degrees of free-dom, five sensors to measure five degrees of freedom. However, more sensors may of course be used. RCC's typically do not have more than five degrees of freedom; they are constrained to permit no displacement in the axial direction.
Once the translational displacement signals are obtained from the sensor or sensors, they must be converted or resolved into an acceptable coordinate form to provide useful information. Typically in an X and Y coordinate system the -X and Y translations, XJ Y~ and the X and Y rotations ~X~ ~y~ of the operator member are desired to describe the movement of the operator member with respect to the remote compliance center. Computing circuits are necessary to resolve the measured displacement signals into the actual displacements o:E the oper-ator member. The soundness of the block diagrams of the computing circuits disclosed herein may be verified and defined analytically through the use of geometry and algebra, or empirically by a calibration technique also taught herein.
A simple arrangement which uses a relatively simple computing circuit results from using four translational displacement sensors, two in the plane perpendicular, i.e. radial, to the axis, of the operating member and two in a second plane parallel to the first plane. The sensors in each plane are at 90 to each other, and each is aligned with the sensor in the plane above.
However, this is not a necessary limitation on the invention. For example, the angle between the sensors in each pair need not be 90, and in fact the angle between one pair of sensors need not be equal to the angle between the other pair of sensors. The sensors need not be aligned each with another one, and in fact each of the sensors may be in a different plane. Of course, the number of sensors need not be fixed at four, but may be any number equal to or greater than the number of degrees of freedom that it is desired to moni-tor. For proper results, however, the sensors should be disposed so that there is an output produced from at least one of the sensors for changes of position of the operator member. In contrast the use of rotationally sensi-tive sensors for any one or more of the sensors results in the difficulty of connecting such sensors, with their fixed axes of rotation, to the operator member, with its five degrees of freedom, two of translation and three of ro-tation, by means of the kinematic equivalent of a splined shaft with universal l ~6192~
joints at the ends, with all attendant disadvantages such as backlash, fric-tion and inertia.
There is shown in Figure 1 a remote center compliance device 10 which includes a deformable structure 22, from the central portion 24 of which is suspended operator member 16 having longitudinal or axial axis 17. De-formable structure 22 may also include three or more radially extending beams 26, 28, and 30, which are equally spaced and terminate in an intermediate rigid annular member 32. Beams 26, 28, and 30 lie along radial axes, i.e.
axes perpendicular to the axial axis. Member 32 is carried~by a second de-formable structure 34 which includes three longitudinal beams 36, 38, and 40, which extend to a fixed portion such as housing 12, as illustrated in Pigure
A remote center compliance device (RCC) is a passive device for aid-ing insertion and mating manoeuvers in robot machines and assembly equipment.
RCC's typically include a structure which supports an operator member and establishes a remote compliance center near the functioning end of the oper-ator member. See United States Patents No. 4,098,001 and ~,155,169. In some robot and assembly applications there is a need for feedback from the RCC;
however, force measurement is not always ideal for this purpose. For example, force sensors generally cannot withstand the large forces that occur when the RCC is driven to the limit against mechanical stops. In addition, force sensors generally cannot resolve the very small forces on the RCC when it is operating in its more normal range, not at its limits. Further, the mounting of the force sensors, usually between the RCC and its support from the host machine, interfeTes with the compliance of the RCC; the compliance of the re-mote center is not simply that of the RCC but the combination of the compliance of the RCC and the compliance of the force sensor apparatus.
Typical angular deflections of an RCC are of the order of 5 and such angles are very difficult to measure using angular rotation sensors. In addition, the kinematic rotation center of the RCC is not a fixed point but rather a varying point. The general angular rotational sensor enforces a fixed axis of rotation within the sensor. In addition, the operator means of the RCC is subject to various translation. In consequence, angular rotational sensors need be connected to the operator means of the RCC by means of the - 1 - '3~
1 1~1925 kinematic equivalent of splined shaf~s accommodating either axial or lateral relative motion. This is a significant difficulty which is avoided hy the use of translational displacement sensors exclusively.
It is therefore an object of this invention to provide an improved instrumented RCC which uses only translational-displacement measuring sensors to measure position and angular displacement in one or more degrees of free-dom.
The invention is featured i-n an improved instrumented remote center compliance device which has an operator member and a remote compliance center near the end of the operator member. More specifically, the invention fea-tures one or more translational displacement sensors located proximate the op-erator member for sensing displacement in one or more degrees of freedom of the operator member. By translational displacement sensor is mean* one which measures motion of the operator member in terms of translations which can then be resolved into actual translakional and rotational displacements. The sensors are arranged so-as to produce a change in output from at least one of the sensors in response to changes in position relative to the radial axes of the operator member. In a preferred embodiment, there are first and second translational displacement sensors spaced from the operator member for sensing displacement thereof, and the first and second sensors are disposed to one another at a first angle about the axis of the operator member. There are third and fourth translational displacement sensors spaced from the operator member for sensing displacement thereof. The third and fourth sensors are spaced from the first and second sensors along the axis of the operator member and are disposed to each other at a second angle about the axis of the oper-ator member. The sensors are disposed so as to produce an output from at least one sensor for changes of position of the operator member relative to the radial axes. By displacement herein is meant both angular and transla-tional movement.
Typically, the first and second sensors are in one plane and the third and fourth are ln a second, parallel plane, and the first and second angles are equal. ln a simple case the first and second angles may both be equal to 90 and the sensor in each pair may be aligned with a sensor in the other pair.
If necessary or desirable, fewer or more translational displacement sensors may be used, for example a fifth sensor may be used to sense a fifth degree of freedom of motion of the operator member.
The invention also features means for solving the equation X = ~Xl, where ~ is a transfer matrix relating the translational displacement sensor output signals to displacement applied to the remote center compliance device which produces those output signals; Xl is the vector whose elements are the outputs of the sensors for determining X, which is a vector whose elements are the components of the displacement supplied to the device. Although the sensors illustrated in the specification are of the photo-electric type, this is not a necessary limitation of the invention, for other types of translational trans-ducers may be used and are sufficient, for example LVDT's, linear-displacement potentiometers, or any other translational displacement-sensitive transducer.
~0 This invention also features a method of measuring an unknown dis-placement on the operator member of a remote center compliance device having a remote compliance center near the end of the operator member which includes disposing one or more translational displacement centers about the device for producing output signals representative of displacements of the operator mémber Known displacements are applied to the operator member so that there exists no sensed displacement which cannot be expressed in terms of one or more applied displacements. Each of the output signals produced by each of the sensors ~=~ -3-~ 161925 in response to the applied displacements is measured. A transfer matrix ID
defined by the equation Xl = ~X as determined by the applied displacements and the corresponding sensor output signals, where X is a vector whose elements are the components of the applied displacements and Xl is a vector whose elements are the outputs of the sensors is calculated. An unknown displacement is applied to the operator member. Each of the output signals from each sensor in response to the unknown displacement is measured and the unknown displace-ment is calculated by solving the equation X - ~Xl where Xl is a vector whose elements are the sensor outputs in response to the unknown displacement and X
is a vector whose elements are the componen~s of the unknown displacement.
Other objects, features and advantages will occur from the following description of a preferred embodiment and the accompanying drawings, in which:
Figure 1 is an axonometric view of a remote center compliance device, RCC, of the type shown in United States Patent No. 4,155,169, which may be instrumented according to this invention;
Figure 2 is a more detailed sectional view of an RCC device such as shown in Figure 1 with instrumentation according to this invention taken along , - \
` -3a-` . 1 l~lg25 line 2-2 of Figure 3;
Figure 3 is a plan view of the improved instrumented RCC device of Figure 2 taken along line 3-3 of Figure 2;
Figure 4 is a block diagram of a computer circuit for resolving measured translational displacement signals into resolved translational and rotational displacements;
Figure 5 is an axonometric schematic diagram illustrating basic parameters used in resolving measured displacement signals into resolved translational and rotational displacements;
Figure 6 is a more simplified schematic of the instrumentation of an RCC where the angle between the sensors in each pair of sensors is at an angle other than 90;
Figure 7 is a diagram illustrating a basis for conversion from the axes of the sensors in Figure 6 to the X,Y axes in Figure 6;
Figure 8 is a block diagram of a computer circuit for calculating the resolved translational and rotational displacements from the measured displacement outputs of the sensors;
Figure 9 is a simplified schematic diagram of the placement of sen-sors on an instrumented RCC when each of the sensors is in a different plane and at a different angle to the X,Y axes and there is no vertical alignment between any of the sensors;
Figure 10 is a schematic diagram showing one placement of a fifth sensor, which enables monitoring of all five degrees of freedom of motion of an RCC;
Figure 11 is a block diagram of a computer circuit for resolving the measured displacement signals into the resolved translational and rota-tional displacements;
9 2 ~
Figure 12 is a block diagram of a circuit which may be constructed using calibration techniques to resolve measured displacement signals into resolved translational and rotational displacements;
Figure 13 is a schematic diagram of an RCC of the type shown in United States Patent No. 4,098,001;
Flgure 14 is a simple block diagram of a circuit for resolving the measured displacement signals into the resolved translational and rotational displacements for the RCC in Figure 13; and Figure 15 shows an alternative circuit similar to that in Figure 14 for resolving measured displacement signals into resolved translational and rotational displacements for the RCC's in Figure 13.
The invention may be accomplished by disposing a number of transla-tional displacement sensors on an RCC so that the relative angular and trans-lational displacement between the moveable or operating member and the rest of the RCC can be detected. RCC's are disclosed in United States Patents No.
4,098,001 and 4,155,169. Any number of sensors may be used, but they should be disposed so that an output is produced from at least one sensor for changes of position of the operator member rela~ive to the remainder of *he RCC. The number of sensors used may be commensurate with the number of degrees of free-dom that it is desired to monitor, for example, one sensor may be used tomonitor one degree of freedom, four sensors to measure four degrees of free-dom, five sensors to measure five degrees of freedom. However, more sensors may of course be used. RCC's typically do not have more than five degrees of freedom; they are constrained to permit no displacement in the axial direction.
Once the translational displacement signals are obtained from the sensor or sensors, they must be converted or resolved into an acceptable coordinate form to provide useful information. Typically in an X and Y coordinate system the -X and Y translations, XJ Y~ and the X and Y rotations ~X~ ~y~ of the operator member are desired to describe the movement of the operator member with respect to the remote compliance center. Computing circuits are necessary to resolve the measured displacement signals into the actual displacements o:E the oper-ator member. The soundness of the block diagrams of the computing circuits disclosed herein may be verified and defined analytically through the use of geometry and algebra, or empirically by a calibration technique also taught herein.
A simple arrangement which uses a relatively simple computing circuit results from using four translational displacement sensors, two in the plane perpendicular, i.e. radial, to the axis, of the operating member and two in a second plane parallel to the first plane. The sensors in each plane are at 90 to each other, and each is aligned with the sensor in the plane above.
However, this is not a necessary limitation on the invention. For example, the angle between the sensors in each pair need not be 90, and in fact the angle between one pair of sensors need not be equal to the angle between the other pair of sensors. The sensors need not be aligned each with another one, and in fact each of the sensors may be in a different plane. Of course, the number of sensors need not be fixed at four, but may be any number equal to or greater than the number of degrees of freedom that it is desired to moni-tor. For proper results, however, the sensors should be disposed so that there is an output produced from at least one of the sensors for changes of position of the operator member. In contrast the use of rotationally sensi-tive sensors for any one or more of the sensors results in the difficulty of connecting such sensors, with their fixed axes of rotation, to the operator member, with its five degrees of freedom, two of translation and three of ro-tation, by means of the kinematic equivalent of a splined shaft with universal l ~6192~
joints at the ends, with all attendant disadvantages such as backlash, fric-tion and inertia.
There is shown in Figure 1 a remote center compliance device 10 which includes a deformable structure 22, from the central portion 24 of which is suspended operator member 16 having longitudinal or axial axis 17. De-formable structure 22 may also include three or more radially extending beams 26, 28, and 30, which are equally spaced and terminate in an intermediate rigid annular member 32. Beams 26, 28, and 30 lie along radial axes, i.e.
axes perpendicular to the axial axis. Member 32 is carried~by a second de-formable structure 34 which includes three longitudinal beams 36, 38, and 40, which extend to a fixed portion such as housing 12, as illustrated in Pigure
2.
Attached to member 16, Figures 2 and 3, is a stop member 42 whichlimits the extent of motion of operator member 16 to prevent damage to the RCC. Also mounted to operator member 16 is a shade 44 which has two shade elements 46 and 48, whose outer edges 50, 52 sharply delineate the shadow area from that illuminated by light sources 54, 56 on translational displacement sensors 58, 60 carried by supports 62, 64 on housing 12. Light sources 54, 56 are carried by support 66, also mounted on housing 12. Light source 54 and 56 may be Monsanto Electronic Special Products MVlOB light-emitting diodes, for example, and translational displacement sensors 58 and 60 may be Reticon RL 256G solid-state line scanners with associated timing and counting cir-cuitry, for example. Sensors 58 and 60 may be considered the X axis sensors.
A second set of translational displacement sensors 76 and 78 ~partly obscured) is typically provided, Figure 3, with a second pair of light sources 72 and 74 ~partly obscured). Shade 44 includes a second pair of shade elements 80 and 82 ~not shown). The signals from sensors 58 and 60 are referred to as 9~5 X2 and Xl, respectively, and those from sensors 76 and 78 as Y2 and Yl, res-pectively.
The measured translational displacement signals Xl, X2, Yl, Y2 may be resolved into the actual translational X, Y, and angular or rotational ~X' displacements of operator member 16 by the computing circuit shown in Figure 4. There, Xl is multiplied by the factor ~) in multiplier circuit 100, and by the factor (S) in multiplier circuit 102, where L is the distance from remote center 70 to the X2, Y2 signal sensing position and S is the dis-tance between the Xl, Yl and X2, Y2 signal sensing positions, shown in Figure 5. X2 measured displacement signal is multiplied by the factor (l ~ S) in multiplier 104, and by the factor ~(S) in multiplier 106. Measured signal Yl is multiplied by the fac~or (L) in multiplier 108 and ~(S) in multiplier llO. Measured displacement signal Y2 is multiplied by the ~actor (1 - L) in multiplier circuit 112, and by the factor ~S) in multiplier circuit 114.
These multiplier factors are relatively simple since the translational dis-placement sensors are arranged in pairs in parallel planes aligned with each other and with each pair at 90 to each other. The Xl, X2 derived outputs from circuits lO0 and 104 are combined in summer 116 to provide the actual dis-placement X. The Xl, X2 derived outputs from circuits 102 and 106 are com-bined in summer circuit 118 to provide the displacement Oy~ The Yl, Y2 derivedouputs from circuits 108 and 112 are combined in summer circuit 120 ~o pro-vide the actual Y displacement, and the Yl, Y2 derived outputs from circuits 110 and 114 are combined in summer 122 provide the ~X output. That this approach is sound may be seen from Figure 5, where ~1 and ~2 are both equal to 90. The relationship of the measured displacement signals Xl, X2, Yl, Y2 to the actual displacements X, Y, ~X~ ~y in terms of L and S is:
~ 16192~
Xl = X - ~)y (L-S) (1) X2 = X - (3y (L) (2) Yl = Y ~ ~X ~L-S) (3) 2 (~)X (L) (~) These equations may be expressed in matrix form for easier solution:
~X~ 1 0 0 (S-L) ~X
J X21 1 (-L) I Y l 1~ 0 1 (L-S) 0 ~i t lY2~ 1 (L) 0 l J
which may be simply expressed as:
Xl = ~A lX (6) Thus, Xl is a vector whose elements are the outputs of the sensors.
These equations of course are not exact, they are standard approxi-mations known and used in geometry. In order to solve for the actual dis-placements X, the matrix may be inverted, X = ~Xl (7) to the state:
~X~(LS) ~ S~ 0 ~X~
Y ~ (--S~ S) ¦ X2l ~X ~ o (-S) (S-) l yll (8) ~` J (S) (-S) o o ~Y2J
In the general case wherein Xl may be of higher dlmension than X, equations (6) and (7) can be written Xl = ~X and X = ~Xl, respectively, where ~* ~ equals II and II is the identity matrix. In ~he useful special case previously described-in-detail wherein X and Xl are of the same dimension, and ~ are square matrices and simply ~ equals ~ 1.
Alternatively, when the sensors are not at 90 to each other, that l ~61925 is when ~1 and ~2 are not equal to 90 as shown in Figure 6, the measured signals are represented by Ul, U2, Vl and V2, which can be resolved in terms of the Xl, X2, Yl, and Y2 coordinates shown in Figure 6, where Ul and Xl are separated by the angle al; U2 and X2 by the angle a2; Vl and Yl by the angle ~1; and V2 and Y2 by the angle ~2. This conversion may be accomplished as shown in Figure 7 using equations:
x = a cosà
a = u - b b = e sina y = e + c > ,~, c = a sina ~9) f cos~ = V
j cos~ = x j sin~ = g ~g + f = Y ~
which result in the matrix expression:
-sina cosa l~l = sina __ ~ l (10) cos~
For the specific case of Xl, Yl the matrix expression appears as:
sinalcos(x 1 ~ n~; 1 l (Il) and for X2, Y2 the matrix expression appears as:
- "- J1$1925 I' 1 sincl2cosc~2 ~ .
~ X2 ~ U5~2 ~ D2 These two expressions (11) and (12) are combined to produce:
¦ Yl ¦ sinc~ O 1 ~I I
~ = sinQl2cosa X2~ I C5~2 ~U2~
2, 0 sin~2 cosB 2 which when rearranged to present Xl, X2, Yl, Y2 in the desired order, appears as:
` Sin~lCs~l _ /
Xl 1 cosBI U
Sin~2CoS~21 X2 ~ = cos2~ C05~2-cos~2 ' IVl ~ ~14) Yl 1 cosBI cos2c~2 ~ ~
2 2C5~2 J~2) 1 16~925 Expression (14) may now be simply state~:
Xl = ~Ul ~15) Since we know from expression (7) that X = ~Xl, we can substitute in expres-sion (15) to arrive at expression (16)j which fully expanded appears as e~pression ~17).
X = Aæul ~16) L L sinal 5~1 L L n~2 2 X ~ (S) CS~ S) ~ s-)coscc2~ ~l-S~ Ul ~
(S) 1 ~S) cos~ (1 L)sina (1 L) 2 Vl ¦
QX¦ (1) sin~ (1) cos ~1 (S) sin~2 (S) cos~ 1 U2 l (1)(1 C~l_ C~ (1 nc~2cosc~2 J cos~l cos~2 - ~v2 A computer circuit which implements this statement includes a plurality of multiplier circuits 130 through 160, Figure 8, which multiply the measured displacement signals Ul, Vl, U2, and V2, by the various factors shown in terms of the dimensions L, S, and the angles ~ and ~, and are then combined in the combinations shown in summer circuits 162, 164, 166, and 168, to provide the actual displacements X, Y, ~X~ and 3y~
In a similar manner, in the case where there are four translational displacement sensors providing four measured signals Ul, U2, Vl, and V2, but none of the sensors are in the same plane nor aligned with each other, as 1 ~19~
shown in Figure 9, the measured signals Ul, U2, Vl, V2 may be resolved into the desired X, YJ ~X~ ~Y components, as shown by ~he following expressions:
l ( ~l)X + ~sin~l)Y - ~Slsin~ x ~ (slcos~ y (18) 2 ~ ~l)X ~Sin~l)Y - ~Llsln~l)ox + ~Llcos~ Y ~19) Vl ~ ~cos~2)X + (sin~2)Y - ~S2sin~2)~x ~ ~S2cs 2) Y ~20) V2 ~ (cos~2)X + (sin~2)Y - (L2Sin~2)~x ( 2 2 Y (21) These expressions may be placed in matrix form, lrul~ COSC~l sinal -Slsin~l Slcosc~l ' f x ) U2l cos~l sin~l -Llsin~l Llcos~l J ~ ~22) cosa2 sinc~2 -S2sinc~2 S2coso~2 ; X
2J cos~2 sin~2 -L2sin~2 L2cos~2 l J
and then inverted in the usual way, ~ X l Mll ~12 M13 14 l Ul : Jl ~ M21 M22 M23 24 ~ U2 ~ ~23) ~X ~ M31 M32 M33 ~34 Vl M4l M42 M43 M44 2 ¦
to obtain the terms which define the multiplier factors that are implemented in multiplier circuits 180 - 210 in the computer circui~, Figure 11.
The outputs of circuits 180-210 are combined in the groups shown in summer circuits 212, 214, 216, and 218, to provide directly the X, Y, and ~X' displacements.
Although thus far the illustrations have used four translational displacement sensors to sense four degrees of freedom, this is not a neces-sary limitation of the invention, as fewer or more sensors may be used to monitor fewer or more degrees of freedom. For example, a fifth sensor 220, Figure 10, may be added to produce a ~ displacement signal which senses rota-tion about the Z axis, axis 17, of the operator member. Sensor 220 is placed 1 161~5 parallel to sensor 78 in order to sense the rotation about Z axis 17. To effect this, a non-circular member with some sort of camming surface 222 is used in conjunction with sensor 220 to detect the rotation. Alternatively, sensor 220 might be placed elsewhere.
With five degrees of freedom being sensed by five sensors, the four expressions (18) - (21) would be expanded to include a fifth equation, and there would be a fifth column and fifth row added to the matrices in expres-sions (22) and (23), while the implementation shown in Figure 11 would be expanded by the addition of one more multiplier circuit associated wi-th each of the measured ;nput signals Ul, U2, Vl, V2, and also the addition of a fifth input, for example ~z.
Alternatively, a calibration technique may be used to veri`~y the multiplier factors in the computer circuit which resolves the measured dis-placement signals obtained from an instrumented RCC into the actual displace-ments of the operator member and body of the RCC relative to each other.
First the instrumented RCC is fixed so that each degree of freedom, for ex-ample, X, Y, 3X~ ~y~ and ~z, can be varied independently while all the others remain fixed or at zero displacement. This may be stated in matrix form as:
~ ul~ 11 N12 N13 N14 N15 ~X l 20l U2l N21 N22 N23 N24 N25 ~ I
Attached to member 16, Figures 2 and 3, is a stop member 42 whichlimits the extent of motion of operator member 16 to prevent damage to the RCC. Also mounted to operator member 16 is a shade 44 which has two shade elements 46 and 48, whose outer edges 50, 52 sharply delineate the shadow area from that illuminated by light sources 54, 56 on translational displacement sensors 58, 60 carried by supports 62, 64 on housing 12. Light sources 54, 56 are carried by support 66, also mounted on housing 12. Light source 54 and 56 may be Monsanto Electronic Special Products MVlOB light-emitting diodes, for example, and translational displacement sensors 58 and 60 may be Reticon RL 256G solid-state line scanners with associated timing and counting cir-cuitry, for example. Sensors 58 and 60 may be considered the X axis sensors.
A second set of translational displacement sensors 76 and 78 ~partly obscured) is typically provided, Figure 3, with a second pair of light sources 72 and 74 ~partly obscured). Shade 44 includes a second pair of shade elements 80 and 82 ~not shown). The signals from sensors 58 and 60 are referred to as 9~5 X2 and Xl, respectively, and those from sensors 76 and 78 as Y2 and Yl, res-pectively.
The measured translational displacement signals Xl, X2, Yl, Y2 may be resolved into the actual translational X, Y, and angular or rotational ~X' displacements of operator member 16 by the computing circuit shown in Figure 4. There, Xl is multiplied by the factor ~) in multiplier circuit 100, and by the factor (S) in multiplier circuit 102, where L is the distance from remote center 70 to the X2, Y2 signal sensing position and S is the dis-tance between the Xl, Yl and X2, Y2 signal sensing positions, shown in Figure 5. X2 measured displacement signal is multiplied by the factor (l ~ S) in multiplier 104, and by the factor ~(S) in multiplier 106. Measured signal Yl is multiplied by the fac~or (L) in multiplier 108 and ~(S) in multiplier llO. Measured displacement signal Y2 is multiplied by the ~actor (1 - L) in multiplier circuit 112, and by the factor ~S) in multiplier circuit 114.
These multiplier factors are relatively simple since the translational dis-placement sensors are arranged in pairs in parallel planes aligned with each other and with each pair at 90 to each other. The Xl, X2 derived outputs from circuits lO0 and 104 are combined in summer 116 to provide the actual dis-placement X. The Xl, X2 derived outputs from circuits 102 and 106 are com-bined in summer circuit 118 to provide the displacement Oy~ The Yl, Y2 derivedouputs from circuits 108 and 112 are combined in summer circuit 120 ~o pro-vide the actual Y displacement, and the Yl, Y2 derived outputs from circuits 110 and 114 are combined in summer 122 provide the ~X output. That this approach is sound may be seen from Figure 5, where ~1 and ~2 are both equal to 90. The relationship of the measured displacement signals Xl, X2, Yl, Y2 to the actual displacements X, Y, ~X~ ~y in terms of L and S is:
~ 16192~
Xl = X - ~)y (L-S) (1) X2 = X - (3y (L) (2) Yl = Y ~ ~X ~L-S) (3) 2 (~)X (L) (~) These equations may be expressed in matrix form for easier solution:
~X~ 1 0 0 (S-L) ~X
J X21 1 (-L) I Y l 1~ 0 1 (L-S) 0 ~i t lY2~ 1 (L) 0 l J
which may be simply expressed as:
Xl = ~A lX (6) Thus, Xl is a vector whose elements are the outputs of the sensors.
These equations of course are not exact, they are standard approxi-mations known and used in geometry. In order to solve for the actual dis-placements X, the matrix may be inverted, X = ~Xl (7) to the state:
~X~(LS) ~ S~ 0 ~X~
Y ~ (--S~ S) ¦ X2l ~X ~ o (-S) (S-) l yll (8) ~` J (S) (-S) o o ~Y2J
In the general case wherein Xl may be of higher dlmension than X, equations (6) and (7) can be written Xl = ~X and X = ~Xl, respectively, where ~* ~ equals II and II is the identity matrix. In ~he useful special case previously described-in-detail wherein X and Xl are of the same dimension, and ~ are square matrices and simply ~ equals ~ 1.
Alternatively, when the sensors are not at 90 to each other, that l ~61925 is when ~1 and ~2 are not equal to 90 as shown in Figure 6, the measured signals are represented by Ul, U2, Vl and V2, which can be resolved in terms of the Xl, X2, Yl, and Y2 coordinates shown in Figure 6, where Ul and Xl are separated by the angle al; U2 and X2 by the angle a2; Vl and Yl by the angle ~1; and V2 and Y2 by the angle ~2. This conversion may be accomplished as shown in Figure 7 using equations:
x = a cosà
a = u - b b = e sina y = e + c > ,~, c = a sina ~9) f cos~ = V
j cos~ = x j sin~ = g ~g + f = Y ~
which result in the matrix expression:
-sina cosa l~l = sina __ ~ l (10) cos~
For the specific case of Xl, Yl the matrix expression appears as:
sinalcos(x 1 ~ n~; 1 l (Il) and for X2, Y2 the matrix expression appears as:
- "- J1$1925 I' 1 sincl2cosc~2 ~ .
~ X2 ~ U5~2 ~ D2 These two expressions (11) and (12) are combined to produce:
¦ Yl ¦ sinc~ O 1 ~I I
~ = sinQl2cosa X2~ I C5~2 ~U2~
2, 0 sin~2 cosB 2 which when rearranged to present Xl, X2, Yl, Y2 in the desired order, appears as:
` Sin~lCs~l _ /
Xl 1 cosBI U
Sin~2CoS~21 X2 ~ = cos2~ C05~2-cos~2 ' IVl ~ ~14) Yl 1 cosBI cos2c~2 ~ ~
2 2C5~2 J~2) 1 16~925 Expression (14) may now be simply state~:
Xl = ~Ul ~15) Since we know from expression (7) that X = ~Xl, we can substitute in expres-sion (15) to arrive at expression (16)j which fully expanded appears as e~pression ~17).
X = Aæul ~16) L L sinal 5~1 L L n~2 2 X ~ (S) CS~ S) ~ s-)coscc2~ ~l-S~ Ul ~
(S) 1 ~S) cos~ (1 L)sina (1 L) 2 Vl ¦
QX¦ (1) sin~ (1) cos ~1 (S) sin~2 (S) cos~ 1 U2 l (1)(1 C~l_ C~ (1 nc~2cosc~2 J cos~l cos~2 - ~v2 A computer circuit which implements this statement includes a plurality of multiplier circuits 130 through 160, Figure 8, which multiply the measured displacement signals Ul, Vl, U2, and V2, by the various factors shown in terms of the dimensions L, S, and the angles ~ and ~, and are then combined in the combinations shown in summer circuits 162, 164, 166, and 168, to provide the actual displacements X, Y, ~X~ and 3y~
In a similar manner, in the case where there are four translational displacement sensors providing four measured signals Ul, U2, Vl, and V2, but none of the sensors are in the same plane nor aligned with each other, as 1 ~19~
shown in Figure 9, the measured signals Ul, U2, Vl, V2 may be resolved into the desired X, YJ ~X~ ~Y components, as shown by ~he following expressions:
l ( ~l)X + ~sin~l)Y - ~Slsin~ x ~ (slcos~ y (18) 2 ~ ~l)X ~Sin~l)Y - ~Llsln~l)ox + ~Llcos~ Y ~19) Vl ~ ~cos~2)X + (sin~2)Y - ~S2sin~2)~x ~ ~S2cs 2) Y ~20) V2 ~ (cos~2)X + (sin~2)Y - (L2Sin~2)~x ( 2 2 Y (21) These expressions may be placed in matrix form, lrul~ COSC~l sinal -Slsin~l Slcosc~l ' f x ) U2l cos~l sin~l -Llsin~l Llcos~l J ~ ~22) cosa2 sinc~2 -S2sinc~2 S2coso~2 ; X
2J cos~2 sin~2 -L2sin~2 L2cos~2 l J
and then inverted in the usual way, ~ X l Mll ~12 M13 14 l Ul : Jl ~ M21 M22 M23 24 ~ U2 ~ ~23) ~X ~ M31 M32 M33 ~34 Vl M4l M42 M43 M44 2 ¦
to obtain the terms which define the multiplier factors that are implemented in multiplier circuits 180 - 210 in the computer circui~, Figure 11.
The outputs of circuits 180-210 are combined in the groups shown in summer circuits 212, 214, 216, and 218, to provide directly the X, Y, and ~X' displacements.
Although thus far the illustrations have used four translational displacement sensors to sense four degrees of freedom, this is not a neces-sary limitation of the invention, as fewer or more sensors may be used to monitor fewer or more degrees of freedom. For example, a fifth sensor 220, Figure 10, may be added to produce a ~ displacement signal which senses rota-tion about the Z axis, axis 17, of the operator member. Sensor 220 is placed 1 161~5 parallel to sensor 78 in order to sense the rotation about Z axis 17. To effect this, a non-circular member with some sort of camming surface 222 is used in conjunction with sensor 220 to detect the rotation. Alternatively, sensor 220 might be placed elsewhere.
With five degrees of freedom being sensed by five sensors, the four expressions (18) - (21) would be expanded to include a fifth equation, and there would be a fifth column and fifth row added to the matrices in expres-sions (22) and (23), while the implementation shown in Figure 11 would be expanded by the addition of one more multiplier circuit associated wi-th each of the measured ;nput signals Ul, U2, Vl, V2, and also the addition of a fifth input, for example ~z.
Alternatively, a calibration technique may be used to veri`~y the multiplier factors in the computer circuit which resolves the measured dis-placement signals obtained from an instrumented RCC into the actual displace-ments of the operator member and body of the RCC relative to each other.
First the instrumented RCC is fixed so that each degree of freedom, for ex-ample, X, Y, 3X~ ~y~ and ~z, can be varied independently while all the others remain fixed or at zero displacement. This may be stated in matrix form as:
~ ul~ 11 N12 N13 N14 N15 ~X l 20l U2l N21 N22 N23 N24 N25 ~ I
3 ~ 31 N32 N33 N34 N35 ~ ~X ~(24) ~ u5J N51 N52 N53 N5~ N55 ~Zl The U terms are the sensor outputs. If X is displaced a known amount Xl, not equal to zero, and all remaining possible displacements, Y~X~ ~y~ ~z, are held at zero, the result may be expressed:
.
l ~61925 lll = NllXl ~25) U2 = N21Xl (26) U3 = N31Xl (27) U4 = N41Xl (28) U5 N51Xl (29) and since the measured values Ul 5 are known and the displacemen~ Xl is known, this set of equations may be transformed into:
Ul (30) N
Xl U2 (31) N
Xl u3 (32) Xl U4 (33) Xl U5 (34) N - X
In a similar fashion, with Y set equal to Yl, not equal to zero, and the remaining terms X, ~X~ ~y~ ~z all set at zero, the same action may be taken to obtain the numerical values for the second column of the matrix of expression 24. When this is done, with all the numerical values in place in the matrix of expression (24), a simple matrix inversion results in:
.
1 1619~5 I'x ¦ 11 M12 M13 M14 M15~ Ul 1 ¦ Y ¦ 21 M22 M23 M24 M25¦ ~J2 ¦
X ~= 31 M32 M33 M34M35 ~ U3 1 ~ (35) ¦~Y 41 M42 M43 M44 M45l U4 51 M52 M53 M54 M55l U5_ where each of the M values in each row and column of the matrix is a numerical value and may be directly inserted in the multiplier circuits 250-298, Figure 12, which are combined as shown in summing circuits 300, 302, 304, 306, and 308 to provide the actual displacements X, Y, ~X~ Y~ ~Z
An even simplier implementation occurs with the RCC of Uni~ed States Patent No. 4,098,001, as shown in Figure 13. In such a device, operating member 16' typically is supported by a member 310, which in turn is supported by an intermediate device 312 by means of a number, typically three, flexures 314, 316, only two of which are shown, which converge toward each other and meet at a point 70' which generally establishes the remote compliance center along the axis 17' of operator member 16'. Flexures 314, 316 are in turn fastened to intermediate member 312, which is attached ~o a support 318 by means of typically three additional flexures 320, 322, only two of which are shown. Typically flexures 320, 322 control only translational motion, while flexures 314, 316 independently provide the rotational flexibility for the instrument. In this case a single translational displacement sensor 330, located as shown between support 318 and intermediate member 312, provides the signal X'2, which is indicative of motion along the X axis. Motion about the Y axis is indicated by the measured signal X'l obtainable from transla-tional displacement sensors 332, or from X"l, obtainable from sensor 334.
Similar signals Y'l, Y"l, and Y'2 are obtained in the same way with respect `-` l 1~192~
- to the Y axis translational and X axis rotational displacements. Because of this independent action in the translational and rotational motion modes in RCC 10', the actual displacement along the X axis, X, is equal to the measured value X'2, X = X'2 (36) and similarly the displacement along the Y axis is equal to the measured dis-placement Y'2:
Y 2 (37) Rotational motion about the X axis, ~X' is either:
1 (38) ~3x =
or:
1 ~39) ~X
Similarly, ~y is either:
X'l (40) ~)y = -- .
or:
X"l ~41) Y S
Thus the computing circuit implementation to resolve the X'l, Y'l, X'2, and Y'2 measured displacements into the actual displacements ~yJ ~X~ X1 and Y, may be simple: direct connections 350, 352, to resolve the X'2 and Y'2 signals into X and Y displacements. Multiplier circuit 354 multiplies X'l signal by a factor of (l/L) to obtain ~y~ and multiplier circuit 356 multiplies Y'l dis-placement signal by a factor of (-l/L) to obtain ~X
Similarly, using the combination X'2, Y'2, and X"l,, and Y"l, only 11 ~6~92~
multiplier circuits 355, providing a factor of (l/S), and multiplier cir-cuit 360, providing a factor of (-l/S), are necessary to complete the compu-ting circuit 10. As in Figure 14, X'2 and Y'2 directly provide the X and Y
displacements.
.
l ~61925 lll = NllXl ~25) U2 = N21Xl (26) U3 = N31Xl (27) U4 = N41Xl (28) U5 N51Xl (29) and since the measured values Ul 5 are known and the displacemen~ Xl is known, this set of equations may be transformed into:
Ul (30) N
Xl U2 (31) N
Xl u3 (32) Xl U4 (33) Xl U5 (34) N - X
In a similar fashion, with Y set equal to Yl, not equal to zero, and the remaining terms X, ~X~ ~y~ ~z all set at zero, the same action may be taken to obtain the numerical values for the second column of the matrix of expression 24. When this is done, with all the numerical values in place in the matrix of expression (24), a simple matrix inversion results in:
.
1 1619~5 I'x ¦ 11 M12 M13 M14 M15~ Ul 1 ¦ Y ¦ 21 M22 M23 M24 M25¦ ~J2 ¦
X ~= 31 M32 M33 M34M35 ~ U3 1 ~ (35) ¦~Y 41 M42 M43 M44 M45l U4 51 M52 M53 M54 M55l U5_ where each of the M values in each row and column of the matrix is a numerical value and may be directly inserted in the multiplier circuits 250-298, Figure 12, which are combined as shown in summing circuits 300, 302, 304, 306, and 308 to provide the actual displacements X, Y, ~X~ Y~ ~Z
An even simplier implementation occurs with the RCC of Uni~ed States Patent No. 4,098,001, as shown in Figure 13. In such a device, operating member 16' typically is supported by a member 310, which in turn is supported by an intermediate device 312 by means of a number, typically three, flexures 314, 316, only two of which are shown, which converge toward each other and meet at a point 70' which generally establishes the remote compliance center along the axis 17' of operator member 16'. Flexures 314, 316 are in turn fastened to intermediate member 312, which is attached ~o a support 318 by means of typically three additional flexures 320, 322, only two of which are shown. Typically flexures 320, 322 control only translational motion, while flexures 314, 316 independently provide the rotational flexibility for the instrument. In this case a single translational displacement sensor 330, located as shown between support 318 and intermediate member 312, provides the signal X'2, which is indicative of motion along the X axis. Motion about the Y axis is indicated by the measured signal X'l obtainable from transla-tional displacement sensors 332, or from X"l, obtainable from sensor 334.
Similar signals Y'l, Y"l, and Y'2 are obtained in the same way with respect `-` l 1~192~
- to the Y axis translational and X axis rotational displacements. Because of this independent action in the translational and rotational motion modes in RCC 10', the actual displacement along the X axis, X, is equal to the measured value X'2, X = X'2 (36) and similarly the displacement along the Y axis is equal to the measured dis-placement Y'2:
Y 2 (37) Rotational motion about the X axis, ~X' is either:
1 (38) ~3x =
or:
1 ~39) ~X
Similarly, ~y is either:
X'l (40) ~)y = -- .
or:
X"l ~41) Y S
Thus the computing circuit implementation to resolve the X'l, Y'l, X'2, and Y'2 measured displacements into the actual displacements ~yJ ~X~ X1 and Y, may be simple: direct connections 350, 352, to resolve the X'2 and Y'2 signals into X and Y displacements. Multiplier circuit 354 multiplies X'l signal by a factor of (l/L) to obtain ~y~ and multiplier circuit 356 multiplies Y'l dis-placement signal by a factor of (-l/L) to obtain ~X
Similarly, using the combination X'2, Y'2, and X"l,, and Y"l, only 11 ~6~92~
multiplier circuits 355, providing a factor of (l/S), and multiplier cir-cuit 360, providing a factor of (-l/S), are necessary to complete the compu-ting circuit 10. As in Figure 14, X'2 and Y'2 directly provide the X and Y
displacements.
Claims (12)
PROPERTY OR PRIVILEGE IS CLAIMED ARE DEFINED AS FOLLOWS:
1. A remote center compliance device having an elongate operator mem-ber and a remote compliance center near an end of the operator member, the device also comprising:
first and second translational displacement sensors spaced from said operator member for sensing translational displacements thereof, said first and second sensors being disposed to one another at a first angle about the longitudinal axis of said operator member; and third and fourth transla-tional displacement sensors spaced from said operator member for sensing other translational displacements thereof, said third and fourth sensors being spaced from said first and second sensors along the longitudinal axis of said operator member and disposed to each other at a second angle about the long-itudinal axis of said operator member, said sensors being disposed to produce an output from at least one sensor for any displacement relative to radial axes of said operator member.
first and second translational displacement sensors spaced from said operator member for sensing translational displacements thereof, said first and second sensors being disposed to one another at a first angle about the longitudinal axis of said operator member; and third and fourth transla-tional displacement sensors spaced from said operator member for sensing other translational displacements thereof, said third and fourth sensors being spaced from said first and second sensors along the longitudinal axis of said operator member and disposed to each other at a second angle about the long-itudinal axis of said operator member, said sensors being disposed to produce an output from at least one sensor for any displacement relative to radial axes of said operator member.
2. A remote center compliance device having an elongate operator mem-ber and a remote compliance center near an end of the operator member, the device also comprising:
first and second translational displacement sensors spaced from said operator member for sensing translational displacements thereof, said first and second sensors being disposed to one another at a first angle about the longitudinal axis of said operator member; third and fourth translational displacement sensors spaced from said operator member for sensing other trans-lational displacements thereof, said third and fourth sensors being spaced from said first and second sensors along the longitudinal axis of said opera-tor member and disposed to each other at a second angle about the longitudinal axis of said operator member; and a fifth sensor, spaced from each of the other four sensors, said sensors being disposed to produce an output from at least one sensor for any displacement of said operator member.
first and second translational displacement sensors spaced from said operator member for sensing translational displacements thereof, said first and second sensors being disposed to one another at a first angle about the longitudinal axis of said operator member; third and fourth translational displacement sensors spaced from said operator member for sensing other trans-lational displacements thereof, said third and fourth sensors being spaced from said first and second sensors along the longitudinal axis of said opera-tor member and disposed to each other at a second angle about the longitudinal axis of said operator member; and a fifth sensor, spaced from each of the other four sensors, said sensors being disposed to produce an output from at least one sensor for any displacement of said operator member.
3. The device of claim 1 or 2 in which said first and second sensors are in a first plane perpendicular to the longitudinal axis and said third and fourth sensors are in a second plane perpendicular to the longitudinal axis.
4. The device of claim 1 in which said first and second angles are equal.
5. The device of claim 4 in which said first and second angles are 90°.
6. The device of claim 4 in which said first and third and second and fourth sensors are aligned in planes through the longitudinal axis.
7. The device of claim 1 further including:
means for solving the equation X = ?AX1, where ?A is a transfer mat-rix relating the translational displacement sensor output signals to displace-ments applied to the remote center compliance device which produces those output signals, X1 is a vector whose elements are the outputs of the sensors, for determining X, a vector whose elements are the components of the displace-ments applied to the device.
means for solving the equation X = ?AX1, where ?A is a transfer mat-rix relating the translational displacement sensor output signals to displace-ments applied to the remote center compliance device which produces those output signals, X1 is a vector whose elements are the outputs of the sensors, for determining X, a vector whose elements are the components of the displace-ments applied to the device.
8. A method of measuring an unknown displacement on the operator mem-ber of a remote center compliance device having a remote compliance center near the end of the operator member comprising:
disposing one or more translational displacement sensors about said device for producing output signals representative of displacements of said operator member; applying known displacements to said operator member, so that there exists no sensed displacement which cannot be expressed in terms of one or more applied displacements; measuring each of the output signals produced by each of the sensors in response to the applied displacements;
calculating a transfer matrix ?D defined by the equation X1 =?DX as determin-ed by the applied displacements and the corresponding sensor output signals, where X is a vector whose elements are the components of the applied dis-placements and X1 is a vector whose elements are the outputs of the sensors;
applying an unknown displacement to the operator member; measuring each of the output signals from each sensor in response to the unknown displacement;
calculating the unknown displacement by solving the equation X = ?X1, where X1 is a vector whose elements are the sensor outputs in response to the un-known displacement and X is a vector whose elements are the components of the unknown displacement.
disposing one or more translational displacement sensors about said device for producing output signals representative of displacements of said operator member; applying known displacements to said operator member, so that there exists no sensed displacement which cannot be expressed in terms of one or more applied displacements; measuring each of the output signals produced by each of the sensors in response to the applied displacements;
calculating a transfer matrix ?D defined by the equation X1 =?DX as determin-ed by the applied displacements and the corresponding sensor output signals, where X is a vector whose elements are the components of the applied dis-placements and X1 is a vector whose elements are the outputs of the sensors;
applying an unknown displacement to the operator member; measuring each of the output signals from each sensor in response to the unknown displacement;
calculating the unknown displacement by solving the equation X = ?X1, where X1 is a vector whose elements are the sensor outputs in response to the un-known displacement and X is a vector whose elements are the components of the unknown displacement.
9. A method of calibrating displacements of an operator member of an instrumented remote center compliance device having a remote compliance center near the end of the operator member, and having one or more transla-tional displacement sensors about the device for producing signals represen-tative of displacement of the operator member comprising:
applying known displacements to said operator member so that there exists no sensed displacement which cannot be expressed in terms of one or more applied displacements; measuring each of the output signals produced by each of the sensors in response to the applied displacements; and calcu-lating a transfer matrix ?D defined by the equation X1 = ?DX as determined by the applied displacements and the corresponding sensor output signals, where X is a vector whose elements are the components of the applied displacements, and X1 is a vector whose elements are the outputs of the sensors.
applying known displacements to said operator member so that there exists no sensed displacement which cannot be expressed in terms of one or more applied displacements; measuring each of the output signals produced by each of the sensors in response to the applied displacements; and calcu-lating a transfer matrix ?D defined by the equation X1 = ?DX as determined by the applied displacements and the corresponding sensor output signals, where X is a vector whose elements are the components of the applied displacements, and X1 is a vector whose elements are the outputs of the sensors.
10. A remote center compliance device having an operator member and a remote compliance center near the end of said operator member, the device further comprising: one or more translational displacement sensors located proximate said operator member, said sensors being arranged to produce a change in output from at least one of said sensors in response to both trans-lational and angular displacements relative to a radial axis of said operator member.
11. A remote center compliance device having an operator member and a remote center compliance center near the end of said operator member, the device further comprising: one or more translational displacement sensors located proximate said operator member, said sensors being arranged to produce a change in output from at least one of said sensors in response to both translational and angular displacements of said operator member.
12. A remote center compliance device having an operator member and a remote compliance center near the end of said operator member, the device further comprising: one or more translational displacement sensors, located proximate said operator member, said sensors being arranged to produce a change in output from at least one of said sensors in response to both trans-lational and angular displacements relative to radial axes of said operator member; and means for solving the equation X = ?AX1, where ?A is a transfer matrix relating the displacement sensor output signals to displacements applied to the remote center compliance device which produces those output signals, X1 is a vector whose elements are the outputs of the sensors, for determining X, a vector whose elements are the components of the displacements applied to the device.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US7690679A | 1979-09-19 | 1979-09-19 | |
US076,906 | 1979-09-19 |
Publications (1)
Publication Number | Publication Date |
---|---|
CA1161925A true CA1161925A (en) | 1984-02-07 |
Family
ID=22134898
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CA000360624A Expired CA1161925A (en) | 1979-09-19 | 1980-09-19 | Instrumented remote center compliance device |
Country Status (6)
Country | Link |
---|---|
JP (1) | JPS5696206A (en) |
CA (1) | CA1161925A (en) |
DE (1) | DE3035838A1 (en) |
FR (1) | FR2465996B1 (en) |
GB (3) | GB2080523B (en) |
IT (1) | IT1132981B (en) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4440031A (en) * | 1981-07-31 | 1984-04-03 | The Charles Stark Draper Laboratory | Force detecting system for remote center compliance device |
US4409736A (en) * | 1981-07-31 | 1983-10-18 | The Charles Stark Draper Laboratory, Inc. | Null seeking system for remote center compliance device |
JPS6186606A (en) * | 1984-10-05 | 1986-05-02 | Hitachi Ltd | Configuration measuring method without contact |
GB2180117B (en) * | 1985-09-05 | 1989-09-06 | Ferranti Plc | Three-dimensional position measuring apparatus |
GB2191859B (en) * | 1986-05-16 | 1990-10-10 | Qubit Int Sa | Navigation aids |
DE4331230B4 (en) * | 1993-09-15 | 2008-04-17 | Diehl Aerospace Gmbh | Control lever device for adjusting the thrust of airplanes |
EP1867429B1 (en) * | 2006-06-16 | 2011-04-20 | Joo, Sang-wan | Remote center compliance device with measuring sensor |
JP5201888B2 (en) * | 2006-06-22 | 2013-06-05 | ジュー,サン−ワン | Elastic center device composed of one elastic body |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3481577A (en) * | 1966-11-03 | 1969-12-02 | True Trace Corp | Stylus steering system for a tracer valve |
GB1211418A (en) * | 1967-11-27 | 1970-11-04 | Ikegai Iron Works Ltd | An automatic tool position compensating system for a numerically controlled machine tool |
CH549438A (en) * | 1971-03-01 | 1974-05-31 | Far Fab Assortiments Reunies | DEVICE FOR SIMULTANEOUS TRANSMISSION OF THE MOVEMENTS OF A PROBE TO AT LEAST TWO READING ORGANS. |
DE2242355C2 (en) * | 1972-08-29 | 1974-10-17 | Fa. Carl Zeiss, 7920 Heidenheim | Electronic multi-coordinate probe |
US4030201A (en) * | 1973-04-19 | 1977-06-21 | Finike Italiana Marposs-Soc. In Accomandita Semplice Di Mario Possati & C. | Method and relevant apparatus for detecting the geometrical features of mechanical workpieces, in particular for measuring the eccentricity and out-of-roundness |
US3921445A (en) * | 1973-10-15 | 1975-11-25 | Stanford Research Inst | Force and torque sensing method and means for manipulators and the like |
JPS5435355B2 (en) * | 1974-12-04 | 1979-11-01 | ||
US4098001A (en) | 1976-10-13 | 1978-07-04 | The Charles Stark Draper Laboratory, Inc. | Remote center compliance system |
US4155169A (en) | 1978-03-16 | 1979-05-22 | The Charles Stark Draper Laboratory, Inc. | Compliant assembly system device |
-
1980
- 1980-09-16 GB GB8127834A patent/GB2080523B/en not_active Expired
- 1980-09-16 GB GB8029878A patent/GB2060167B/en not_active Expired
- 1980-09-16 GB GB8127833A patent/GB2080522B/en not_active Expired
- 1980-09-18 FR FR8020124A patent/FR2465996B1/en not_active Expired
- 1980-09-19 DE DE19803035838 patent/DE3035838A1/en not_active Ceased
- 1980-09-19 IT IT24777/80A patent/IT1132981B/en active
- 1980-09-19 JP JP13055580A patent/JPS5696206A/en active Granted
- 1980-09-19 CA CA000360624A patent/CA1161925A/en not_active Expired
Also Published As
Publication number | Publication date |
---|---|
GB2080522B (en) | 1983-10-12 |
GB2060167A (en) | 1981-04-29 |
IT8024777A0 (en) | 1980-09-19 |
GB2080523A (en) | 1982-02-03 |
JPH0323842B2 (en) | 1991-03-29 |
JPS5696206A (en) | 1981-08-04 |
DE3035838A1 (en) | 1981-04-30 |
GB2080522A (en) | 1982-02-03 |
GB2060167B (en) | 1983-10-12 |
IT1132981B (en) | 1986-07-09 |
GB2080523B (en) | 1983-10-12 |
FR2465996B1 (en) | 1985-10-11 |
FR2465996A1 (en) | 1981-03-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4316329A (en) | Instrumented remote center compliance device | |
US3948093A (en) | Six degree of freedom force transducer for a manipulator system | |
US4132318A (en) | Asymmetric six-degree-of-freedom force-transducer system for a computer-controlled manipulator system | |
US5794356A (en) | Three dimensional coordinate measuring apparatus | |
US4676002A (en) | Mechanisms to determine position and orientation in space | |
US4819195A (en) | Method for calibrating a coordinate measuring machine and the like and system therefor | |
US20030070311A1 (en) | Six degrees of freedom precision measuring system | |
Renders et al. | Kinematic calibration and geometrical parameter identification for robots. | |
Lenz et al. | Calibrating a cartesian robot with eye-on-hand configuration independent of eye-to-hand relationship | |
EP1809446B1 (en) | Method and system to provide imporved accuracies in multi-jointed robots through kinematic robot model parameters determination | |
US5222400A (en) | Force and torque converter | |
EP0225588A2 (en) | Micropositioning apparatus for a robotic arm | |
CA1161925A (en) | Instrumented remote center compliance device | |
GB2341203A (en) | Flat web coupler for coordinate measurement systems | |
Jiang et al. | A review of recent developments in robot metrology | |
Zhang et al. | A six-dimensional traction force sensor used for human-robot collaboration | |
CA1336532C (en) | Probe motion guiding device, position sensing apparatus and position sensing method | |
EP2050534B1 (en) | Method for checking a rotary axis with a self-centring sensing device | |
US4440031A (en) | Force detecting system for remote center compliance device | |
Mandel et al. | On-line compensation of mobile robot docking errors | |
Kim et al. | Displacement sensor integrated into a remote center compliance device for a robotic assembly | |
EP0227432B1 (en) | Force and torque converter | |
Podoloff et al. | An accuracy test procedure for robotic manipulators utilizing a vision based, 3-D position sensing system | |
Vira | Spherical coordinate automatic measurement (SCAM) system for robots' end-point sensing | |
CA1292661C (en) | Force and torque converter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MKEX | Expiry |