Device, method and system for detecting circumferential three-dimensional space position of mover shaft of two-degree-of-freedom motor

By using a detection method combining multilinear Hall sensor with stator in a two-degree of freedom motor, the complexity of the position detection of the stator semi-type motor is solved, and the precise three-dimensional spatial position detection of the motor rotor is realized, and the structure is simplified. Reduced costs.

CN118971506APending Publication Date: 2024-11-15ZHENGZHOU UNIV +1

Patent Information

Application Number
CN202411236405.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

When detecting its three-dimensional spatial position, the existing two-degree-of-freedom motor rotor has a complex structure and large volume, making it difficult to integrate into the motor. The existing technology cannot effectively solve the position detection problem of the stator half-term two-degree-of-freedom motor.

Method used

A three-dimensional spatial position detection device for the circumference of the two-degree-of-freedom motor rotor shaft is designed, and a combination of multiple linear Hall sensors and rotating and linear motion stator is used to realize the motor rotor through a specific magnet structure and sensor layout. Accurate detection of three-dimensional spatial location.

Benefits of technology

The motor structure is simplified, the cost is reduced, and the precise three-dimensional spatial position detection of the two-degree-of-freedom motor is realized. It is suitable for stator-separated two-degree-of-freedom motors, which improves the application and development potential of the motor.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118971506A_ABST
    Figure CN118971506A_ABST
Patent Text Reader

Abstract

The invention designs a device and a method for detecting the circumferential three-dimensional space position of a rotor shaft of a two-degree-of-freedom motor aiming at a stator split-half type two-degree-of-freedom linear rotating motor, and three linear Hall sensors are installed in three rotating unit stator grooves to calculate the circumferential three-dimensional space position of a rotor when the motor rotates. The two linear Hall sensors are installed in the two linear motion stator grooves so as to calculate the axial three-dimensional space position of the rotor when the motor moves linearly. And finally, calculating the circumferential three-dimensional space position of the rotor when the motor spirally moves based on the axial three-dimensional space position of the rotor when the motor linearly moves and the circumferential three-dimensional space position of the rotor when the motor rotationally moves.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of permanent magnet motors, and in particular to a device, method and system for detecting the circumferential three-dimensional spatial position of a rotor shaft of a two-degree-of-freedom motor. Background Art

[0002] Traditional motors can only achieve single rotation or linear motion. However, there is an increasing demand for multi-degree-of-freedom motion in industrial production, semiconductor packaging, aviation, radar and other fields. In this context, two-degree-of-freedom motors that can directly achieve rotation, linear and spiral motion are developing rapidly. The precise control of the operation of two-degree-of-freedom motors requires timely detection of the precise three-dimensional spatial position and speed of their moving parts.

[0003] At present, commonly used motor position detection devices are only for single rotation and linear motion. For example, the rotor position detection of a traditional single rotary motion motor only requires a rotational position sensor such as a magnetic encoder or a rotary transformer, and the secondary position detection of a single linear motion motor only requires a linear position sensor such as a laser displacement sensor or a grating sensor.

[0004] Since the rotor of a two-degree-of-freedom motor has two degrees of freedom, rotation and linear, the spatial position in two directions needs to be detected simultaneously. Compared with a single-degree-of-freedom motor, its position detection is more complicated, and a rotation position sensor, a linear position sensor and a position decoupling device need to be installed at the same time. The three-dimensional spatial position of the rotor passes through the position decoupling device, and the circumferential position and axial position are respectively calculated by the rotation position sensor and the linear position sensor. As a result, the position detection device for the rotor of the two-degree-of-freedom motor has a complex structure, large size, and is difficult to integrate into the motor, which restricts the application and development of two-degree-of-freedom motors.

[0005] CN105914952B proposes a position detection method for a linear-rotational two-degree-of-freedom permanent magnet motor. For a single-stator linear-rotational two-degree-of-freedom permanent magnet motor, a linear Hall sensor is used, and a block permanent magnet is used to realize position detection of the two-degree-of-freedom three-motion mode of the linear-rotational permanent magnet motor. The Hall sensor is buried in the stator, which is simple to install, low in cost, and easy to implement.

[0006] CN105762991B proposes an integrated position detection device and method for a dual-stator linear-rotation permanent magnet motor. For the dual-stator linear-rotation two-degree-of-freedom permanent magnet motor, a separate interactive position detection method is adopted to divide the linear part permanent magnet along the circumferential direction into several blocks for rotating part position detection, and divide the rotating part permanent magnet along the axial direction into several blocks for linear part position detection, thereby reducing mutual interference in position detection and facilitating motor decoupling control.

