A nonmagnetic target control method and system based on eddy current effect
By combining five omnidirectional electromagnets and orthogonal drive coils, and utilizing the eddy current effect for closed-loop analytical calculations, the problems of high computational overhead and unexecutable commands in the control of non-magnetically conductive targets are solved, achieving real-time control and efficient planar trajectory tracking and yaw attitude maintenance.
Patent Information
- Application Number
- CN202611329515.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-31
- Publication Date
- 2026-11-17
AI Technical Summary
Existing technologies incur high computational overhead when controlling non-magnetically conductive targets, making it difficult to achieve high-frequency real-time calculations on embedded controllers, and the output control commands may be unexecutable.
Five omnidirectional electromagnets are used, each with three orthogonal drive coils. The optimal current and phase are calculated analytically in a closed loop using an eddy current force-torque positive model and a weighted cost function to directly drive the coils and achieve planar trajectory tracking and yaw attitude maintenance for non-magnetically conductive targets.
It realizes real-time non-magnetic conductive target control on embedded controllers with low computational load and physically executable output control commands, which can effectively control the planar position and yaw angle of copper or aluminum spheres or cylinders.
Smart Images

Figure CN123113864A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of non-magnetic conductive target control technology, and in particular to a non-magnetic target control method and system based on eddy current effect. Background Technology
[0002] Non-magnetic conductive objects such as copper and aluminum do not have inherent magnetic moments and cannot be driven directly by magnetic field moments. Rotating magnetic dipole magnetic fields can induce eddy currents inside conductive and non-magnetic conductive targets, thereby generating time-averaged forces and torques, thus achieving non-contact manipulation of non-magnetic conductive objects.
[0003] Existing technologies disclose physical models driven by rotating magnetic field eddy currents, proposing the use of a single magnetic dipole source for excitation. Constraint optimization is used to approximate the desired force and torque of a non-magnetically conductive target through generalized force approximation. Analogous experiments are conducted using four omnidirectional electromagnets to perform planar motion and yaw control of a copper sphere on a water surface. However, when the magnetic control array uses five omnidirectional electromagnets, each equipped with three orthogonal drive coils, providing a total of fifteen-dimensional current output, and the controlled object is limited to two-dimensional translational motion within the liquid surface and vertical axis yaw rotation, existing general numerical optimization schemes require iterative solutions, resulting in high computational overhead and difficulty in achieving high-frequency real-time calculations in embedded controllers. Furthermore, the eddy current effect does not satisfy the linear superposition characteristic of magnetic fields, and general optimization algorithms easily output control commands that are physically unexecutable. Summary of the Invention
[0004] To address the shortcomings of existing technologies, this invention provides a non-magnetic target control method and system based on eddy current effect. This invention does not require iterative optimization, has low computational overhead, and can run in real time on an embedded controller, realizing non-magnetic conductive target liquid surface plane trajectory tracking and yaw attitude maintenance.
[0005] In a first aspect, the present invention provides a non-magnetic target control method based on eddy current effect. The method is implemented on a magnetically controlled platform with five omnidirectional electromagnets arranged below a liquid surface. Each omnidirectional electromagnet has three mutually orthogonal drive coils. The method includes: Obtain the actual planar position and actual yaw angle of the non-magnetically conductive target within the liquid surface, and generate the desired planar position and desired yaw angle; The desired horizontal force is calculated based on the planar position deviation, and the desired moment about the vertical axis is calculated based on the yaw angle deviation and yaw angular velocity. For each of the five omnidirectional electromagnets, candidate rotation axes are evaluated one by one. For each candidate rotation axis, the actual horizontal force and actual torque around the vertical axis are predicted using the eddy current force-torque positive model. The square of the magnetic moment is solved in a closed loop only when the projection of the expected horizontal force in the direction of the horizontal force of the candidate rotation axis is positive. The optimal omnidirectional electromagnet, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function. Based on the optimal candidate rotation axis and the optimal magnetic moment amplitude, the rotating magnetic dipole moment is reconstructed into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet; Based on the current amplitude and phase of the corresponding drive coil, a real-time instantaneous sinusoidal drive current is output to drive the drive coils of each omnidirectional electromagnet.
[0006] Secondly, the present invention provides a non-magnetic target control system based on eddy current effect, comprising: The pose acquisition module is used to obtain the actual planar position and actual yaw angle of a non-magnetically conductive target in the liquid surface, and to generate the desired planar position and desired yaw angle. The desired force and torque calculation module is used to calculate the desired horizontal force based on the planar position deviation, and to calculate the desired torque about the vertical axis based on the yaw angle deviation and yaw angular velocity. The magnet screening module is used to evaluate candidate rotation axes one by one for the five omnidirectional electromagnets. For each candidate rotation axis, the actual horizontal force and actual torque around the vertical axis are predicted using the eddy current force-torque positive model. The magnetic moment square is solved in a closed loop only when the projection of the expected horizontal force in the horizontal force direction of the candidate rotation axis is positive. The optimal omnidirectional electromagnet, the optimal candidate rotation axis and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function. The current-phase calculation module is used to reconstruct the rotating magnetic dipole moment into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet based on the optimal candidate rotating axis and the optimal magnetic moment amplitude. The driving module is used to output a real-time instantaneous sinusoidal driving current based on the current amplitude and phase of the corresponding driving coil to drive the driving coils of each omnidirectional electromagnet.
[0007] Thirdly, the present invention provides an electronic device, comprising: At least one embedded controller; and a memory that is communicatively connected to the at least one embedded controller; The memory stores a computer program that can be executed by at least one embedded controller, which, when executed by the at least one embedded controller, implements the non-magnetic target control method based on eddy current effect.
[0008] Fourthly, the present invention provides a computer-readable storage medium storing a computer-executable computer program, which, when executed by a processor, implements the non-magnetic target control method based on eddy current effect.
[0009] The beneficial effects of this invention are as follows: 1. This invention utilizes the physical relationship that eddy current force and torque are proportional to the square of magnetic moment, employs closed-loop analytical calculation, has no iterative optimization process, has a small computational load, can run in real time on an embedded controller, and meets the closed-loop control cycle requirements; 2. This invention uses the expectation that the projection of the horizontal force onto the candidate force direction is positive as a candidate screening condition to eliminate candidate solutions that are physically unrealizable under the eddy current repulsion effect, thus ensuring that the output control command is physically executable. 3. This invention uses a weighted cost function to balance the control priorities of planar trajectory tracking and yaw attitude maintenance; 4. This invention realizes the analytical reconstruction of the amplitude and phase of the current in the rotating magnetic dipole moment coil, and analytically solves the amplitude and phase of the sinusoidal current in each driving coil; the output is a current command that can be directly recognized by hardware. 5. This invention can be directly deployed on a five-omnidirectional electromagnet liquid surface magnetocontrol array platform to achieve closed-loop control of planar position and yaw angle for non-magnetically conductive targets such as spheres and cylinders made of copper and aluminum. The platform has strong reusability. Attached Figure Description
[0010] Figure 1 This is a flowchart illustrating the method of an embodiment of the present invention; Figure 2 This is a schematic diagram of the rotation axis configuration according to an embodiment of the present invention; Figure 3 This is a structural framework diagram of the system according to an embodiment of the present invention; In the figure, 10 is the pose acquisition module; 20 is the desired force and torque calculation module; 30 is the magnet screening module; 40 is the current-phase calculation module; and 50 is the drive module. Detailed Implementation
[0011] The specific embodiments of the present invention will be further described below with reference to the accompanying drawings: like Figure 1 As shown, this embodiment provides a non-magnetic target control method based on eddy current effect. The method is implemented on a magnetically controlled platform with five omnidirectional electromagnets arranged below the liquid surface. Each omnidirectional electromagnet has three mutually orthogonal drive coils. The method includes: S1: Obtain the actual planar position and actual yaw angle of the non-magnetically conductive target within the liquid surface, and generate the desired planar position and desired yaw angle; S2: Calculate the desired horizontal force based on the planar position deviation, and calculate the desired moment about the vertical axis based on the yaw angle deviation and yaw angular velocity; S3: Evaluate the candidate rotation axes for each of the five omnidirectional electromagnets. For each candidate rotation axis, use the eddy current force-torque positive model to predict the actual horizontal force and the actual torque around the vertical axis. Only when the projection of the expected horizontal force in the direction of the horizontal force of the candidate rotation axis is positive, solve the square of the magnetic moment in a closed loop. Select the optimal omnidirectional electromagnet, the optimal candidate rotation axis and the optimal magnetic moment amplitude from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function. S4: Based on the optimal candidate rotation axis and the optimal magnetic moment amplitude, reconstruct the rotating magnetic dipole moment into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet; S5: Based on the current amplitude and phase of the corresponding drive coil, output a real-time instantaneous sinusoidal drive current to drive the drive coils of each omnidirectional electromagnet.
[0012] In this embodiment, step S1 involves obtaining the actual planar position and actual yaw angle of the non-magnetically conductive target within the liquid surface, and generating the desired planar position and desired yaw angle, including: S11: With a fixed sampling period The optical motion capture camera is triggered to acquire images of non-magnetically conductive target markers, and the original planar coordinates are calculated. Compared with the original yaw angle ; S12: Original yaw angle Execution angle winding, turning the original yaw angle Constrain to interval And a first-order digital low-pass filter is used to process the original planar coordinates. Compared with the original yaw angle After performing noise reduction preprocessing, the actual planar position and actual yaw angle of the non-magnetically conductive target in the current period are obtained, i.e.: ; In the formula, , Each is the current period The actual planar position and actual yaw angle of a non-magnetically conductive target; These are the filter coefficients.
[0013] S13: The desired planar position and desired yaw angle are generated by the trajectory generator. The trajectory generator has two operating modes: stationary position holding and time-varying trajectory tracking. When the trajectory generator is in stationary position holding mode, the set planar position and set yaw angle are loaded as the desired planar position and desired yaw angle, that is: ; In the formula, , These represent the desired horizontal position and the desired yaw angle, respectively; superscript Indicates the transpose operation; These are the x and y coordinates of the desired planar position, respectively. , These are for setting the horizontal position and setting the yaw angle, respectively.
[0014] When the trajectory generator operates in time-varying trajectory tracking mode, based on the current time... Substituting the reference trajectory function, the desired planar position and desired yaw angle are generated, i.e.: ; In the formula, , The reference trajectory function; This is the controller sampling period.
[0015] In this embodiment, step S2, calculating the desired horizontal force based on the planar position deviation and calculating the desired moment about the vertical axis based on the yaw angle deviation and yaw angular velocity, includes: S21: Calculate the planar position deviation based on the actual and desired planar positions of the non-magnetically conductive target, i.e.: ; In the formula, Let $k$ be the planar position deviation for the current period $k$. S22: The actual planar velocity of the non-magnetically conductive target is estimated from the actual planar positions of the preceding and following periods using backward differential calorimetry, and the desired planar velocity is obtained by differential calorimetry from the desired planar position, i.e.: ; ; In the formula, The actual planar velocity of the non-magnetically conductive target in the current period k; Let be the desired planar velocity of the non-magnetically conductive target in the current period k.
[0016] S23: Based on the planar position deviation, actual planar velocity, and desired planar velocity of the non-magnetically conductive target in the current period k, the desired horizontal force is calculated using a proportional-derivative (PD) control law, i.e.: ; In the formula, , These are the position proportional gain matrix and the position differential gain matrix, respectively. For the desired horizontal force; These are the components of the desired horizontal force along the x and y axes, respectively.
[0017] S24: Calculate the yaw angle deviation by performing a orbiting calculation based on the actual yaw angle and the desired yaw angle, i.e.: ; In the formula, This refers to the yaw angle deviation; Indicates will Fold to range .
[0018] S25: Obtain the actual yaw rate and the desired yaw rate through backward difference, i.e.: ; ; In the formula, , These are the actual yaw rate and the expected yaw rate of the non-magnetically conductive target in the current period k, respectively.
[0019] S26: Based on the yaw angle deviation, desired yaw angular velocity, and actual yaw angular velocity, the desired moment about the vertical axis is calculated using proportional-derivative control, i.e.: ; In the formula, Let k be the desired torque about the vertical axis of the non-magnetically conductive target in the current period k. This is the yaw angle proportional gain; This is the yaw rate damping gain.
[0020] In this embodiment, in step S3, candidate rotation axes are evaluated one by one for the five omnidirectional electromagnets. For each candidate rotation axis, the actual horizontal force and actual torque around the vertical axis are predicted using the eddy current force-torque positive model. The square of the magnetic moment is solved in a closed loop only when the projection of the expected horizontal force in the horizontal force direction of the candidate rotation axis is positive. The optimal omnidirectional electromagnet, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function. S31: Initialize global storage variables, set the global minimum cost value. Initialize to positive infinity; S32: Iterate through each omnidirectional electromagnet and calculate the line-of-sight direction from each omnidirectional electromagnet to a non-magnetically conductive target. ,Right now: ; In the formula, For the current period The actual planar position of a non-magnetically conductive target; For the current period k omnidirectional electromagnet Position vector; It is an L2 norm.
[0021] S33: Construct a set of candidate rotation axes that includes the line of sight, the line of sight reverse, and several candidate rotation axes obtained by scanning at discrete angles in a plane perpendicular to the line of sight; the candidate rotation axes in the plane perpendicular to the line of sight are orthogonal to the line of sight vector, and their three-dimensional force is synthesized by the radial component and the tangential component obtained by the cross product of the line of sight and the rotation axis and then projected horizontally, and the torque about the vertical axis is determined by the vertical component of the rotation axis. S34: Traverse each candidate rotation axis under the current omnidirectional electromagnet By calling the pre-calibrated eddy current force-torque positive model, candidate rotation axes under unit magnetic moment squared are obtained. The corresponding horizontal force vector and the moment coefficient about the vertical axis Calculate the desired horizontal force on the candidate rotation axis Output the projection of the horizontal force direction; if the projection is less than or equal to zero, determine the candidate rotation axis. If invalid, skip the candidate rotation axis. If the projection is greater than zero, then a candidate rotation axis is determined. Effective; that is: ; In the formula, Indicates projection; For the desired horizontal force; Candidate rotation axis The corresponding horizontal force vector.
[0022] S35: For valid candidate rotation axes The square of the magnetic moment can be solved using a closed-form formula based on the physical relationship that the eddy current force is proportional to the square of the magnetic moment: ; In the formula, Omnidirectional Electromagnet The square of the magnetic moment; Based on the maximum magnetic moment of the hardware Limiting the square of the magnetic moment, if an omnidirectional electromagnet... The square of the magnetic moment Less than or equal to And if it is greater than or equal to 0, then the magnetic moment amplitude ;like Greater than Then take ;if ,but ; And calculate the actual horizontal force under the corresponding magnetic moment amplitude based on the square of the magnetic moment. and actual torque about the vertical axis .
[0023] S36: Construct a weighted cost function based on the desired horizontal force, actual horizontal force, desired moment about the vertical axis, and actual moment about the vertical axis. The weighted cost function simultaneously represents the error in the horizontal force and the error in the moment about the vertical axis, i.e.: ; In the formula, Omnidirectional Electromagnet and valid candidate rotation axes The weighted cost function; This is the torque error weighting coefficient.
[0024] If the current valid candidate rotation axis If the cost value is less than the saved global minimum cost value, then update the global minimum cost value and record the corresponding optimal omnidirectional electromagnet number, optimal candidate rotation axis, and optimal magnetic moment amplitude; for the two sets of candidates, one with the lower cost value and one with the opposite line of sight, retain the set with the lower cost value. S37: After all candidates of the five omnidirectional electromagnets have been traversed, if there are no valid candidates, the optimal magnetic moment amplitude is set to zero; otherwise, the optimal omnidirectional electromagnet number, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are output.
[0025] like Figure 2 As shown in (a), the candidate axis of rotation is along the line of sight; flipping the axis of rotation does not change the actual horizontal force. However, it will reverse the yaw moment about the vertical axis; it can be achieved without changing the actual horizontal force. Adjust the sign of the torque under the premise of direction.
[0026] like Figure 2 As shown in (b), the candidate rotation axis lies in the plane perpendicular to the line of sight; at this time, the actual horizontal force... It includes radial and tangential components, which can extend the range of force directions that a single omnidirectional electromagnet can achieve.
[0027] In this embodiment, step S4 involves reconstructing the rotating magnetic dipole moment into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet based on the optimal candidate rotation axis and the optimal magnetic moment amplitude, including: S41: Construct two unit orthogonal vectors that are orthogonal to the optimal candidate rotation axis. , unit orthogonal vectors , Zhang Cheng rotates in a plane perpendicular to the axis of rotation; the rotating magnetic dipole moment constraint rotates in uniform circular motion at an angular frequency within the plane of rotation. The vector expression for the rotating magnetic dipole moment is: ; In the formula, Let be the rotating magnetic dipole moment vector at time t; The optimal magnetic moment amplitude; ω is the angular frequency.
[0028] S42: Obtain the unit vectors corresponding to the axes of the three orthogonal drive coils inside the optimal omnidirectional electromagnet. , , Projecting the rotating magnetic dipole moment vector onto the axes of the three drive coils respectively, and substituting it into the expression for the rotating magnetic dipole moment vector, yields the cosine and sine amplitudes of the corresponding upward magnetic moment components of the drive coils. Then, the amplitude and phase of the drive coil current are solved, i.e.: ; Using trigonometric identities, we obtain: ; The cosine and sine amplitudes of the corresponding upward magnetic moment components of the driving coil are obtained as follows: ; In the formula, , respectively drive coil The amplitudes of the cosine and sine terms of the axial magnetic moment component; For driving coil The current amplitude; For driving coil The phase; is the current-to-magnetic moment conversion coefficient.
[0029] Determine the current amplitude and phase of the drive coil: ; In the formula, It is the arctangent function in the four quadrants.
[0030] In this embodiment, the current amplitudes of the four omnidirectional electromagnets, excluding the optimal omnidirectional electromagnet, are set to 0.
[0031] In this embodiment, in step S5, the driving coils of each omnidirectional electromagnet are driven to operate based on the current amplitude and phase of the corresponding driving coil, and a real-time instantaneous sinusoidal driving current is output.
[0032] The current amplitude and phase of the drive coil are sent to the power drive unit, which generates a real-time instantaneous sinusoidal drive current. By using real-time instantaneous sinusoidal drive current Controlling an omnidirectional electromagnet, i.e.: .
[0033] In this embodiment, the five omnidirectional electromagnets are arranged at the four corners and center of a square, below the motion plane of the non-magnetically conductive target. The non-magnetically conductive target is a sphere or cylinder made of copper or aluminum. The omnidirectional electromagnets control the translation of the non-magnetically conductive target along two orthogonal directions of the liquid surface and its rotation around the vertical axis.
[0034] like Figure 3 As shown, the second embodiment of the present invention provides a non-magnetic target control system based on eddy current effect, including a pose acquisition module 10, a desired force and torque calculation module 20, a magnet screening module 30, a current-phase calculation module 40, and a drive module 50.
[0035] In this embodiment, the pose acquisition module 10 is configured to acquire the actual planar position and actual yaw angle of a non-magnetically conductive target within the liquid surface, and generate the desired planar position and desired yaw angle.
[0036] In this embodiment, the pose acquisition module 10 uses a fixed sampling period. The optical motion capture camera is triggered to acquire images of non-magnetically conductive target markers, and the original planar coordinates are calculated. Compared with the original yaw angle .
[0037] In this embodiment, the pose acquisition module 10 sets the original yaw angle. Execution angle winding, turning the original yaw angle Constrain to interval And a first-order digital low-pass filter is used to process the original planar coordinates. Compared with the original yaw angle After performing noise reduction preprocessing, the actual planar position and actual yaw angle of the non-magnetically conductive target in the current period are obtained, i.e.: ; In the formula, , Each is the current period The actual planar position and actual yaw angle of a non-magnetically conductive target; These are the filter coefficients.
[0038] In this embodiment, the pose acquisition module 10 generates a desired planar position and a desired yaw angle through a trajectory generator. The trajectory generator operates in two modes: fixed-point holding and time-varying trajectory tracking. When the trajectory generator operates in fixed-point holding mode, a set planar position and a set yaw angle are loaded as the desired planar position and desired yaw angle, i.e.: ; In the formula, , These represent the desired horizontal position and the desired yaw angle, respectively; superscript Indicates the transpose operation; These are the x and y coordinates of the desired planar position, respectively. , These are for setting the horizontal position and setting the yaw angle, respectively.
[0039] When the trajectory generator operates in time-varying trajectory tracking mode, based on the current time... Substituting the reference trajectory function, the desired planar position and desired yaw angle are generated, i.e.: ; In the formula, , The reference trajectory function; This is the controller sampling period.
[0040] In this embodiment, the desired force and torque calculation module 20 is configured to calculate the desired horizontal force based on the planar position deviation and to calculate the desired torque about the vertical axis based on the yaw angle deviation and yaw angular velocity.
[0041] In this embodiment, the planar position deviation is calculated based on the actual planar position and the desired planar position of the non-magnetically conductive target, that is: ; In the formula, Let be the planar position deviation of the current period k.
[0042] In this embodiment, backward differential is used to estimate the actual planar velocity of the non-magnetically conductive target from the actual planar positions of the preceding and following periods, and the desired planar velocity is obtained by differentiating the desired planar position, that is: ; ; In the formula, The actual planar velocity of the non-magnetically conductive target in the current period k; Let be the desired planar velocity of the non-magnetically conductive target in the current period k.
[0043] In this embodiment, based on the planar position deviation, actual planar velocity, and desired planar velocity of the non-magnetically conductive target in the current period k, the desired horizontal force is calculated using a proportional-derivative (PD) control law, i.e.: ; In the formula, , These are the position proportional gain matrix and the position differential gain matrix, respectively. For the desired horizontal force; These are the components of the desired horizontal force along the x and y axes, respectively.
[0044] In this embodiment, the yaw angle deviation is calculated by performing a circling operation based on the actual yaw angle and the desired yaw angle, that is: ; In the formula, This refers to the yaw angle deviation; Indicates will Fold to range .
[0045] In this embodiment, the actual yaw rate and the desired yaw rate are obtained by backward difference, that is: ; ; In the formula, , These are the actual yaw rate and the expected yaw rate of the non-magnetically conductive target in the current period k, respectively.
[0046] In this embodiment, based on the yaw angle deviation, the desired yaw angular velocity, and the actual yaw angular velocity, proportional-derivative control is used to calculate the desired moment about the vertical axis, i.e.: ; In the formula, Let k be the desired torque about the vertical axis of the non-magnetically conductive target in the current period k. This is the yaw angle proportional gain; This is the yaw rate damping gain.
[0047] In this embodiment, the magnet screening module 30 is configured to evaluate candidate rotation axes one by one for the five omnidirectional electromagnets. For each candidate rotation axis, the actual horizontal force and the actual torque around the vertical axis are predicted using the eddy current force-torque positive model. The square of the magnetic moment is solved in a closed loop only when the projection of the expected horizontal force in the horizontal force direction of the candidate rotation axis is positive. The optimal omnidirectional electromagnet, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function.
[0048] In this embodiment, the magnet screening module 30 initializes the global storage variable, setting the global minimum cost value. Initialize to positive infinity.
[0049] In this embodiment, the magnet screening module 30 iterates through each omnidirectional electromagnet and calculates the line-of-sight direction of each omnidirectional electromagnet pointing towards a non-magnetically conductive target. ,Right now: ; In the formula, For the current period The actual planar position of a non-magnetically conductive target; For the current period k omnidirectional electromagnet Position vector; It is an L2 norm.
[0050] In this embodiment, the magnet screening module 30 constructs a candidate rotation axis set including the line of sight direction, the line of sight reverse direction, and several candidate rotation axes obtained by scanning at discrete angles in a plane perpendicular to the line of sight direction; the candidate rotation axes in the plane perpendicular to the line of sight direction are orthogonal to the line of sight vector, and their three-dimensional force is synthesized by the radial component and the tangential component obtained by the cross product of the line of sight and the rotation axis and then projected horizontally, and the torque about the vertical axis is determined by the vertical component of the rotation axis.
[0051] In this embodiment, the magnet screening module 30 traverses each candidate rotation axis under the current omnidirectional electromagnet. By calling the pre-calibrated eddy current force-torque positive model, candidate rotation axes under unit magnetic moment squared are obtained. The corresponding horizontal force vector and the moment coefficient about the vertical axis Calculate the desired horizontal force on the candidate rotation axis Output the projection of the horizontal force direction; if the projection is less than or equal to zero, determine the candidate rotation axis. If invalid, skip the candidate rotation axis. If the projection is greater than zero, then a candidate rotation axis is determined. Effective; that is: ; In the formula, Indicates projection; For the desired horizontal force; Candidate rotation axis The corresponding horizontal force vector.
[0052] For valid candidate rotation axes The square of the magnetic moment can be solved using a closed-form formula based on the physical relationship that the eddy current force is proportional to the square of the magnetic moment: ; In the formula, Omnidirectional Electromagnet The square of the magnetic moment.
[0053] Based on the maximum magnetic moment of the hardware Limiting the square of the magnetic moment, if an omnidirectional electromagnet... The square of the magnetic moment Less than or equal to And if it is greater than or equal to 0, then the magnetic moment amplitude ;like Greater than Then take ;if ,but .
[0054] And calculate the actual horizontal force under the corresponding magnetic moment amplitude based on the square of the magnetic moment. and actual torque about the vertical axis .
[0055] A weighted cost function is constructed based on the expected horizontal force, the actual horizontal force, the expected moment about the vertical axis, and the actual moment about the vertical axis. This weighted cost function simultaneously represents the error in both the horizontal force and the error in the moment about the vertical axis. ; In the formula, Omnidirectional Electromagnet and valid candidate rotation axes The weighted cost function; This is the torque error weighting coefficient.
[0056] If the current valid candidate rotation axis If the cost value is less than the saved global minimum cost value, then update the global minimum cost value and record the corresponding optimal omnidirectional electromagnet number, optimal candidate rotation axis, and optimal magnetic moment amplitude; for the two candidate groups, the line-of-sight direction and the line-of-sight opposite, complete all calculations and cost evaluations respectively, and retain the group with the smaller cost value.
[0057] After all candidates of the five omnidirectional electromagnets have been traversed, if no valid candidate is found, the optimal magnetic moment amplitude is set to zero; otherwise, the optimal omnidirectional electromagnet number, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are output.
[0058] In this embodiment, the current-phase calculation module 40 is configured to reconstruct the rotating magnetic dipole moment into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet based on the optimal candidate rotating axis and the optimal magnetic moment amplitude.
[0059] Construct two unit orthogonal vectors that are orthogonal to the optimal candidate rotation axis. , unit orthogonal vectors , Zhang Cheng rotates in a plane perpendicular to the axis of rotation; the rotating magnetic dipole moment constraint rotates in uniform circular motion at an angular frequency within the plane of rotation. The vector expression for the rotating magnetic dipole moment is: ; In the formula, Let be the rotating magnetic dipole moment vector at time t; The optimal magnetic moment amplitude; ω is the angular frequency.
[0060] Obtain the unit vectors corresponding to the axes of the three orthogonal drive coils inside the optimal omnidirectional electromagnet. , , Projecting the rotating magnetic dipole moment vector onto the axes of the three drive coils respectively, and substituting it into the expression for the rotating magnetic dipole moment vector, yields the cosine and sine amplitudes of the corresponding upward magnetic moment components of the drive coils. Then, the amplitude and phase of the drive coil current are solved, i.e.: ; Using trigonometric identities, we obtain: ; The cosine and sine amplitudes of the corresponding upward magnetic moment components of the driving coil are obtained as follows: ; In the formula, , respectively drive coil The amplitudes of the cosine and sine terms of the axial magnetic moment component; For driving coil The current amplitude; For driving coil The phase; is the current-to-magnetic moment conversion coefficient.
[0061] Determine the current amplitude and phase of the drive coil: ; In the formula, It is the arctangent function in the four quadrants.
[0062] In this embodiment, the current amplitudes of the four omnidirectional electromagnets, excluding the optimal omnidirectional electromagnet, are set to 0.
[0063] In this embodiment, the driving module 50 is configured to output a real-time instantaneous sinusoidal driving current based on the current amplitude and phase of the corresponding driving coil to drive the driving coil of each omnidirectional electromagnet.
[0064] The current amplitude and phase of the drive coil are sent to the power drive unit, which generates a real-time instantaneous sinusoidal drive current. By using real-time instantaneous sinusoidal drive current Controlling an omnidirectional electromagnet, i.e.: .
[0065] In this embodiment, the five omnidirectional electromagnets are arranged at the four corners and center of a square, below the motion plane of the non-magnetically conductive target. The non-magnetically conductive target is a sphere or cylinder made of copper or aluminum. The omnidirectional electromagnets control the translation of the non-magnetically conductive target along two orthogonal directions of the liquid surface and its rotation around the vertical axis.
[0066] A third embodiment of the present invention provides an electronic device, comprising: At least one embedded controller; and a memory that is communicatively connected to the at least one embedded controller; The memory stores a computer program that can be executed by at least one embedded controller, which, when executed by the at least one embedded controller, implements the non-magnetic target control method based on eddy current effect.
[0067] A fourth embodiment of the present invention provides a computer-readable storage medium storing a computer-executable computer program, which, when executed by a processor, implements the non-magnetic target control method based on eddy current effect.
[0068] In some embodiments, the memory may be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic storage, flash memory, magnetic disk, or optical disk. A processor, coupled to the memory, is used to execute computer programs in the memory.
[0069] In some embodiments, the computer program includes computer program code, which may be in the form of source code, object code, executable file, or some intermediate form. Computer-readable media may include at least: any entity or device capable of carrying computer program code into an electronic device, recording media, computer memory, read-only memory (ROM), random access memory (RAM), electrical carrier signals, telecommunication signals, and software distribution media. Examples include USB flash drives, portable hard drives, magnetic disks, or optical disks.
[0070] The embodiments and descriptions above are merely illustrative of the principles and preferred embodiments of the present invention. Various changes and modifications may be made to the present invention without departing from its spirit and scope, and all such changes and modifications fall within the scope of the present invention as claimed.
Claims
1. A non-magnetic target control method based on eddy current effect, wherein the method is implemented on a magnetically controlled platform with five omnidirectional electromagnets arranged below the liquid surface, each of the omnidirectional electromagnets having three mutually orthogonal drive coils, characterized in that, The method includes: Obtain the actual planar position and actual yaw angle of the non-magnetically conductive target within the liquid surface, and generate the desired planar position and desired yaw angle; The desired horizontal force is calculated based on the planar position deviation, and the desired moment about the vertical axis is calculated based on the yaw angle deviation and yaw angular velocity. For each of the five omnidirectional electromagnets, candidate rotation axes are evaluated one by one. For each candidate rotation axis, the actual horizontal force and actual torque about the vertical axis are predicted using the eddy current force-torque positive model. The square of the magnetic moment is solved in a closed loop only when the projection of the expected horizontal force in the direction of the horizontal force of the candidate rotation axis is positive. The optimal omnidirectional electromagnet, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function. Based on the optimal candidate rotation axis and the optimal magnetic moment amplitude, the rotating magnetic dipole moment is reconstructed into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet; Based on the current amplitude and phase of the corresponding drive coil, a real-time instantaneous sinusoidal drive current is output to drive the drive coils of each omnidirectional electromagnet.
2. The method according to claim 1, characterized in that: Obtain the actual planar position and actual yaw angle of a non-magnetically conductive target within the liquid surface, including: An optical motion capture camera is triggered to acquire images of non-magnetically conductive target markers using a fixed sampling period, and the original planar coordinates and original yaw angle are calculated. Perform angle winding on the original yaw angle to constrain it to the interval. A first-order digital low-pass filter is used to perform noise reduction preprocessing on the original planar coordinates and the original yaw angle to obtain the actual planar position and actual yaw angle of the non-magnetically conductive target in the current period.
3. The method according to claim 1, characterized in that: Generate the desired planar position and desired yaw angle, including: The desired planar position and desired yaw angle are generated by a trajectory generator. The trajectory generator has two working modes: fixed-point holding and time-varying trajectory tracking. When the trajectory generator is in fixed-point holding mode, the set planar position and set yaw angle are loaded as the desired planar position and desired yaw angle. When the trajectory generator operates in time-varying trajectory tracking mode, the current time is substituted into the reference trajectory function to generate the desired planar position and desired yaw angle.
4. The method according to claim 1, characterized in that: The desired horizontal force is calculated based on the planar position deviation, and the desired moment about the vertical axis is calculated based on the yaw angle deviation and yaw angular velocity, including: Calculate the planar position deviation based on the actual and desired planar positions of the non-magnetically conductive target; The actual planar velocity of a non-magnetically conductive target is estimated from the actual planar position of the preceding and following periods using backward differential calorimetry, and the desired planar velocity is obtained by differential calorimetry from the desired planar position. Based on the planar position deviation, actual planar velocity, and desired planar velocity of the non-magnetically conductive target in the current cycle, the desired horizontal force is calculated using a proportional-derivative (PD) control law. The yaw angle deviation is calculated by performing a orbiting operation based on the actual yaw angle and the expected yaw angle. The actual yaw rate and the desired yaw rate are obtained by backward difference. Based on the yaw angle deviation, the desired yaw angular velocity, and the actual yaw angular velocity, the desired moment about the vertical axis is calculated using proportional-derivative control.
5. The method according to claim 1, characterized in that: For each of the five omnidirectional electromagnets, candidate rotation axes are evaluated. For each candidate rotation axis, the actual horizontal force and actual torque about the vertical axis are predicted using a positive eddy current force-torque model. The square of the magnetic moment is solved in a closed loop only when the projection of the desired horizontal force in the direction of the horizontal force on the candidate rotation axis is positive. Based on the weighted cost function, the optimal omnidirectional electromagnet, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes, including: Iterate through each omnidirectional electromagnet and calculate the line-of-sight direction of each omnidirectional electromagnet pointing to a non-magnetically conductive target; Construct a candidate rotation axis set that includes the line of sight, the line of sight reverse, and several candidate rotation axes obtained by scanning at discrete angles in a plane perpendicular to the line of sight; Traverse each candidate rotation axis under the current omnidirectional electromagnet Call the pre-calibrated eddy current force-torque positive model to obtain the horizontal force vector and torque coefficient around the vertical axis corresponding to the candidate rotation axis under the unit magnetic moment square. Calculate the projection of the desired horizontal force on the direction of the output horizontal force on the corresponding candidate rotation axis. If the projection is less than or equal to zero, the corresponding candidate rotation axis is determined to be invalid and the candidate rotation axis is skipped. If the projection is greater than zero, the corresponding candidate rotation axis is determined to be valid. For a valid candidate rotating axis, the square of the magnetic moment is solved in a closed loop according to the physical relationship that the eddy current force is proportional to the square of the magnetic moment. The square of the magnetic moment is limited according to the maximum magnetic moment in the hardware, and the actual horizontal force under the corresponding magnetic moment amplitude is calculated based on the limited magnetic moment square. A weighted cost function is constructed based on the expected horizontal force, the actual horizontal force, the expected moment about the vertical axis, and the actual moment about the vertical axis. The weighted cost function simultaneously represents the error of the horizontal force and the error of the moment about the vertical axis. If the cost of the current valid candidate rotation axis is less than the saved global minimum cost, then update the global minimum cost and record the corresponding optimal omnidirectional electromagnet number, optimal candidate rotation axis, and optimal magnetic moment amplitude; for the two groups of candidates with the line of sight direction and the line of sight opposite, complete all calculations and cost evaluations respectively, and retain the group with the smaller cost. After traversing all five omnidirectional electromagnets, if there are no valid candidate rotation axes, the optimal magnetic moment amplitude is set to zero; otherwise, the optimal omnidirectional electromagnet number, the optimal candidate rotation axis, and the optimal magnetic moment amplitude are output.
6. The method according to claim 1, characterized in that: Based on the optimal candidate rotation axis and the optimal magnetic moment amplitude, the rotating magnetic dipole moment is reconstructed into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet, including: Construct two unit orthogonal vectors that are orthogonal to the optimal candidate rotation axis. The unit orthogonal vectors span a rotation plane perpendicular to the rotation axis. The rotating magnetic dipole moment constraint rotates in uniform circular motion at an angular frequency within the rotation plane. Obtain the unit vectors corresponding to the axes of the three orthogonal drive coils inside the optimal omnidirectional electromagnet. Project the rotating magnetic dipole moment vector onto the axes of the three drive coils respectively, and substitute it into the expression of the rotating magnetic dipole moment vector to obtain the cosine and sine amplitudes of the magnetic moment components in the axial direction of the corresponding drive coils. Then solve for the amplitude and phase of the drive coil current.
7. The method according to claim 1, characterized in that: Based on the current amplitude and phase of the corresponding drive coil, a real-time instantaneous sinusoidal drive current is output to drive the drive coils of each omnidirectional electromagnet, including: The current amplitude and phase of the drive coil are sent to the power drive unit, which generates a real-time instantaneous sinusoidal drive current to control the omnidirectional electromagnet.
8. The method according to claim 1, characterized in that: The five omnidirectional electromagnets are arranged at the four corners and center of a square, below the plane of motion of the non-magnetically conductive target. The non-magnetically conductive target is a sphere or cylinder made of copper or aluminum. The omnidirectional electromagnets control the translation of the non-magnetically conductive target along two orthogonal directions of the liquid surface and its rotation around the vertical axis.
9. A non-magnetic target control system based on eddy current effect, characterized in that, include: The pose acquisition module is used to obtain the actual planar position and actual yaw angle of a non-magnetically conductive target in the liquid surface, and to generate the desired planar position and desired yaw angle. The desired force and torque calculation module is used to calculate the desired horizontal force based on the planar position deviation, and to calculate the desired torque about the vertical axis based on the yaw angle deviation and yaw angular velocity. The magnet screening module is used to evaluate candidate rotation axes one by one for the five omnidirectional electromagnets. For each candidate rotation axis, the actual horizontal force and actual torque around the vertical axis are predicted using the eddy current force-torque positive model. The magnetic moment square is solved in a closed loop only when the projection of the expected horizontal force in the horizontal force direction of the candidate rotation axis is positive. The optimal omnidirectional electromagnet, the optimal candidate rotation axis and the optimal magnetic moment amplitude are selected from all omnidirectional electromagnets and all candidate rotation axes according to the weighted cost function. The current-phase calculation module is used to reconstruct the rotating magnetic dipole moment into the current amplitude and phase of the three driving coils of the optimal omnidirectional electromagnet based on the optimal candidate rotating axis and the optimal magnetic moment amplitude. The driving module is used to output a real-time instantaneous sinusoidal driving current based on the current amplitude and phase of the corresponding driving coil to drive the driving coils of each omnidirectional electromagnet.
10. An electronic device, comprising: At least one embedded controller; and a memory that is communicatively connected to the at least one embedded controller; The memory stores a computer program that can be executed by at least one embedded controller, wherein the computer program, when executed by the at least one embedded controller, implements the non-magnetic target control method based on eddy current effect.
