MULTIDIMENSIONAL RESONANT FORCE SENSOR
20170276559 · 2017-09-28
Inventors
- Davinson CASTANO CANO (ANTONY, FR)
- Mathieu GROSSARD (VERRIERES LE BUISSON, FR)
- Arnaud HUBERT (COMPIEGNE, FR)
Cpc classification
G01L1/183
PHYSICS
International classification
Abstract
A resonant sensor comprises a proof body subjected to a torque of forces produced by an external mechanical structure, the body comprising: a first and a second interface that can each come into contact with the structure; at least two sensitive zones arranged between these two interfaces; a sensitive zone formed by a plate embedded in a frame secured mechanically to the interfaces, the plate able to resonate under the effect of local mechanical excitations produced at particular points by excitation transducers bearing the plate at several resonant frequencies, sensors picking up the resonant signals produced at the particular points, measurement means measuring the resonant frequency shifts of signals which are linear combinations of the resonant signals picked up, the shifts being a function of mechanical stresses induced by the forces and transmitted to the plate by the frame, the components of the torque of forces being determined from the resonant frequency shifts measured on the plates of the sensitive zones.
Claims
1. A resonant force sensor, comprising a proof body that can be subjected to a torque of forces produced by an external mechanical structure, said body comprising at least: a first interface and a second interface that can each come into contact with said structure; at least two sensitive zones each arranged between these two interfaces; a sensitive zone being formed by a plate embedded in a frame secured mechanically to said interfaces, said plate being able to resonate under the effect of local mechanical excitations produced at particular points by excitation transducers bearing said plate at several resonant frequencies, sensors picking up the resonant signals produced at said particular points, measurement means measuring the resonant frequency shifts of signals which are linear combinations of the resonant signals picked up, said shifts being a function of mechanical stresses induced by said forces and transmitted to said plate by said frame, the components of said torque of forces being determined from the resonant frequency shifts measured on the plates of said sensitive zones.
2. The sensor as claimed in claim 1, wherein said excitations are produced simultaneously.
3. The sensor as claimed in claim 1, wherein said particular points are situated on vibratory mode nodal lines so as to make it possible to select particular mode resonant frequencies by said combinations.
4. The sensor as claimed in claim 1, wherein the combination of said frequencies is an addition or subtraction operation.
5. The force sensor as claimed in claim 1, wherein each plate having a dimension according to an x axis and a dimension according to a y axis, it comprises four particular excitation points, a North point and a South point being situated on the axis of symmetry of said plate according to y, and a West point and an East point being situated on the axis of symmetry according to x, said North and South and West and East points being situated symmetrically relative to the intersection of the two axes of symmetry.
6. The sensor as claimed in claim 5, wherein three resonant frequencies of three vibratory modes are selected, a frequency of a first mode being selected by adding the resonant frequencies of the North point and of the South point and/or of the West point and of the East point, a frequency of a second mode being selected by performing a subtraction between the measurement of the North point and the measurement of the South point, and a third frequency of a third mode being selected by performing a subtraction between the measurement of the West point and the measurement of the East point.
7. The sensor as claimed in claim 1, wherein the shift measurements are performed by phase-locked loop circuits whose output signal controls a transducer.
8. The sensor as claimed in claim 1, wherein said transducers are of piezoelectric type.
9. The sensor as claimed in claim 1, wherein the sensors are of piezoelectric type, each fixed facing a transducer on the other side of the face of said plate, the signals produced being the charge signals of said sensors of piezoelectric type.
10. The sensor as claimed in claim 1, wherein said proof body is monolithic.
11. The sensor as claimed in claim 1, wherein said sensitive zones form a non-zero angle with said interfaces giving said proof body a pyramidal appearance.
12. The sensor as claimed in claim 1, wherein said zones form a zero angle with said interfaces, giving said proof body a flattened appearance.
13. The sensor as claimed in claim 1, wherein the geometry of said proof body is invariant according to the angle separating the central points of two sensitive zones.
14. The sensor as claimed in claim 1, wherein the sensitive plate is placed outside of the neutral axis of the assembly formed by the frame and said plate.
15. The sensor as claimed in claim 1, comprising a protective jacket covering said proof body.
Description
[0025] Other advantages and features of the invention will become apparent from the following description, given in light of the attached drawings which represent:
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0042] These sensitive zones 1 are secured mechanically to the interfaces 2, 3 so as to form therewith a rigid assembly 10. In a preferred embodiment, the proof body 10 can be monolithic, the sensitive zones and the interfaces being formed in a single block. This block can be made of aluminum or of stainless steel, other materials being of course possible provided that they have the appropriate mechanical properties.
[0043] The contact face of the interfaces 2, 3 is preferably planar in order to obtain the best contact with the external mechanical structure.
[0044] The interfaces 2, 3 for example have holes, tapped or not, to allow the sensor to be fixed to this structure.
[0045]
[0046] In the example of
[0047] One of the downstream 12 and upstream 13 parts of the jacket 11 can take the form of a cap covering the interface 2, 3 that it protects, the jacket 11 then consisting of a jacket and a cap. Other forms and types of protective jacket are possible, provided that they protect the components of the sensor and allow a reliable transmission of the forces produced by the external structure. It is also possible to provide embodiments without a protective jacket.
[0048]
[0049] A sensitive zone 1 is formed by a plate 21 embedded in a frame 22, this plate being able to vibrate under the effect of local mechanical excitations.
[0050] More specifically, the plate 21 is made to vibrate by local excitations produced by transducers that are not represented. These transducers, which are for example piezoelectric patches, provoke transverse vibrations in the plate. Hereinbelow, transducers of piezoelectric type will be used by way of example.
[0051] Through these transverse vibrations, the plate can enter into mechanical resonance according to the three axes of spaces x, y, z in which the axes x and y are in the plane of the plate and the axis z is at right angles to this plane.
[0052] The frame 22 is fixed at its two ends to the interfaces 2, 3. The mechanical link between an end of the frame and an interface is made not over the entire width of the frame but only over a part 23, 24 of the width.
[0053] The frames are arranged regularly around the axis 20 of the proof body 10. The structure or geometry thereof is moreover such that it is invariant by 120° rotation, more generally it is invariant according to the angle separating the central points of two sensitive zones.
[0054] The force torque produced by the external mechanical structure, that is to say the force to be measured, is assumed to be localized at a point A of intersection of the axis of the body with the downstream interface. This force torque will hereinbelow be denoted , called force or force torque without preference.
[0055] This torque =[F.sub.x, F.sub.y, F.sub.z, M.sub.x, M.sub.y, M.sub.z] is made up of three force components F.sub.x, F.sub.y, F.sub.z, and three torque components M.sub.x, M.sub.y, M.sub.z.
[0056] The structure of the proof body as shown by
[0057] The measurement of the force torque is based on the use of the vibrating plates 21 whose frequencies and modal deformations are sensitive to the external forces. In effect, when a quasi-static force is applied to the point A of the proof body, it provokes a prestress
to all of the structure of the proof body. In particular, this prestress
is transmitted to each resonant plate 21. The principle of operation of the sensor lies in the fact that the natural frequencies and the modal deformations of each vibrating plate are greatly dependent on their limiting conditions, in terms of force and of displacement. The mechanical properties of the plates, in apparent rigidity terms, are in fact altered by this prestress notably provoking a modification of the natural frequency, or resonant frequency. Thus, after a sensor calibration step, the measurements of natural frequency shift of each plate 21, due to the force
, make it possible to estimate this force in all its dimensions as demonstrated hereinbelow in this description.
[0058]
[0059] and passes into a state
. In this new state, corresponding to an operational phase, the excitation F.sup.exc is applied. This excitation makes the body 31 resonate V(t), the resonant frequency being shifted because of the prestress
applied. In other words, the resonant frequency is shifted relative to a state without prestress.
[0060] Two types of forces are to be taken into account in this particular case, these forces being characterized by their frequency bands which are very far apart from one another: [0061] The excitation force F.sup.exc is at high frequencies, it is created by the excitation produced by the piezoelectric elements which make the body 31 resonate with resonances, the plates 21 in the case of the present invention. The resonances can be obtained by the application of an electrical potential (I) at the terminals of the piezoelectric elements; [0062] The forces to be measured are at a relatively low frequency. The relationship between these forces and the resonant frequency shift are due to the prestressing. In the case of a robotics application for example, the frequency band of the prestressing
is very far below the resonant frequencies of the body 31 like plates 21. The prestressing can therefore be considered as quasi-static.
[0063] By using Freq (σ) to denote the prestressing frequency and Freq (F.sup.exc) to denote the frequency of the excitation force, this gives: Freq (σ)<<Freq (F.sup.exc).
[0064] A dynamic model of a vibrating plate is notably described in the document by D. Castano-Cano, M. Grossard and A. Hubert: “Multi-axis Force Sensing with Pre-stressed Resonant Composite Plates: An Alternative to Strain Gauge Force Sensors”, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), Besançn, France, Jul. 8-11, 2014. This model is defined by the following relationship:
in which [M] is the weight matrix and [K] the stiffness matrix, U is the displacement of a node of a meshed structure, φ is the electrical potential at the terminals of the electrodes of a piezoelectric element, F.sup.exc is the excitation force which produces the vibrations of the plate and Q is the electrical charge on the electrodes of the piezoelectric element.
[0065] The weight matrix and the stiffness matrix are defined by the following relationships:
in which [K.sub.UU] is the mechanical stiffness matrix, [K.sub.Uφ]=[K.sub.φU].sup.T is the electromechanical coupling matrix and [K.sub.φφ] is the capacitance matrix. The stiffness matrix [K] also comprises the matrix
which is me geometrical stiffness matrix which takes into account the force to be measured F via the induced prestress , as an apparent stiffness variation.
[0066] From the relationship (1), the resonant frequency is obtained by the calculation of [M].sup.−1 [K].
[0067]
[0068] Transducers are fixed onto the plate 21. The function of these transducers is to excite the plate 21 at particular points thereof. The transducers are therefore situated at these particular points. In a preferred implementation of the invention, the transducers are piezoelectric elements in the form of patches. Throughout the rest of the description, the transducers used will therefore be, by way of example, piezoelectric patches. In the example of
[0069] The frame 22 prevents the transmission of the high frequencies to the rest of the structure of the proof body and transmits to the plate 21 the effects of the prestress due to the external force, these effects being at low frequencies. In other words, the frame 22 acts as a filter for the high frequencies, when the resonant frequencies are produced on the plate 21, and at the same time makes it possible for the quasi-static force to be transmitted to this same plate.
[0070] An electrical potential (I) is applied to the electrodes of the piezoelectric patches 41, 42, 43, 44 of the top face to make the plate vibrate. The electrical charges Q are measured on the electrodes of the patches 41′, 42′, 43′, 44′ of the bottom face to obtain frequency domain signals and therefore measure the resonant frequency.
[0071]
[0072]
[0073] As will be shown hereinbelow, a sensitive element structure, as illustrated by
[0074] The capacity of a patch to monitor, or observe, a resonant frequency of the plate is directly linked to its relative placement in relation to each nodal line. The way in which the patches are positioned characterizes the modal controllability and observability of the plate. In particular, the placement of the patches on the nodal line of a selected resonant frequency causes them to be insensitive to the corresponding modes, and acts as a modal spatial filter.
[0075]
[0076] Conventionally, the patch 41 situated at the top of the view is called North patch. The two patches 43, 44 below are respectively called West patch and East patch in accordance with their position relative to the North patch, and the fourth patch 42 is called South patch. Only the excitation patches 41, 42, 43, 44 are represented, the observation patches 41′, 42′, 43′, 44′ being placed on the other face with the same orientation rules.
[0077] The North and South patches are placed on the axis of symmetry 62 according to y of the plate and the West and East patches are placed on the axis of symmetry 65 according to x. The North and South patches are placed symmetrically in relation to the intersection of the two axes 62, 65. The same applies for the West and East patches.
[0078] In this configuration, the North and South patches are centered on the nodal line 62 of the mode (2, j), the West and East patches are centered on two nodal lines 61, 63 of the mode (4, j), on each side of the preceding nodal line 62. The West and East patches are centered on the nodal line 65 of the mode (i, 2), the North and South patches are centered on two nodal lines 64, 66 of the mode (i, 4), on each side of the preceding line 65.
[0079] The configuration illustrated by
[0080] The description below will be given with this configuration, other configurations being possible.
[0081]
[0084] It could also be shown, likewise, that the modes with i=4 or j=4 are totally filtered.
[0085] The filtering is obtained by placing the patches on the nodal lines symmetrically, as illustrated by the example in
[0086] A placement of the piezoelectric patches, of the type of this example, making it possible to filter resonant frequencies provides advantages. That notably makes it possible to limit the electronic components for the signal processing.
[0087]
[0088]
[0089] For example, the simultaneous estimation of three force components .sub.x,
.sub.y,
.sub.z, necessitates measuring, at the same time, the frequency shifts of three resonant modes. This superimposing of the modes is implemented in a sensor according to the invention by using three sinusoidal signals centered on the selected resonant frequencies, which are applied to the different activation patches. The resonant frequencies used are for example those of three modes (1, 2), (1,3), (2, 1). The three excitations applied for example to the North (N.sup.u), West (W.sup.u) and South (S.sup.u) excitation patches can be described by the following set of relationships:
in which φ.sub.m.sup.X.sup.
[0090] The response of a plate 21 to this set of simultaneous excitations generates electrical charges on the electrodes of the observation patches. The signal from each electrode can be expressed as the superimposition of the contributions of all the excitation signals.
[0091] The overall charge Q.sup.X.sup.
Q.sup.X.sup.
[0092] The amplitude of the charge signal given by this relationship (4) exhibits a few properties based on the modal deformations: [0093] 1. When a patch X.sup.u,d is placed on a nodal line for a mode m, the result is that
[0095] By exploiting these two properties, control strategies can be implemented between the signals to extract a single modal component. These control strategies can be implemented simply by additions and subtractions as illustrated in
[0096]
[0097] The first line of table 91 shows the results of a first operation. This first operation produces the sum of the charge signal of the North patch N.sup.d and of the charge signal of the South patch S.sup.d, operation denoted N.sup.d+S.sup.d. Given the states of the patches symbolized by the different representations 212, 213, 221 and the preceding properties 1 and 2, it follows that only the mode (1, 3) is selected, the charge signal being equal to +2Q.sub.(1, 3). It is likewise shown that: [0098] The mode (1, 2) is selected by the operation N.sup.d−S.sup.d; [0099] The mode (1, 3) is also selected by the operation W.sup.d+E.sup.d; [0100] The mode (2, 1) is selected by the operation W.sup.d−E.sup.d;
note that the mode (1, 3) can be selected by two operations, N.sup.d+S.sup.d and W.sup.d+E.sup.d.
[0101] This redundancy can advantageously be used to check the validity of the measurement method, the two signals N.sup.d+S.sup.d and W.sup.d+E.sup.d having to be in phase opposition.
[0102] The signals at the outputs of the operations are connected to a PLL circuit of the type of
[0103]
[0104] Take the exemplary embodiment of a sensor in which the proof body 10 comprises three sensitive zones 1, therefore three plates 21 in accordance with
[0105] By considering that the resonant frequencies vary linearly as a function of the forces to be measured, the relationship between the frequency shifts and the force components to be measured, for the i.sup.th plate, is given by the following relationship:
{Δf.sub.i}=[C].sub.i{} (6)
in which {} is a column matrix made up of the force components to be measured and [C].sub.i is the characteristic matrix of the i.sup.th plate:
[0106] The matrix [C].sub.i is a function of the vibratory modes (1, 2), (1, 3) and (2, 1).
[0107] To identify each component of the matrix [C].sub.i, an experimental calibration or calibration by simulation can be performed according to each of the three axes x, y and z. Each component according to x, y, and z of the force to be measured is then applied in succession. There are thus obtained, in succession, the components
[c.sub.(1,2),x.sup.i, c.sub.(2,1),x.sup.i, c.sub.(1,3),x.sup.i].sup.T;
[c.sub.(1,2),y.sup.i, c.sub.(2,1),y.sup.i, c.sub.(1,3),y.sup.i].sup.T;
and [c.sub.(1,2),z.sup.i, c.sub.(2,1),z.sup.i, c.sub.(1,3),z.sup.i].sup.T;
of the matrix [C].sub.i.
[0108] Thus, each column of the matrix is characterized separately.
[0109] To obtain all of the force components in all six dimensions, that is to say the three force components and the three torque components, the characteristic matrix of the proof body 10 is used. This characteristic matrix [C] of the proof body as a whole, taking into account all of the resonant plates 21, can be obtained from characteristic matrices [C].sub.i of each plate.
[0110] From this matrix [C] it is possible to obtain all of the components according to the following relationship:
{Δf}=[C]{} (7)
in which {Δf} is the column matrix made up of the frequency shifts measured on all the plates, in accordance with }, whose components are the force components to be measured. The sensor according to the invention comprises computation means making it possible to extract the components of this vector. These computation means can be incorporated in the FPGA 100 or on a printed circuit for example comprising the FPGA 100, all types of appropriate layout being able to be used.
[0111] To obtain a force measurement according to all six dimensions, that is to say according to the three components of the forces and the three torque components, it is essential for the proof body 10 to include at least two resonant plates 21, each plate being able to supply three dimensions, by virtue of the fact that it exhibits several resonances for stresses in the three dimensions x, y, z.
[0112] In the present example in which the proof body comprises three plates, the matrix [C] is the transposed matrix of the three matrices [C], concatenated, i.e.:
[C]=[C.sub.1,C.sub.2,C.sub.3].sup.T (8)
[0113] The matrix {Δf} of the frequency shifts is the concatenation of the three column matrices Δf.sub.1, Δf.sub.2, Δf.sub.3 of the frequency shifts measured on the three plates.
[0114] In this example, the matrix [C] is not square but is of dimension 9×6, that is to say comprising 9 rows and 6 columns, the vector {Δf} having 9 components, which are the 9 measurements of shifts obtained on all of the three plates, and the vector {} is a vector having 6 components, which are the six force components.
[0115] It is therefore not possible to obtain the vector {} sought by a simple matrix inversion, the matrix [C] not being invertible.
[0116] Several solutions can be envisaged to extract this vector {}. It is in particular possible to use the pseudo-inverse matrix [C].sup.+ defined according to the following relationship:
[C]+=(C.sup.TC).sup.−1C.sup.T
C.sup.T being the transposed matrix of [C].
[0117] The vector {} sought is then obtained according to the following relationship:
{}=[C]+{Δf} (9)
[0118] In the present example, more frequency shift measurements are obtained than needed. In effect, 9 measurements are obtained for 6 components. However, this redundancy can advantageously be used to improve the numerical conditioning of the computation means.
[0119] The invention has been presented with a proof body 10 comprising three sensitive zones based on vibrating plates, it is possible to provide a greater number of sensitive zones, that is to say plates. The redundancy coefficient is thus increased.
[0120] The invention has also been presented by selecting the three vibratory modes (1, 2), (1, 3) and (2, 1). It is of course possible to select other modes, by placing the transducers and sensors at other points of the plate and by performing combinations other than the additions and subtractions of the example given here. More generally, it is possible to perform all linear combinations on the resonant signals picked up, the identity linear combination being of course possible.
[0121] A sensor according to the invention can of course be used in the field of robotics, for example for manipulator robotics arms interacting with an environment and driven forcewise using a multi-axial force sensor mounted at its end to control the force exerted at this end. It can also be applied for interactive robotics arms or those interacting with an operator, in a human/robot co-manipulation phase, to estimate the forces imparted by the operator to detect his or her movement intentions.
[0122] Advantageously, the invention goes far beyond this scope and can be used in other fields, notably industrial, for which force measurement is necessary. The dimensions of the sensor can be easily adapted to the ranges of forces involved.