[0007] However, there are many types of linear-rotary two-degree-of-freedom motors. For a stator-split two-degree-of-freedom linear-rotary motor, it is not necessary to divide the permanent magnet into blocks, so the above two technical solutions cannot be used for position detection.

[0008] In order to solve the above problems, people have been seeking an ideal technical solution. Summary of the invention

[0009] The purpose of the present invention is to address the deficiencies in the prior art and thereby provide a device, method and system for detecting the circumferential three-dimensional spatial position of a rotor shaft of a two-degree-of-freedom motor.

[0010] In order to achieve the above object, the technical solution adopted by the present invention is: A first aspect provides a device for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor mover shaft, comprising a mover, a rotary motion stator and a linear motion stator, wherein the mover is a salient pole structure; The rotary motion stator comprises a plurality of axially arranged rotary unit stator teeth and axially magnetized permanent magnets arranged in the rotary unit stator teeth, and a rotary unit stator slot is formed between any two rotary unit stator teeth; The linear motion stator comprises a plurality of circumferentially arranged linear motion stator teeth and circumferentially magnetized permanent magnets arranged in the linear motion stator teeth, and a linear motion stator slot is formed between any two linear motion stator teeth; It also includes a first linear Hall sensor, a second linear Hall sensor and a third linear Hall sensor disposed on the stator of the rotating unit; and a fourth linear Hall sensor and a fifth linear Hall sensor disposed on the linear motion stator; the magnetic density sensing surface of any linear Hall sensor is opposite to the salient pole structure surface of the mover; The first linear Hall sensor is installed in any one of the rotating unit stator slots, the second linear Hall sensor is installed in the rotating unit stator slot that is M1th away from the first linear Hall sensor in the forward direction, and the third linear Hall sensor is installed in the rotating unit stator slot that is M1th away from the first linear Hall sensor in the reverse direction; The fourth linear Hall sensor is installed in any linear motion stator slot, and the fifth linear Hall sensor is installed in the linear motion stator slot that is M2 th away from the fourth linear Hall sensor along any linear motion direction.

[0011] Furthermore, M 1 =ks / (2p) , M 2 =A / 2s; in, k To makeM 1 is the smallest integer that is an integer, s is the number of stator slots of the rotating unit, p is the number of permanent magnet pairs on the rotating stator; is the pole length of the linear unit, A is the number of linear Hall sensors on the linear motion stator.

[0012] A second aspect provides a method for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor mover shaft, which is applied to the above-mentioned two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device, and the method comprises the following steps: When the two-degree-of-freedom motor performs rotational motion, the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor are collected, and the circumferential three-dimensional spatial position of the mover when the motor rotates is calculated according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor; When the two-degree-of-freedom motor performs linear motion, the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor are collected, and the axial three-dimensional spatial position of the mover when the motor performs linear motion is calculated according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; When the two-degree-of-freedom motor performs spiral motion, the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, the third linear Hall sensor, the fourth linear Hall sensor and the fifth linear Hall sensor are collected, and the circumferential three-dimensional spatial position of the mover when the motor rotates is first calculated according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor and the third linear Hall sensor; then the axial three-dimensional spatial position of the mover when the motor moves linearly is calculated according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; finally, the circumferential three-dimensional spatial position of the mover when the motor spirals is calculated based on the axial three-dimensional spatial position of the mover when the motor moves linearly and the circumferential three-dimensional spatial position of the mover when the motor rotates.

[0013] Furthermore, the specific steps of calculating the circumferential three-dimensional spatial position of the mover when the motor rotates according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor are as follows: After performing analog-to-digital conversion on the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor, a linear combination is performed to obtain a digital signal in a two-phase stationary coordinate system; Based on the digital signal in two-phase stationary coordinates, a synchronous reference frame phase-locked loop is used to calculate the circumferential three-dimensional spatial position of the mover when the motor rotates.

[0014] Furthermore, the specific steps of calculating the axial three-dimensional spatial position of the mover when the motor moves linearly according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor are as follows: The output voltages of the fourth linear Hall sensor and the fifth linear Hall sensor are obtained, and the inverse tangent calculation is performed based on the following formula to obtain the axial three-dimensional spatial position of the mover when the motor moves linearly: in, ; x is the axial three-dimensional spatial position of the mover; τ is the magnetic pole pitch, d= τ / 2; u1 and u2 are the output voltages of the fourth linear Hall sensor and the fifth linear Hall sensor respectively.

