DETERMINING THE POSITION OF A MOVABLE COMPONENT RELATIVE TO A STATIONARY COMPONENT
20230160721 · 2023-05-25
Assignee
Inventors
Cpc classification
H02K11/215
ELECTRICITY
G01D5/145
PHYSICS
G06F17/17
PHYSICS
International classification
G01D5/244
PHYSICS
G06F17/17
PHYSICS
H02K11/215
ELECTRICITY
H02P6/00
ELECTRICITY
Abstract
For determination of the position of a movable component with a plurality of position magnets relative to a stationary component with a plurality of position sensors, it is provided that the sensor responses are detected for a group of position sensors in the region of the movable component, sensor model responses of the group of position sensors are determined from a sensor model for a plurality of assumed different relative positions of the movable component relative to the stationary component, the sensor model responses are compared with the sensor responses and the assumed relative position with the smallest deviation between the sensor model responses and the sensor responses is used as the relative position of the movable component.
Claims
1. A method for determination of the position of at least one movable component relative to a stationary component, wherein an array of a plurality of position magnets with a pole pitch is arranged on the movable component and an arrangement with a plurality of position sensors with a sensor pitch is arranged on the stationary component, wherein with a position sensor, a magnetic field of a position magnet in the region of this position sensor is detected in the form of a sensor response, wherein the sensor responses are detected for a group of a plurality of position sensors in the region of the movable component considered for the position determination, wherein a sensor model is provided which, for the at least one movable component and a position sensor, supplies sensor model responses as a function of a relative position of the movable component relative to the position sensor, wherein for a plurality of assumed different relative positions of the movable component relative to the stationary component sensor model responses of all position sensors of the group of position sensors are determined with the sensor model, wherein the sensor model responses are compared with the sensor responses detected with the group of position sensors, and wherein the relative position from the plurality of assumed different relative positions with the smallest deviation between the sensor model responses from the sensor model and the detected sensor responses is used as the relative position of the movable component or, from this, the relative position of the movable component of the movable component related to a stationary reference point is determined.
2. The method according to claim 1, wherein sensor model is determined by detecting the profile of the sensor model responses when the array of the plurality of position magnets is moved past the position sensor on the stationary component.
3. The method according to claim 1, wherein for comparison of the sensor model responses with the sensor responses detected by the group of position sensors a cost function is formulated that evaluates the deviation between the detected sensor responses and the sensor model responses of the group of position sensors, and in that the one of the plurality of different relative positions which optimizes the value of the cost function is used as the relative position of the movable component or, from this, the relative position of the movable component or an absolute position of the movable component related to a stationary reference point is determined.
4. The method according to claim 1, wherein the plurality of the assumed different relative positions is determined by varying the relative position of the movable component with a predetermined position increment.
5. The method according to claim 1, wherein the plurality of the assumed different relative positions is determined by performing a mathematical optimization of the cost function with respect to the relative position, wherein the relative position is varied by the optimization.
6. The method according to claim 1, wherein the plurality of the assumed different relative positions is determined by varying the relative position of the movable component by at least one pole pitch.
7. The method according to claim 6, wherein the relative position of the movable component is varied by a number of pole pitches which corresponds to the number, or at most the number, of position magnets on the movable component.
8. The method according to claim 1, wherein at least one further group of position sensors is used and the sensor model responses are compared with the sensor responses detected by the at least one further group of position sensors, and wherein the relative position of the movable component, or an absolute position of the movable component related to a stationary reference point is determined with reference to the group of position sensors which has the smallest deviation between the sensor model responses from the sensor model and the detected sensor values.
9. A movement arrangement with at least one movable component which is arranged movably relative to a stationary component, wherein an array of a plurality of position magnets with a pole pitch is arranged on the movable component and an arrangement with a plurality of position sensors with a sensor pitch is arranged on the stationary component, and with a position sensor of a position magnet in the region of this position sensor is detectable in the form of a sensor response, wherein a computing unit which processes the sensor responses from position sensors is provided for determination of the position of the movable component relative to the stationary component, wherein for a group of position sensors considered for the position determination in the region of the movable component, the computing unit detects the sensor responses, wherein a memory unit is provided in which a sensor model is stored, which for the at least one movable component and a position sensor supplies sensor model responses as a function of a relative position of the movable component relative to the position sensor, wherein for a plurality of assumed different relative positions of the movable component relative to the stationary component the computing unit determines sensor model responses of the group of position sensors with the sensor model, wherein the computing unit compares the sensor model responses with the sensor responses detected by the group of position sensors, and wherein the computing unit determines the relative position from the plurality of assumed different relative positions with the smallest deviation between the sensor model responses from the sensor model and the detected sensor responses as the relative position of the movable component, or from this the relative position of the movable component or an absolute position of the movable component related to a stationary reference point is determined.
Description
[0011] The present invention is described in greater detail below with reference to
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021] As shown in
[0022] Such a movement arrangement occurs in many applications. An example is a linear motor, long stator linear motor or planar motor, in which a plurality of drive coils As with s>1 are additionally arranged on the stationary component 1, as indicated by dashed lines in
[0023] Another application is pure position detection in a movement arrangement with a component 2 that is movable relative to the stationary component 1, for example a slide on a machine tool. In this application, the movable part 2 is moved by some other mechanism and the position of the movable part 2 relative to the stationary component 1 is to be determined.
[0024] The position sensors Sn used measure the magnetic field M, for example the magnitude and/or direction, of the magnetic field of a position magnet Pk in the region of the respective position sensor Sn. Possible position sensors Sn are magnetostrictive sensors, magnetoresistive sensors (such as an anisotropic magnetoresistive sensor, a tunnel magnetoresistance sensor or giant magnetoresistance sensor) or a Hall effect sensor. In addition, there can of course also be further types of sensors that are capable of detecting a magnetic field M. Different types of sensors can also indicate the magnitude of the magnetic field M (if this is detected) differently. A Hall effect sensor supplies, for example, a value which indicates the magnetic field intensity (for example in Tesla), wherein the Hall effect sensor is not usually operated in saturation. A magnetoresistive sensor, on the other hand, supplies a value in a specific value range, for example between zero and one, wherein the sensor is usually operated in saturation. This means that such a sensor supplies the value one, for example, for a wide range of the magnetic field intensity. With such a sensor it is usually not possible to obtain an absolute value of the magnetic field intensity of the magnetic field M, but statements can only be made about whether the respective sensor type is in the saturation range or not.
[0025] In
[0026] A position sensor Sn supplies, for example, a sine and cosine track (in the form of an electrical voltage measurement value u) as a sensor signal, as shown in
[0027] If a position magnet Pk is moved past a position sensor Sn, the result is the typical sawtooth-like profile of the angle information γ between zero and 2π (value depending on the sensor) and the profile of the absolute value |A| depending on the position x of the position magnet Pk relative to the position sensor Sn, as shown in
[0028] If an array of position magnets Pk with k>1 on the movable component 2 (for example as shown in
[0029] The value of the angle information γ can also be scaled with a constant factor. For example, it can be specified that the position sensor Sn supplies the value π/2 for the angle information γ at the center of the position magnet Pk. According to
[0030]
[0031] The relative position x.sub.R between the movable component 2 and the position sensor Sn is related to any point on the movable component 2, for example to the center (viewed in the direction of movement) or to one end of the movable component 2 or of the array of the position magnets Pk. In
[0032] If the position x(i) (regardless of whether it is an absolute position or a relative position) of the movable component 2 at the current sampling time (i) (in which time interval the position is determined) is known, then from the determined position x(i−1) of the previous sampling time (i−1), the current position x(i) can be determined in a trivial manner, for example from the known movement of the movable component 2. The main problem, however, is to determine the position x(i) independently of the information about the position x(i−1) of the previous sampling time (i−1), for example and in particular initially when the system is switched on or started up.
[0033] When switching on or starting up, all position sensors Sn on the stationary component 1 can be read out, but it cannot be said which position magnet Pk of a movable component 2 is detected by a specific position sensor Sn. Each position magnet Pk on the movable component 2 can produce the same sensor response SA, for example the same angle information γ, for a specific position sensor Sn. Therefore, the sensor response SA measured with a position sensor Sn is not unambiguous. In order to resolve this ambiguity and also to enable a reliable determination of the position in such situations, the procedure according to the invention is as follows.
[0034] For a given combination of a known array of position magnets Pk (pole length p, pole pitch Tp, orientation and polarity of the position magnets Pk, etc.) on a movable component 2 and a specific known position sensor Sn (sensor type, distance between sensor and position magnet, etc.) on a stationary component 1 a sensor model SM can be determined which ascertains a sensor model response SA*, for example the angle information γ* and/or the absolute value |A|*, as a function of the relative position x.sub.R of the movable component 2 relative to the stationary component 1 or to the position sensor Sn. For the angle information γ* and the absolute value |A|*, the sensor model SM corresponds, for example, to the profile of these variables as shown in
[0035] Hence, the sensor model SM is determined in that the profile of the sensor model response SA* is detected when the complete array of the plurality of the position magnets Pk is moved past the position sensor Sn on the stationary component 1. During the movement past the position sensor Sn, the sensor responses SA are detected and used as sensor model responses SA*. The sensor model SM is therefore independent from the arrangement of the position sensors Sn on the stationary component 1, because the sensor model response SA* is detected with regard to only a single position sensor Sn.
[0036] If a plurality of different movable components 2 are present, e.g. with different numbers of position magnets Pk, as is quite common, for example, with a long stator linear motor or planar motor, or if different position sensors Sn are provided on the stationary component 1, then there is of course an associated sensor model SM for every possible combination of the array of position magnets Pk and a position sensor Sn.
[0037] The sensor model SM, or the sensor models SM, of course only has/have to be determined once for a specific movement arrangement. Consequently, for the implementation of the method for determination of the position, the sensor model SM can be assumed to be known and given.
[0038] The sensor model SM can be stored in the form of the values of the sensor model response SA*, i.e. for example the values of the angle information γ* and/or the absolute values |A|*, as a function of the relative position x.sub.R as in
[0039] For this reason it is also possible to store the sensor model SM of the sensor model response SA* in a different form, as is explained with reference to
[0040] The profile of the absolute value |A|* in the sensor model SM could likewise be discretized with position increments Δx in order to obtain interpolation points into which a smooth curve, for example a spline again, can then be approximated. This would also make it possible to store the profile of the absolute value |A|* in the form of a mathematical description of the curve. In this case, the value of the absolute value |A|* for a specific relative position x.sub.R can be determined directly from the stored curve.
[0041] The same procedure can also be used for other or additional sensor responses SA or sensor model responses SA* of the sensor model SM.
[0042] A movable part 2 with a number of position magnets Pk in a specific relative position x.sub.R with respect to the stationary component 1 with the position sensors Sn is shown in
[0043] If one position sensor Sn is considered, this supplies a corresponding sensor response SAn, for example the angle information γn and the absolute value |A|n, depending on the position of a position magnet Pk, the magnetic field M of which is measured, relative to the position sensor Sn (as shown in
[0044] In addition, the sensor model SM for this movable component 2 and the existing position sensors Sn is known. The object now is to determine the relative position x.sub.R of the movable component 2 in such a way that the sensor model responses SA*.sub.j of the considered position sensors Sn.sub.j from the sensor model SM coincide to the best possible extent with the actually detected sensor responses SA.sub.j of the considered position sensors Sn.sub.j.
[0045] A specific relative position x.sub.R of the movable component 2 thus supplies sensor model responses SA*.sub.j from the sensor model SM of the considered position sensors Sn.sub.j. These sensor model responses SA*.sub.j are compared with the sensor responses SA.sub.j actually detected by the considered position sensors Snj. For this purpose, the relative position x.sub.R of the movable component 2 is varied and for each varied relative position x.sub.Rv the sensor model response SA*.sub.j(x.sub.Rv) is determined from the sensor model SM. Of course, this variation is only assumed and the movable component 2 is not physically moved on the stationary component 1 for this purpose. The relative position x.sub.Rv with the smallest deviation between the sensor model response SA*.sub.j(x.sub.Rv) from the sensor model SM and the actually detected sensor responses SA.sub.j is then used to determine the relative position x.sub.R of the movable component 2 relative to the stationary component 1.
[0046] The absolute position x.sub.A can then simply be determined from the determined relative position x.sub.R with the known geometry of the movable component 2 and of the stationary component 1 and with the known installation locations of the position sensors Sn. The absolute position x.sub.A is related to a predetermined stationary reference point RP (
[0047] The relative position x.sub.Rv of the movable component 2 can be varied in different ways for the implementation of the method for determination of the position, as is explained below. For the following description, the angle information γ and the absolute value |A| are assumed as the sensor response SA. For the invention, however, only one of these variables can be used as the sensor response SA, or another variable supplied by the position sensors Sn or also additional variables supplied by the position sensors Sn can be used. The sensor responses SA used can be provided directly by the position sensors Sn, or can also be determined from sensor signals supplied by the position sensors Sn (as for example in
[0048] A group with a number j of position sensors Sn.sub.j is used to determine the relative position x.sub.R (or also the absolute position x.sub.A) of a movable component 2. Of course, such position sensors Sn.sub.j are used which supply sensor responses SAj and are therefore located in the region of a movable component 2. In the example according to
[0049] Consequently, the position sensors Snj used to determine the relative position x.sub.R of the movable component 2, for example when the system is started up, supply sensor responses SA.sub.j, for example
For any relative position x.sub.Rv of the movable component 2, a sensor model response SA*.sub.j(x.sub.Rv), for example
can be determined from the sensor model SM for each position sensor Sn.sub.j.
[0050] For determination of the relative position x.sub.R of the movable component 2 relative to the stationary component 1 the sensor response SA, detected by the considered position sensors Sn.sub.j is compared with the sensor model responses SA*.sub.j(x.sub.Rv) for the varied relative position x.sub.Rv. The varied relative position x.sub.Rv, at which the sensor model responses SA*.sub.j(x.sub.Rv) of the considered position sensors Sn.sub.j come closest to the sensor responses SA.sub.j actually detected by the considered position sensors Sn.sub.j, is used as a relative position x.sub.R of the movable component 2 or used for the determination of the relative position x.sub.R (e.g. if this is related to another point of the movable component 2) or the absolute position x.sub.A of the movable component 2.
[0051] For the comparison of the sensor responses SAj with the sensor model responses SA*.sub.j(x.sub.Rv) a cost function J can be used as a function of the sensor responses SA.sub.j and the sensor model responses SA*.sub.j(x.sub.Rv), i.e. J=f(SA.sub.j,SA*.sub.j(x.sub.Rv)) ∀j, which evaluates the deviation between the measured sensor responses SA.sub.j and the sensor model responses SA*.sub.j(x.sub.Rv) of the considered position sensors Sn.sub.j. The cost function J preferably evaluates all j considered position sensors Sn.sub.j. The cost function J can simply be formulated as the absolute value of a difference, for example
or as a squared error, for example in the form
or in any other suitable form. If the sensor response SA is a vector of a plurality of variables, for example as above of the angle information γ and the absolute value |A|, then any norm, for example the Euclidean norm ∥ ∥.sub.2, can be used, for example
[0052] The one of the varied relative positions x.sub.Rv which optimizes (i.e. either minimizes or maximizes) the value of the cost function is then the sought relative position x.sub.R or is used to determine the relative position x.sub.R or the absolute position x.sub.A of the movable component 2.
[0053] In a first embodiment, the relative positions x.sub.Rv could be varied in small position increments Δx.sub.R. The smaller the position increment Δx.sub.R, the higher the resolution. The range in which the relative position x.sub.Rv is varied can be predetermined, for example depending on the known geometric dimensions of the movable component 2 and/or the known sensor spacing s. For example,
[0054] However, a second possible embodiment of the determination of the position is more advantageous. If k indicates the number of position magnets Pk on the movable component 2, then a specific one of the position sensors Sn.sub.j used can detect the magnetic field of one of these k position magnets Pk. The movable component 2 therefore only has to be varied by k pole pitches Tp in order to cover all possible positions of the movable component 2. In this way, the number of relative positions x.sub.Rv to be varied can be reduced significantly without sacrificing accuracy in determination of the position. In this case, too, a value for the cost function J is obtained for each of the varied relative positions x.sub.Rv. The relative position x.sub.Rv at which the value of the cost function J is optimal (either minimal or maximal) is then the sought relative position x.sub.R or is used to determine the relative position x.sub.R or the absolute position x.sub.A of the movable component 2.
[0055] It is also possible to even further reduce the number of relative positions x.sub.Rv to be varied. For example, those relative positions x.sub.Rv of which the associated absolute values |A| are below a certain limit could be ignored.
[0056] In a further possible embodiment, the cost function J can be optimized (minimized or maximized) depending on the relative position x.sub.Rv in a mathematical optimization. Mathematically it can be represented in the form J=f(SA.sub.j,SA.sub.j.sup.{circumflex over ( )}(x.sub.Rv)), x.sub.R=min J. The varied relative positions x.sub.Rv result from the optimization algorithm, for example the Newton method, a gradient method, evolutionary algorithms, etc. The relative position x.sub.Rv is iteratively varied by the optimization algorithm so that the cost function J converges towards the minimum or maximum and is thus optimized. The first relative position x.sub.Rv of the iteration can be predetermined as desired or set by the optimization method used. A termination criterion is also predetermined for this purpose, i.e. the optimization is repeated iteratively until the termination criterion is reached. A possible termination criterion is falling below (or exceeding) a specified threshold value for the cost function or falling below a predetermined deviation of the values of the cost function J of two successive iterations.
[0057] It is also possible to use a plurality of different groups with position sensors Sn.sub.j for determination of the position. Certain position sensors Sn.sub.j can also be contained in a plurality of groups, but the groups differ in each case by at least one position sensor Sn.sub.j. In the example in
[0058] A cost function J can thus be optimized for each group of position sensors Sn.sub.j by varying the relative position x.sub.Rv using a method as described above. A group could now be selected and the relative position x.sub.Rv at which the value of the cost function J for this group is optimal (either minimum or maximum) (or generally the relative position x.sub.Rv at which the deviation between the sensor model responses and the measured sensor responses is smallest), could be used as the sought relative position x.sub.R or used to determine the relative position x.sub.R or the absolute position x.sub.A of the movable component 2. The result of the optimization of the cost function with the other group could then be used to check plausibility of the determination of the relative position x.sub.R (or absolute position x.sub.A) of the movable component 2. For example, the deviation between the two determined positions must not exceed a certain value. For example, the group of which the value of the cost function J is the smallest could be selected and the others could be discarded or used for plausibility checking.
[0059] If a plurality of different sensor models SM are present, for example because different movable components 2 are present, then the method described above must be carried out for each sensor model SM, that is to say for example to carry out the optimization on the basis of each sensor model SM. Thus this method not only supplies the relative position x.sub.R of the movable component 2, but also the information as to which movable component 2 is involved. For example, in the case of an optimization of a cost function J, the cost function J with one of the sensor models SM will be minimal, so that the movable component 2 is the one on which this sensor model SM is based.
[0060] If a single movable component 2 or a movable component 2 that is sufficiently far away from other movable components is present, then the minimum of the cost function J will approach zero (depending on the accuracy of the sensor model SM and the accuracy of the installation position of the position sensors Sn.sub.j).
[0061] However, the method according to the invention for determination of the position also functions when two movable components 2 are close to one another or even lie directly on one another. “Close” is understood to mean an arrangement in which the magnetic fields M of the two movable components 2 influence one another within the measurement accuracy of the position sensors Sn. Due to the significant drop in the magnetic field M outside the position magnets Pk, it can be assumed that the influencing will only take place in the edge region of the movable components 2. In the region of influencing, the sensor model response SA* from the sensor model SM (which was determined for an isolated position sensor Sn) for a position sensor Sn will deviate more significantly from the sensor response SA measured with this position sensor Sn.sub.j. Since a plurality of position magnets Pk are provided on the movable component 2 and a plurality of position sensors Sn.sub.j are always taken into account for determination of the position, there are position sensors Sn.sub.j for which a good match of the sensor model response SA* from the sensor model SM and the measured sensor response SA can be found. These are sufficient in order to determine the relative position x.sub.R. This even works if more than two movable components 2 are closely or directly adjacent to one another. Thus it is also easily possible to determine the relative positions x.sub.R (or absolute position x.sub.A) of a plurality of movable components 2 that are closely or directly adjacent to one another. Since the movable component 2 is also characterized by the sensor model SM, information can also be obtained as to which movable components 2 are closely or directly adjacent to one another.
[0062] Plausibility checks could also be carried out, in particular in the case of movable components 2 that are closely or directly adjacent to one another. If it follows from the determined relative positions x.sub.R (or absolute positions x.sub.A) of two adjacent movable components 2 that the movable components 2 would overlap, then an error in the determination of the position is obvious. Since the geometries of the movable components 2 are known, such a plausibility check can be carried out easily. If a plurality of groups of position sensors Sn.sub.j are used for determination of the position, then, for example, the known dimensions of the movable component 2 could be used to select a group for determination of the position. For example, with the known dimensions of the movable components 2, the cost function J (which does not necessarily have to have the smallest value) can be selected, which makes the result of the determination of the position plausible.
[0063] In the case of long stator linear motors 10, there are often stator designs in which two stationary components 1 of the long stator linear motor 10 are brought together at a switch W or a stationary component 1 is divided into two stationary components 1 at a switch W (depending on the direction of movement of the movable component 2), as shown in
[0064] It can be expected that a sensor model SM of the movable component 2 can be made to coincide more precisely with measured sensor responses SA on a certain stationary component 1 of the switch W than on the other stationary component 1 of the switch W, because the air gaps between position sensors Sn and position magnets Pk are different in the region of the switch W (which in turn causes different magnetic fields at the position sensors Sn). If a cost function J is used, it will be smaller (or larger) for a certain stationary component 1 involved in the switch W than for the other stationary component 1 involved in the switch W, because the measured sensor responses SA.sub.j will deviate more significantly from the sensor model responses SA*.sub.j due to the larger air gap. In this way, the relative position x.sub.R (or absolute position x.sub.A) of a movable component 2 in the switch W can also be determined in the region of the switch W by the present method for determination of the position. In addition, at the same time it can also be determined at which of the stationary components 1 involved in a switch W the movable component 2 is currently located.
[0065] The described method for determination of the position can be carried out in a computing unit 5. For this purpose, the computing unit 5 receives the required sensor responses SA from the position sensors Sn (as indicated in