[0015] Furthermore, the following formula is used to calculate the circumferential three-dimensional spatial position of the mover during the helical motion of the motor based on the axial three-dimensional spatial position of the mover during the linear motion of the motor and the circumferential three-dimensional spatial position of the mover during the rotational motion of the motor: in, θ is the circumferential three-dimensional spatial position of the mover when the rotating unit moves, x is the axial three-dimensional spatial position of the mover when the motor moves linearly, L is the total length of the linear motion stator.

[0016] A third aspect provides a two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection system, comprising the above-mentioned two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device, and further comprising: A first position calculation module is connected to the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor, and is used to collect voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor when the two-degree-of-freedom motor performs rotational motion, and calculate the circumferential three-dimensional spatial position of the mover when the motor rotates according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor; A second position calculation module is connected to the fourth linear Hall sensor and the fifth linear Hall sensor, and is used to collect voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor when the two-degree-of-freedom motor performs linear motion, and calculate the axial three-dimensional spatial position of the mover when the motor performs linear motion according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; The third position calculation module is connected to the first position calculation module and the second position calculation module respectively, and is used to calculate the circumferential three-dimensional spatial position of the mover when the two-degree-of-freedom motor performs spiral motion based on the circumferential three-dimensional spatial position of the mover output by the first position calculation module and the axial three-dimensional spatial position of the mover output by the second position calculation module.

[0017] A fourth aspect provides an electronic device, comprising a memory and a processor, wherein the memory stores a computer program, and the processor implements the steps of the aforementioned method when executing the computer program.

[0018] A fifth aspect provides a computer-readable storage medium having a computer program stored thereon, characterized in that the computer program implements the steps of the aforementioned method when executed by a processor.

[0019] The sixth aspect provides a computer program product, including a computer program, characterized in that the computer program implements the steps of the aforementioned method when executed by a processor.

[0020] The present invention has outstanding substantial features and remarkable progress compared with the prior art. Specifically, the present invention is aimed at a stator-split two-degree-of-freedom motor linear rotary motor, and designs a two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device and method. Three linear Hall sensors are installed in three rotating unit stator slots to calculate the circumferential three-dimensional spatial position of the mover when the motor rotates, and two linear Hall sensors are installed in two linear motion stator slots to calculate the axial three-dimensional spatial position of the mover when the motor moves linearly; finally, the circumferential three-dimensional spatial position of the mover during the motor's spiral motion is calculated based on the axial three-dimensional spatial position of the mover during the motor's linear motion and the circumferential three-dimensional spatial position of the mover during the motor's rotational motion. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] Figure 1 It is a schematic diagram of the structure of a two-degree-of-freedom motor in an example of the present invention.

[0022] Figure 2 This is a schematic diagram of installing a linear Hall sensor on a rotating unit motor in an embodiment of the present invention.

[0023] Figure 3 Schematic diagram of the radial magnetic field distribution of the detection points of the linear Hall sensor of the rotating unit motor in an embodiment of the present invention.

[0024] Figure 4 This is a schematic diagram of installing a linear Hall sensor on a linear unit motor in an embodiment of the present invention.

[0025] Figure 5 Graph showing the radial magnetic field distribution at the detection point of the linear Hall sensor of the linear unit motor in an embodiment of the present invention.

[0026] Figure 6 Schematic diagram of the relationship between position detection and magnetic field strength of dual Hall sensors of a linear unit motor in an embodiment of the present invention.

[0027] Figure 7 It is a schematic diagram of the composition of the synchronous reference coordinate synchronous reference frame phase-locked loop in an example of the present invention.

[0028] Figure 8 This is a waveform diagram of the angle signal obtained by calculation in an implementation example of the present invention.

[0029] Fig. 9 It is a schematic diagram of a 3D spatial position detection system for the circumferential direction of the rotor shaft of a two-degree-of-freedom motor.

[0030] Explanation of the markings in the figure: 1. Rotating unit stator teeth; 2. Rotating permanent magnets; 3. Rotating windings; 4. Linear motion stator teeth; 5. Linear permanent magnets; 6. Linear windings; 7. Mover; 8. Mover salient poles; 9. First linear Hall element; 10. Second linear Hall element; 11. Third linear Hall element; 12. Fourth linear Hall element; 13. Fifth linear Hall element; 14. Phase detector; 15. Loop filter; 16. Voltage-controlled oscillator. DETAILED DESCRIPTION

[0031] The technical solution of the present invention is further described in detail below through specific implementation methods.

[0032] Example 1 This embodiment provides a device for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor rotor shaft, wherein the two-degree-of-freedom motor is a stator-half-type two-degree-of-freedom motor linear rotary motor. Figure 1 As shown, a stator-half-split two-degree-of-freedom motor linear-rotary motor, the two-degree-of-freedom motor comprises a mover 7, a rotary motion stator and a linear motion stator, the mover 7 is a salient pole structure, specifically including axial and circumferential salient pole structures; The rotary motion stator comprises a plurality of axially arranged rotary unit stator teeth 1 and axially magnetized rotary permanent magnets 2 arranged in the rotary unit stator teeth 1, a rotary unit stator slot is formed between any two rotary unit stator teeth, and a rotary winding 3 is arranged in the rotary unit stator slot; The linear motion stator comprises a plurality of circumferentially arranged linear motion stator teeth and circumferentially magnetized linear permanent magnets 5 arranged in the linear motion stator teeth. A linear motion stator slot is formed between any two linear motion stator teeth 4, and a linear winding 6 is arranged in the linear motion stator slot.

[0033] Among them, the rotating unit stator teeth 1 and the linear motion stator teeth 4 are harpoon-type and E-type stator teeth respectively, and the harpoon-type and E-type stator teeth respectively form a permanent magnet motor unit for switching rotating magnetic flux and linear magnetic flux along the rotating permanent magnet 2 and the linear permanent magnet 5.

[0034] It is understandable that, under uniform rotation, the magnetization mode of the rotating permanent magnet 2 causes the air gap flux density near the stator slot to present a distribution characteristic close to a sine waveform, so the position of the mover can be obtained by detecting the flux at the stator slot.

[0035] Specifically, Figure 2 As shown, the two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device includes: a first linear Hall sensor H19, a second linear Hall sensor H210 and a third linear Hall sensor H311 arranged on the stator of the rotating unit.

[0036] Specifically, the first linear Hall sensor H19 is installed in any one of the stator slots of the rotating unit, the second linear Hall sensor H210 is installed in the stator slot of the rotating unit that is M1th away from the first linear Hall sensor in the reverse direction, and the third linear Hall sensor H311 is installed in the stator slot of the rotating unit that is M1th away from the first linear Hall sensor in the forward direction.

[0037] in, M 1 =ks / (2p), k To make M 1 is the smallest integer that is an integer, s is the number of stator slots of the rotating unit, p is the number of permanent magnet pairs on the rotating stator 。

[0038] In this embodiment, it is assumed s is 12, p When is 3, we can get k = 1,M 1 =2. That is, the second linear Hall sensor H210 is 2 rotation unit stator slots away from the first linear Hall sensor H19 in the reverse direction, i.e., the counterclockwise direction, and the third linear Hall sensor H311 is also 2 rotation unit stator slots away from the first linear Hall sensor 9 in the forward direction, i.e., the clockwise direction.

[0039] It should be noted that the magnetic sensitive surfaces of the first linear Hall sensor H19 , the second linear Hall sensor H210 , and the third linear Hall sensor H311 are all opposite to the surface of the salient pole structure 8 of the mover.

[0040] Since each linear Hall sensor is installed in a form of two slots apart, the electrical angle phase difference between the first linear Hall sensor H1 and the second linear Hall sensor H2 is 60°, and the electrical angle phase difference between the second linear Hall sensor H2 and the third linear Hall sensor H3 is 60°. Among them, U A is the digital signal of the output voltage signal of the first linear Hall sensor H1 after analog-to-digital conversion, U B is the digital signal of the output voltage signal of the second linear Hall sensor H2 after analog-to-digital conversion, U C is the digital signal of the output voltage signal of the third linear Hall sensor H3 after analog-to-digital conversion, U m is the amplitude of the output voltage signal of the three linear Hall sensors; U DC is the DC component of the output voltage signal of the three linear Hall sensors; θ is the actual electrical angle of the mover 7, and the electrical angle phase difference is 60°.

[0041] In this embodiment, the radial magnetic field distribution diagram at the detection point of the linear Hall sensor on the rotating stator is as follows: Figure 3 shown.

[0042] It is understandable that, under the uniform linear state, the magnetization mode of the linear permanent magnet 5 causes the air gap flux density near the stator slot to present a distribution characteristic close to a sine waveform, so the position of the mover can be obtained by detecting the flux of the stator slot.

[0043] like Figure 4 As shown, the two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device also includes a fourth linear Hall sensor H412 and a fifth linear Hall sensor H513 arranged on the linear motion stator.

[0044] in M 2 =Aτ / 2s, is the pole length of the linear unit, A is the number of linear Hall sensors on the linear motion stator.

[0045] Assume that in this embodiment, the pole length of the linear unit is τ is 12, and the number of linear Hall elements A is 2, then we can get M 2 =1。 That is the fifth linear Hall sensor H513 Positive (negative) motion along a straight line Direction 1 notch away from the fourth linear Hall sensor H412.

[0046] Similarly, the magnetic density sensing surfaces of the fourth linear Hall sensor H412 and the fifth linear Hall sensor H513 are opposite to the surface of the salient pole structure 8 of the mover.

[0047] In this embodiment, the radial magnetic field distribution diagram of the linear Hall sensor detection point of the linear unit motor is as follows: Figure 5 As shown in the figure, the relationship between the position detection of the dual Hall sensors of the linear unit motor and the magnetic field strength is shown in Figure 6 shown.

[0048] Since the two linear Hall sensors H4 and H5 are installed at a distance d from each other in this embodiment, when the two-degree-of-freedom motor performs linear motion and the mover moves a distance of x When , the expressions of the output voltages u1 and u2 of the two linear Hall sensors can be obtained: in , d = / 2 , Represents the magnetic flux density amplitude of the permanent magnet (the permanent magnet is magnetized in parallel in the vertical direction, and two adjacent permanent magnets are magnetized in opposite directions). is the pole length of the linear unit, is the Hall coefficient of the linear Hall sensor, I is the input current of the linear Hall sensor, and is the angle between the linear Hall sensor and the magnetic field.

[0049] Example 2 This embodiment provides a method for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor mover shaft, which is applied to the above-mentioned two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device, and the method comprises the following steps: When the two-degree-of-freedom motor performs rotational motion, the voltage signals output by the first linear Hall sensor H1, the second linear Hall sensor H2, and the third linear Hall sensor H3 are collected, and the circumferential three-dimensional spatial position of the mover 7 during the motor rotational motion is calculated based on the voltage signals output by the first linear Hall sensor H1, the second linear Hall sensor H2, and the third linear Hall sensor H3.

[0050] Specifically, the specific steps of calculating the circumferential three-dimensional spatial position of the mover when the motor rotates according to the voltage signals output by the first linear Hall sensor H1, the second linear Hall sensor H2, and the third linear Hall sensor H3 are as follows: After analog-to-digital conversion of the voltage signals output by the first linear Hall sensor H1, the second linear Hall sensor H2, and the third linear Hall sensor H3, a linear combination is performed to obtain a digital signal in a two-phase stationary coordinate system, as shown below: Among them, U AIt is the digital signal after the analog-to-digital conversion of the output voltage signal of the first linear Hall H1 of the rotating unit, U B It is the digital signal after the analog-to-digital conversion of the output voltage signal of the second linear Hall H2 of the rotating unit, U C It is the digital signal after the analog-to-digital conversion of the output voltage signal of the third linear Hall H3 of the rotating unit; U ɑ is the α-direction component in the two-phase stationary coordinate system, U β is the β direction component in the two-phase stationary coordinate system; the α direction lags the β direction by 90° electrical angle; U0 is the zero axis component in the two-phase stationary coordinate system; U m is the amplitude of the output voltage signal of the three linear Hall elements; U DC is the DC component of the output voltage signal of the three linear Hall elements; θ is the actual electrical angle of the mover.

[0051] Specifically, the Clark transformation step is performed by the digital processor 14. After acquiring the digital signal under the two-phase stationary coordinates, the circumferential three-dimensional spatial position of the mover when the motor rotates is calculated based on the digital signal under the two-phase stationary coordinates using a synchronous reference frame phase-locked loop.

[0052] like Figure 7 As shown, in this embodiment, the synchronous reference frame synchronous reference frame phase-locked loop includes a phase detector 15 , a loop filter 16 and a voltage-controlled oscillator 17 .

[0053] The phase detector 15 performs the Park transformation step to detect the phase difference Δθ between the input signal and the output signal; the loop filter 16 is a type of low-pass filter, which is used to compensate for errors and filter out high-frequency harmonic components and noise in the input signal, and is usually implemented using a proportional-integral controller; the signal after loop filtering is input into a voltage-controlled oscillator to adjust the output signal to achieve tracking of the input signal; the output signal is the circumferential three-dimensional spatial position of the motor.

[0054] The phase detector 15 is represented in matrix form as follows: in, is the d-direction component in the two-phase rotating coordinate system, and the d-direction is consistent with the direct axis direction of the mover; is the q direction component in the two-phase rotating coordinate system and is the output signal of the synchronous detector. The q direction is consistent with the quadrature axis direction of the mover and is 90° ahead of the d direction in electrical angle; is the zero axis component in the two-phase rotating coordinate system; S is the 2s / 2r transformation; is the output signal of the reference frame converter and is the estimated electrical angle of the mover.

[0055] That is, it can be obtained from the matrix expression of the phase detector 15: and In When the phase difference is greater than 0, the estimated angle lags behind the actual angle, and the output signal increases under the action of the loop filter 16 and the voltage-controlled oscillator 17. When the phase difference is less than 0, the estimated angle is ahead of the actual angle, and the output signal is reduced under the action of the loop filter 16 and the voltage-controlled oscillator 17. When the phase difference approaches 0, the estimated angle accurately follows the actual angle.

[0056] When the two-degree-of-freedom motor performs linear motion, the voltage signals output by the fourth linear Hall sensor H4 and the fifth linear Hall sensor H5 are collected, and the axial three-dimensional spatial position of the mover during the linear motion of the motor is calculated based on the voltage signals output by the fourth linear Hall sensor H4 and the fifth linear Hall sensor H5.

[0057] It should be noted that the dual Hall inverse tangent position calculation method is used for the linear motor unit to obtain the axial three-dimensional spatial position of the mover when the motor moves linearly: in, ; x is the axial three-dimensional spatial position of the mover; τ is the pole length of the linear unit, d= τ / 2 is the distance between the fourth linear Hall sensor H4 and the fifth linear Hall sensor H5; u1 and u2 are the output voltages of the fourth linear Hall sensor H4 and the fifth linear Hall sensor H5, respectively.

[0058] When the two-degree-of-freedom motor performs spiral motion, the voltage signals output by the first linear Hall sensor H1, the second linear Hall sensor H2, the third linear Hall sensor H3, the fourth linear Hall sensor H4 and the fifth linear Hall sensor H5 are collected, and the circumferential three-dimensional spatial position of the mover during the rotational motion of the motor is first calculated according to the voltage signals output by the first linear Hall sensor H1, the second linear Hall sensor H2 and the third linear Hall sensor H3; then, the axial three-dimensional spatial position of the mover during the linear motion of the motor is calculated according to the voltage signals output by the fourth linear Hall sensor H4 and the fifth linear Hall sensor H5; finally, the circumferential three-dimensional spatial position of the mover during the spiral motion of the motor is calculated based on the axial three-dimensional spatial position of the mover during the linear motion of the motor and the circumferential three-dimensional spatial position of the mover during the rotational motion of the motor.

[0059] It should be noted that the method for calculating the circumferential three-dimensional spatial position of the mover when the motor rotates during spiral motion is consistent with the method for calculating the circumferential three-dimensional spatial position of the mover when the motor rotates during spiral motion, and the method for calculating the axial three-dimensional spatial position of the mover when the motor moves linearly is consistent with the method for calculating the axial three-dimensional spatial position of the mover when the motor moves linearly.

[0060] The following formula is used to calculate the circumferential three-dimensional spatial position of the mover during the motor's spiral motion based on the axial three-dimensional spatial position of the mover during the motor's linear motion and the circumferential three-dimensional spatial position of the mover during the motor's rotational motion: in, θ is the circumferential three-dimensional spatial position of the mover when the rotating unit moves, x is the axial three-dimensional spatial position of the mover when the motor moves linearly, that is, the linear unit displacement, L is the total length of the linear unit.

[0061] in, is the linear unit displacement x Convert the equivalent angular displacement, is the conversion factor that converts the linear unit displacement x Mapped to a certain angle range, x From 0 to L Map to φ From 0 to 2 .

[0062] like Figure 8 As shown, it is a waveform diagram of the angle signal solved in the implementation example of the present invention, which illustrates that the detected position angle is basically consistent with the actual position angle.

[0063] Example 3 This embodiment provides a two-degree-of-freedom motor rotor shaft circumferential three-dimensional spatial position detection system. Fig. 9 As shown, the device comprises the aforementioned 3D spatial position detection device for the circumferential direction of the rotor shaft of a two-degree-of-freedom motor, and further comprises: A first position calculation module is connected to the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor, and is used to collect the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor when the two-degree-of-freedom motor performs rotational motion, and to calculate the circumferential three-dimensional spatial position of the mover when the motor rotates according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor; A second position calculation module is connected to the fourth linear Hall sensor and the fifth linear Hall sensor, and is used to collect voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor when the two-degree-of-freedom motor performs linear motion, and calculate the axial three-dimensional spatial position of the mover when the motor performs linear motion according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; The third position calculation module is connected to the first position calculation module and the second position calculation module respectively, and is used to calculate the circumferential three-dimensional spatial position of the mover when the two-degree-of-freedom motor performs spiral motion based on the circumferential three-dimensional spatial position of the mover output by the first position calculation module and the axial three-dimensional spatial position of the mover output by the second position calculation module.

[0064] It can be understood that the specific calculation steps of the first position calculation module, the second position calculation module and the third position calculation module refer to Example 2 and are not described in detail here.

[0065] Example 4 This embodiment provides an electronic device, including a memory and a processor, wherein the memory stores a computer program, and the processor implements the steps of the aforementioned method when executing the computer program.

[0066] Example 5 This embodiment provides a computer-readable storage medium on which a computer program is stored, wherein the computer program implements the steps of the aforementioned method when executed by a processor.

[0067] Example 6 This embodiment provides a computer program product, including a computer program, characterized in that when the computer program is executed by a processor, the steps of the aforementioned method are implemented.

[0068] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, ordinary technicians in the field should understand that the specific implementation methods of the present invention can still be modified or some technical features can be replaced by equivalents without departing from the spirit of the technical solution of the present invention, which should be included in the scope of the technical solution for protection of the present invention.

Claims

1. A device for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor mover shaft, wherein the two-degree-of-freedom motor is a stator-half-type two-degree-of-freedom motor linear-rotary motor, comprising a mover, a rotary motion stator and a linear motion stator, and the mover is a salient pole structure; The rotary motion stator comprises a plurality of axially arranged rotary unit stator teeth and axially magnetized permanent magnets arranged in the rotary unit stator teeth, and a rotary unit stator slot is formed between any two rotary unit stator teeth; The linear motion stator comprises a plurality of circumferentially arranged linear motion stator teeth and circumferentially magnetized permanent magnets arranged in the linear motion stator teeth, and a linear motion stator slot is formed between any two linear motion stator teeth; Features: It includes a first linear Hall sensor, a second linear Hall sensor and a third linear Hall sensor arranged on the stator of the rotating unit; and a fourth linear Hall sensor and a fifth linear Hall sensor arranged on the linear motion stator; the magnetic density sensing surface of any linear Hall sensor is opposite to the salient pole structure surface of the mover; The first linear Hall sensor is installed in any one of the rotating unit stator slots, the second linear Hall sensor is installed in the rotating unit stator slot that is M1th away from the first linear Hall sensor in the reverse direction, and the third linear Hall sensor is installed in the rotating unit stator slot that is M1th away from the first linear Hall sensor in the forward direction; The fourth linear Hall sensor is installed in any linear motion stator slot, and the fifth linear Hall sensor is installed in the linear motion stator slot that is M2 th away from the fourth linear Hall sensor along any linear motion direction.

2. The device for detecting the circumferential three-dimensional position of a motor rotor shaft of a two-degree-of-freedom motor according to claim 1, characterized in that: M 1 =ks / (2p) , M 2 =Aτ / 2s; in, k To make M 1 is the smallest integer that is an integer, s is the number of stator slots of the rotating unit, p is the number of permanent magnet pairs on the rotating stator; τ is the pole length of the linear unit, A is the number of linear Hall sensors on the linear motion stator.

3. A method for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor mover shaft, applied to the two-degree-of-freedom motor mover shaft circumferential three-dimensional spatial position detection device according to any one of claims 1-2, characterized in that: The method comprises the following steps: When the two-degree-of-freedom motor performs rotational motion, the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor are collected, and the circumferential three-dimensional spatial position of the mover when the motor rotates is calculated according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor; When the two-degree-of-freedom motor performs linear motion, the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor are collected, and the axial three-dimensional spatial position of the mover when the motor performs linear motion is calculated according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; When the two-degree-of-freedom motor performs spiral motion, the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, the third linear Hall sensor, the fourth linear Hall sensor and the fifth linear Hall sensor are collected, and the circumferential three-dimensional spatial position of the mover when the motor rotates is first calculated according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor and the third linear Hall sensor; then the axial three-dimensional spatial position of the mover when the motor moves linearly is calculated according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; finally, the circumferential three-dimensional spatial position of the mover when the motor spirals is calculated based on the axial three-dimensional spatial position of the mover when the motor moves linearly and the circumferential three-dimensional spatial position of the mover when the motor rotates.

4. A method for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor rotor shaft according to claim 3, characterized in that: The specific steps of calculating the circumferential three-dimensional spatial position of the mover when the motor rotates according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor are as follows: After performing analog-to-digital conversion on the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor, a linear combination is performed to obtain a digital signal in a two-phase stationary coordinate system; Based on the digital signal in two-phase stationary coordinates, a synchronous reference frame phase-locked loop is used to calculate the circumferential three-dimensional spatial position of the mover when the motor rotates.

5. The method for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor rotor shaft according to claim 3, characterized in that: The specific steps of calculating the axial three-dimensional spatial position of the mover when the motor moves linearly according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor are as follows: The output voltages of the fourth linear Hall sensor and the fifth linear Hall sensor are obtained, and the inverse tangent calculation is performed based on the following formula to obtain the axial three-dimensional spatial position of the mover when the motor moves linearly: in, ; x is the axial three-dimensional spatial position of the mover; τ is the magnetic pole pitch, d= τ / 2; u1 and u2 are the output voltages of the fourth linear Hall sensor and the fifth linear Hall sensor respectively.

6. A method for detecting the circumferential three-dimensional spatial position of a two-degree-of-freedom motor rotor shaft according to claim 1, characterized in that: The following formula is used to calculate the circumferential three-dimensional spatial position of the mover during the motor's spiral motion based on the axial three-dimensional spatial position of the mover during the motor's linear motion and the circumferential three-dimensional spatial position of the mover during the motor's rotational motion: in, θ is the circumferential three-dimensional spatial position of the mover when the rotating unit moves, x is the axial three-dimensional spatial position of the mover when the motor moves linearly, L is the total length of the linear motion stator.

7. A 3D spatial position detection system for a two-degree-of-freedom motor rotor shaft, characterized in that: The device for detecting the circumferential three-dimensional spatial position of a rotor shaft of a two-degree-of-freedom motor according to any one of claims 1 to 2 further comprises: A first position calculation module is connected to the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor, and is used to collect voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor when the two-degree-of-freedom motor performs rotational motion, and calculate the circumferential three-dimensional spatial position of the mover when the motor rotates according to the voltage signals output by the first linear Hall sensor, the second linear Hall sensor, and the third linear Hall sensor; A second position calculation module is connected to the fourth linear Hall sensor and the fifth linear Hall sensor, and is used to collect voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor when the two-degree-of-freedom motor performs linear motion, and calculate the axial three-dimensional spatial position of the mover when the motor performs linear motion according to the voltage signals output by the fourth linear Hall sensor and the fifth linear Hall sensor; The third position calculation module is connected to the first position calculation module and the second position calculation module respectively, and is used to calculate the circumferential three-dimensional spatial position of the mover when the two-degree-of-freedom motor performs spiral motion based on the circumferential three-dimensional spatial position of the mover output by the first position calculation module and the axial three-dimensional spatial position of the mover output by the second position calculation module.

8. An electronic device comprising a memory and a processor, wherein the memory stores a computer program, wherein: When the processor executes the computer program, the steps of the method according to any one of claims 3 to 6 are implemented.

9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the method according to any one of claims 3 to 6 are implemented.

10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the steps of the method according to any one of claims 3 to 6 are implemented.

Citation Information

Patent Citations

  • Integrated position detection device and method for double stator linear rotating permanent magnet motor

    CN105762991B

  • A position detection method for a linear rotation two-degree-of-freedom permanent magnet motor

    CN105914952B

Cited By

  • Working method of device for measuring polarity and flatness of linear motor magnet

    CN121069281A