Accurate positioning method, system and equipment for three-dimensional adjustable connecting piece of flight simulator and storage medium
By acquiring real-time data in a flight simulator and utilizing platform kinematics models and Kalman filter fusion technology, the problem of precise positioning of three-dimensional adjustable connectors in vibration environments was solved, achieving sub-millimeter-level precise positioning and improved stability.
Patent Information
- Application Number
- CN202511446915.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2025-10-11
- Publication Date
- 2025-11-07
- Estimated Expiration
- 2045-10-11
AI Technical Summary
In flight simulation training, existing technologies struggle to achieve sub-millimeter-level precise positioning of three-dimensional adjustable connectors under vibration conditions. Laser tracking systems are affected by line-of-sight obstruction, leading to discrepancies between the platform's kinematic model and measured data. Furthermore, single-sensor modes have limited anti-interference capabilities, impacting the accuracy and stability of pose compensation.
By acquiring real-time travel length, instantaneous angle change data, and vibration interference image data of the flight target, three-dimensional coordinate point cloud data is generated using the platform's kinematic model. Combined with marker point recognition and optical distortion compensation, a Kalman filter is used to fuse visual and coordinate data to generate displacement compensation commands, which drive the closed-loop position controller to adjust the spatial pose of the connector.
It achieves sub-millimeter-level precise positioning of three-dimensional adjustable connectors under vibration environment, improves the system's anti-interference capability and positioning stability, and ensures the reliability and realism of flight simulation training.
Smart Images

Figure CN120909347A_ABST
Abstract
Description
TECHNICAL FIELD
[0001] The present application relates to the field of flight simulation control and precision measurement, and particularly relates to a precise positioning method, system and device for a three-dimensional adjustable connecting piece of a flight simulator and a storage medium. BACKGROUND
[0002] In the field of flight simulation training, the core component of the high-precision motion platform, the three-dimensional adjustable connecting piece, needs to maintain an accurate pose relationship with the aircraft model in a continuous vibration environment. Due to the complex motion of the six-degree-of-freedom platform when simulating air flow disturbance, the connecting piece is prone to millimeter-level deviation, which poses extremely high requirements on the positioning system: sub-millimeter positioning accuracy needs to be achieved within a millisecond response time, while overcoming dynamic environmental factors such as optical obstruction and vibration interference.
[0003] At present, one existing scheme for this requirement adopts a real-time monitoring system based on a laser tracker. The system arranges high-reflectivity target balls on the surface of the connecting piece, acquires the spatial coordinates of the target balls in real time through multiple laser trackers, predicts the motion trajectory of the connecting piece in combination with the kinematic model of the platform, and finally drives the electric actuator for position correction through a PID controller. This scheme relies on the high-precision laser ranging principle and closed-loop control architecture, and can achieve a certain degree of dynamic compensation.
[0004] However, this existing scheme has obvious limitations in actual application: the laser tracking system is sensitive to line-of-sight obstruction, and the target ball surface is prone to reflection signal attenuation in a vibration environment; there is a modeling error between the kinematic model of the platform and the actual measurement data, resulting in a deviation between the predicted trajectory and the actual displacement; the single sensing mode has limited anti-interference capability in a complex vibration environment, ultimately affecting the accuracy and stability of the pose compensation. SUMMARY
[0005] The present application provides a precise positioning method, system, device and storage medium for a three-dimensional adjustable connecting piece of a flight simulator, to solve the problem of flight simulation control and precision measurement in the prior art.
[0006] To solve the above technical problems, in a first aspect, the present application provides a precise positioning method for a three-dimensional adjustable connecting piece of a flight simulator, comprising: acquiring real-time stroke length, instantaneous angle change data of a motion control lever in a flight target, and vibration interference image data of a three-dimensional adjustable connecting piece; inputting the real-time stroke length and the instantaneous angle change data into a pre-trained kinematic model of the platform, outputting displacement prediction parameters of the flight target, and generating three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameters; The vibration interference image data is sub-pixel recognized and optical distortion compensated by using a marker point recognition algorithm to generate three-dimensional visual coordinate data; Based on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data, a preset Kalman filter is used for fusion processing to output a spatial pose offset of the three-dimensional adjustable connecting piece; According to the spatial pose offset, a displacement compensation instruction is generated, and the displacement compensation instruction is input to a closed-loop position controller of the flight target, and the spatial pose of the three-dimensional adjustable connecting piece is adjusted through the closed-loop position controller to realize accurate positioning of the three-dimensional adjustable connecting piece relative to the reference coordinate system of the flight target.
[0007] Optionally, based on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data, a preset Kalman filter is used for fusion processing to output a spatial pose offset of the three-dimensional adjustable connecting piece, comprising: The three-dimensional coordinate point cloud data is converted into a first observation vector, and the three-dimensional visual coordinate data is converted into a second observation vector; The first observation vector and the second observation vector are synchronously input to the Kalman filter, wherein the Kalman filter takes the displacement prediction parameter as a state transition constraint; Through a time update unit of the Kalman filter, a state estimation value at the next time is predicted based on the state transition constraint; Through a measurement update unit of the Kalman filter, based on the state estimation value, the first observation vector and the second observation vector, a spatial pose offset of the three-dimensional adjustable connecting piece is generated.
[0008] Optionally, based on the state estimation value, the first observation vector and the second observation vector, the spatial pose offset of the three-dimensional adjustable connecting piece is generated, comprising: Based on the first observation vector and the second observation vector, a Kalman gain matrix is calculated through an adaptive weight distribution network in the measurement update unit; Based on the Kalman gain matrix, the state estimation value is weighted and corrected to obtain a corrected state estimation value; The position deviation component and the angle deviation component are parsed from the corrected state estimation value; The position deviation component and the angle deviation component are respectively subjected to motion smoothing filtering processing; The filtered position deviation component and the filtered angle deviation component are combined to generate the spatial pose offset of the three-dimensional adjustable connecting piece.
[0009] Optionally, the Kalman gain matrix is calculated by an adaptive weight allocation network in the measurement update unit based on the first observation vector and the second observation vector, including: The first observation vector and the second observation vector are input into the adaptive weight allocation network, and an environmental interference coefficient is generated by an environment perception module of the adaptive weight allocation network; The feature importance scores of the first observation vector and the second observation vector are respectively calculated by an attention mechanism module of the adaptive weight allocation network; The real-time confidence weights of the first observation vector and the second observation vector are respectively generated in combination with the environmental interference coefficient and the feature importance scores; The Kalman gain matrix is generated by a Kalman gain calculation formula based on the real-time confidence weights.
[0010] Optionally, the sub-pixel recognition and optical distortion compensation of the vibration interference image data are performed by using a marker point recognition algorithm to generate three-dimensional visual coordinate data, including: The camera internal parameters, lens distortion coefficients, spatial position relationships, and attitude parameters of a binocular vision system in the flight target are acquired; The pixel region of a visual marker point is extracted from the vibration interference image data, and the gray distribution barycenter of the pixel region is calculated as a sub-pixel level coordinate position; An optical distortion compensation model is established based on the camera internal parameters and the lens distortion coefficients; The sub-pixel level coordinate position is input into the optical distortion compensation model, and the sub-pixel level coordinate position is nonlinearly transformed by polynomial coefficients stored in the optical distortion compensation model to output corrected coordinates after elimination of lens distortion; According to the spatial position relationships and the attitude parameters, a stereo matching algorithm is used to calculate the horizontal position difference of the corrected coordinates between left and right images in the binocular vision system, and disparity information is generated based on the horizontal position difference; Based on the disparity information, three-dimensional visual coordinate data of the visual marker point in the camera coordinate system is generated by the principle of triangulation.
[0011] Optionally, the three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece is generated based on the displacement prediction parameter, including: The displacement prediction parameter is converted into a spatial scanning trigger instruction of a plurality of time difference ranging base stations, and the spatial scanning trigger instruction is used to control the plurality of time difference ranging base stations to emit ultra-wideband signals according to a preset time sequence; receive a reflected signal of the ultra-wideband signal after being reflected by the surface of the three-dimensional adjustable connecting piece, measure a signal propagation time difference of each time-difference ranging base station based on the reflected signal; calculate a signal propagation path length according to the signal propagation time difference; generate a three-dimensional coordinate set of the surface reflection point of the three-dimensional adjustable connecting piece based on the signal propagation path length and in combination with a spatial geometric distribution relationship of each time-difference ranging base station; perform spatial clustering processing on the three-dimensional coordinate set based on a spatial position change amount in the displacement prediction parameter, and form three-dimensional coordinate point cloud data.
[0012] Optionally, the space pose offset amount is decomposed into three linear displacement components in orthogonal directions and three rotation angle components, displacement compensation instructions are generated according to the space pose offset amount, and the displacement compensation instructions are input to a closed-loop position controller of the flight target, so that the spatial pose of the three-dimensional adjustable connecting piece is adjusted by the closed-loop position controller. According to the linear displacement component and the rotation angle component, the motion characteristics of the electric control displacement mechanism are combined to calculate the displacement compensation amount required by each motion axis. The displacement compensation amount is converted into displacement compensation instructions in the form of pulse control signals. The displacement compensation instructions are input to a digital signal processing unit of the closed-loop position controller, the displacement compensation instructions are adjusted in real time by the digital signal processing unit, and based on the adjusted displacement compensation instructions, a servo motor of the electric control displacement mechanism is driven to adjust the spatial pose of the three-dimensional adjustable connecting piece.
[0013] In a second aspect, the application provides a precise positioning system of a three-dimensional adjustable connecting piece of a flight simulator, comprising: An acquisition module is configured to acquire real-time stroke length, instantaneous angle change data of a motion control lever in a flight target, and vibration interference image data of a three-dimensional adjustable connecting piece. An input module is configured to input the real-time stroke length and the instantaneous angle change data to a pre-trained platform kinematics model, output displacement prediction parameters of the flight target, and generate three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameters. A compensation module is configured to perform sub-pixel recognition and optical distortion compensation on the vibration interference image data by using a marker point recognition algorithm, and generate three-dimensional visual coordinate data. A fusion module is configured to perform fusion processing on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data by using a preset Kalman filter, and output a space pose offset amount of the three-dimensional adjustable connecting piece. The generating module is configured to generate displacement compensation instructions according to the spatial pose offset, and input the displacement compensation instructions to a closed-loop position controller of the flight target, so as to adjust the spatial pose of the three-dimensional adjustable connecting piece through the closed-loop position controller, and realize accurate positioning of the three-dimensional adjustable connecting piece relative to the reference coordinate system of the flight target.
[0014] In a third aspect, the present application provides an electronic device, comprising: a memory configured to store a computer program; a processor configured to execute the computer program to implement the steps of the method for accurate positioning of a three-dimensional adjustable connecting piece of a flight simulator according to the first aspect.
[0015] In a fourth aspect, the present application provides a computer readable storage medium, wherein the computer readable storage medium stores a computer program, and the computer program is executable by a processor to implement the steps of the method for accurate positioning of a three-dimensional adjustable connecting piece of a flight simulator according to the first aspect.
[0016] The technical scheme provided by the present application has the following beneficial effects: The present application realizes the synchronous acquisition of motion control instructions and visual monitoring data, provides multi-source input guarantee for subsequent fusion processing, converts mechanical motion parameters into spatial prediction data, establishes a mathematical model basis for the motion trajectory of the connecting piece, improves the coordinate extraction precision of optical measurement in a vibration environment, eliminates the influence of lens distortion on positioning accuracy, suppresses the error of a single sensing method through multi-source data complementary optimization, improves the reliability of pose estimation, forms a complete control closed loop from detection to execution, and ensures that the connecting piece tracks the target trajectory in real time and maintains accurate positioning.
[0017] Further, the present application converts the point cloud data and the visual coordinate data into observation vectors, inputs the observation vectors into a Kalman filter with displacement prediction parameters as state constraints, sequentially passes through state prediction in a time update stage and data fusion in a measurement update stage, and finally outputs the spatial pose offset of the connecting piece.
[0018] Moreover, through the dynamic fusion of kinematic constraints and multi-source sensing data, the measurement noise in a vibration environment is effectively overcome, and the calculation precision of the pose offset and the system anti-interference ability are improved.
[0019] These aspects and other aspects of the present application will be more apparent in the following description of the embodiments. BRIEF DESCRIPTION OF DRAWINGS
[0020] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the prior art, the following will briefly introduce the drawings needed to be used in the embodiments or prior art description. Obviously, the drawings described are only some embodiments of the present application, and all other drawings obtained by those of ordinary skill in the art without creative work based on these drawings are within the protection scope of the present application.
[0021] Figure 1 A flow chart of a precise positioning method of a three-dimensional adjustable connecting piece of a flight simulator provided by an embodiment of the present application is shown in the figure. Figure 2 A specific implementation schematic diagram of a precise positioning method of a three-dimensional adjustable connecting piece of a flight simulator provided by an embodiment of the present application is shown in the figure. Figure 3 Another specific implementation schematic diagram of a precise positioning method of a three-dimensional adjustable connecting piece of a flight simulator provided by an embodiment of the present application is shown in the figure. Figure 4 A structural schematic diagram of a precise positioning system of a three-dimensional adjustable connecting piece of a flight simulator provided by an embodiment of the present application is shown in the figure. DETAILED DESCRIPTION
[0022] The existing positioning scheme based on a laser tracker faces limitations in the vibration environment of a flight simulator: the laser measurement is extremely sensitive to the line-of-sight obstruction, the reflection signal of the target ball surface is prone to attenuation under severe vibration; there is an inherent modeling error between the platform kinematic model and the measured data, resulting in systematic deviation between the predicted trajectory and the actual displacement; the single sensing mode has limited anti-interference capability in a complex vibration environment, ultimately affecting the accuracy and stability of the pose compensation. These defects essentially result from the singleness of the sensing mode and the fragmented processing between the model and the sensing data.
[0023] In view of the above problems, the present application provides a precise positioning method of a three-dimensional adjustable connecting piece of a flight simulator, which realizes precise positioning by cooperatively processing mechanical motion parameters and visual perception data.
[0024] In order to enable those skilled in the art to better understand the present application, the present application will be further described in detail below with reference to the drawings and specific embodiments. Obviously, the described embodiments are only some of the embodiments of the present application, not all. Based on the embodiments in the present application, all other embodiments obtained by those of ordinary skill in the art without creative work are within the protection scope of the present application.
[0025] The core of the present application is to provide a precise positioning method of a three-dimensional adjustable connecting piece of a flight simulator, and a flowchart of a specific embodiment thereof is shown in the figure. Figure 1 The method comprises: Step 101: Obtain real-time stroke length, instantaneous rotation angle change data of the motion control stick in the flight target, and vibration interference image data of the three-dimensional adjustable connecting piece.
[0026] In step 101, the real-time stroke length represents the linear distance data of the motion control stick movement, reflecting the magnitude of the control instruction. The instantaneous rotation angle change data represents the instantaneous change amount of the rotation angle of the motion control stick, representing the direction and rate of the control instruction. The three-dimensional adjustable connecting piece and the motion control stick form a linkage relationship through the motion control system of the flight target. The stroke length and rotation angle change data of the motion control stick are calculated to obtain displacement prediction parameters through the platform kinematics model, which are used to guide the pose adjustment of the three-dimensional adjustable connecting piece, so that the spatial position of the connecting piece can respond to the operation instruction input by the operator through the motion control stick in real time, thereby maintaining the accurate relative position relationship between the connecting piece and the reference coordinate system of the flight target in the dynamic vibration environment. The vibration interference image data represents the image containing the visual marker point collected by the binocular vision system in the dynamic vibration environment, which is affected by mechanical vibration and optical distortion.
[0027] In the embodiments of the present application, the stroke length and rotation angle change data are collected in real time by the displacement sensor and the angle sensor installed on the motion control stick, and the vibration interference image data of the connecting piece surface is collected synchronously by the binocular vision system. The displacement sensor records the linear displacement amount of the control stick, the angle sensor records the rotation angle change amount of the control stick, and the binocular vision system synchronously exposes the left and right cameras to capture the marker point image. All data are transmitted to the processing unit through the high-speed data bus to ensure time synchronization.
[0028] For example, in a certain flight simulator, the displacement sensor of the motion control stick collects the real-time stroke length of 120 mm, and the angle sensor collects the instantaneous rotation angle change data of 15 degrees. At the same time, the left camera and the right camera of the binocular vision system synchronously collect the connecting piece surface image at a frequency of 100 frames per second, and the image resolution is set to 1280x1024 pixels. Due to platform vibration, motion blur and distortion appear in the image, forming vibration interference image data. All data are transmitted to the central processing unit through the gigabit Ethernet, and the timestamp error is less than 1 millisecond.
[0029] Step 102: Input the real-time stroke length and the instantaneous rotation angle change data into the pre-trained platform kinematics model, output the displacement prediction parameters of the flight target, and generate the three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameters.
[0030] In step 102, the platform kinematics model represents a mathematical model describing the relationship between the motion control lever input and the platform pose change, which is trained by historical data. The displacement prediction parameter represents the expected displacement and rotation of the platform in three-dimensional space. The three-dimensional coordinate point cloud data represents the set of spatial coordinates of the connecting surface points obtained by the time difference ranging technology.
[0031] In the embodiments of the present application, the real-time collected travel length and corner change data are input into the platform kinematics model, and the model calculates the displacement prediction parameter of the flight target through forward kinematics. The parameter includes the expected displacement of the platform in X, Y and Z directions and the rotation around each axis. Based on the displacement prediction parameter, the time difference ranging base station transmits the ultra-wideband signal, the signal is reflected by the connecting surface and then collected by the receiver, the signal propagation time difference is calculated and converted into distance information, and the three-dimensional coordinate point cloud data is obtained by combining the spatial geometric relationship of the base station.
[0032] For example, after the travel length of 120 mm and the corner of 15 degrees are input into the platform kinematics model, the output displacement prediction parameter is X direction displacement 200 mm, Y direction displacement negative 150 mm and Z direction displacement 50 mm. According to the parameter, four time difference ranging base stations are triggered to transmit the ultra-wideband signal in sequence, and the propagation time difference of base station A to the connecting piece is 15 nanoseconds, base station B is 16 nanoseconds, base station C is 14 nanoseconds and base station D is 17 nanoseconds. Through the formula the distance is calculated, where d represents the straight-line distance from the base station to the connecting piece, in meters (m), and c is the speed of light 3x10 8 m / s, The time difference of the ultra-wideband signal from the base station to the connecting piece is obtained, and the distance values of each base station are 2.25 meters, 2.40 meters, 2.10 meters and 2.55 meters respectively. Combined with the base station coordinates (base station A (0, 0, 0), base station B (2, 0, 0), base station C (0, 2, 0), base station D (0, 0, 2)), three-dimensional coordinate point cloud data containing 150 points are generated by the trilateration algorithm, and the point cloud range is X: 1.95-2.35 meters, Y: -1.20 to -0.90 meters, Z: 0.15-0.30 meters.
[0033] Step 103: using a marker point recognition algorithm to perform sub-pixel recognition and optical distortion compensation on the vibration interference image data to generate three-dimensional visual coordinate data.
[0034] In step 103, sub-pixel recognition refers to a technology that improves the positioning accuracy from pixel level to sub-pixel level through interpolation algorithm. Optical distortion compensation refers to the process of correcting the image coordinate error caused by lens distortion. Three-dimensional visual coordinate data refers to the spatial coordinates of the marker points in the camera coordinate system calculated by stereo vision.
[0035] In the embodiment of the present application, the pixel region of the visual marker point is extracted from the vibration interference image, and the sub-pixel level coordinates are obtained by calculating the gray scale distribution gravity center. A distortion compensation model is established by the camera calibration parameters, and the sub-pixel coordinates are subjected to nonlinear transformation to eliminate the distortion error. The corrected coordinates of the left and right cameras are subjected to stereo matching, the disparity information is calculated, and finally the three-dimensional coordinates of the marker point in the camera coordinate system are obtained by the principle of triangulation.
[0036] For example, the pixel region of the marker point (coordinate range X: 620-660 pixels, Y: 470-510 pixels) is extracted from the left image, and the sub-pixel coordinates (640.5, 490.2) are obtained by calculating the gray scale distribution gravity center. The corrected coordinates (639.8, 489.5) are obtained by the distortion compensation model. The corrected coordinates of the marker point corresponding to the right image are (600.2, 489.7). The baseline distance is 0.5 meters, the focal length is 1200 pixels, and the disparity is 39.6 pixels. The depth is calculated by the triangulation formula , wherein Z represents the depth coordinate of the marker point, B is the baseline, f is the focal length, and d is the disparity. , wherein X represents the horizontal three-dimensional coordinate of the marker point, , wherein X represents the horizontal three-dimensional coordinate of the marker point, , wherein Y represents the vertical three-dimensional coordinate of the marker point, , wherein Y represents the vertical three-dimensional coordinate of the marker point, , wherein Y represents the vertical three-dimensional coordinate of the marker point, The three-dimensional visual coordinate data of the eight marker points are generated, and the coordinate variance is 0.12 mm.
[0037] Step 104: Based on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data, a preset Kalman filter is used for fusion processing, and a spatial pose offset of the three-dimensional adjustable connecting piece is output.
[0038] In step 104, the Kalman filter represents an optimization estimation algorithm that fuses multiple source data through a recursive algorithm. The spatial pose offset represents the deviation of the actual pose of the connecting piece from the theoretical pose in position and attitude.
[0039] In the embodiment of the present application, the point cloud data is converted into a first observation vector, and the visual coordinate data is converted into a second observation vector. The two observation vectors are input into the Kalman filter, and the filter takes the displacement prediction parameter as the state transition constraint. In the time update stage, the state transition matrix is used to predict the state at the next time, and in the measurement update stage, the state estimation is updated combined with the observation vector and the noise characteristics, and finally the pose offset is extracted from the state estimation value.
[0040] For example, the point cloud data is converted into an observation vector , visual coordinate data is converted into observation vector . State transition matrix F is set as unit matrix, process noise covariance , wherein represents process noise covariance matrix, represents unit matrix, observation noise covariance R = diag (0.0004, 0.0004, 0.0004). Gain matrix is calculated by Kalman gain formula (wherein K represents Kalman gain matrix, represents state estimation covariance matrix at k time, H is observation matrix, represents transpose matrix of observation matrix H, R represents observation noise covariance matrix), K = [0.75, 0, 0; 0, 0.75, 0; 0, 0, 0.75] is obtained. After updating state estimation value, it is obtained . Compared with theoretical position , offset meters.
[0041] Step 105: generating displacement compensation instructions according to the spatial position offset, and inputting the displacement compensation instructions into a closed-loop position controller of the flight target, adjusting the spatial position of the three-dimensional adjustable connecting piece through the closed-loop position controller, so as to realize accurate positioning of the three-dimensional adjustable connecting piece relative to the reference coordinate system of the flight target.
[0042] In step 105, the displacement compensation instructions represent the control signals for driving the actuating mechanism to correct the position. The closed-loop position controller represents a system that realizes accurate position control through feedback regulation. The spatial position is obtained by fusing binocular visual three-dimensional coordinates and time difference ranging point cloud data, and through double-source Kalman filtering processing constrained by the flight target kinematic model, which specifically represents the real-time position (X / Y / Z coordinates) and attitude (pitch / roll / roll angle) of the connecting piece in the flight target reference coordinate system, and is used to describe the accurate spatial relationship of the connecting piece relative to the flight target in three-dimensional space.
[0043] In the embodiments of the present application, the position offset is decomposed into displacement and rotation of each motion axis, and the required pulse control signal is calculated according to the characteristics of the actuating mechanism. The pulse signal is input into a digital signal processing unit to drive the servo motor to run and detect the actual displacement through a position sensor in real time, and feedback to the controller to form a closed-loop control.
[0044] For example, the offset is converted into X-axis-8000 pulses, Y-axis-8000 pulses, and Z-axis-8000 pulses (pulse equivalent 5 microns / pulse). The pulse frequency is 1 kHz, and the pulse width is 20 microseconds. After the servo motor runs, the position sensor detects the actual displacement The displacement error is less than 0.001 meters after three iterations, and accurate positioning is achieved.
[0045] The method realizes sub-millimeter positioning accuracy of the three-dimensional adjustable connecting piece in the vibration environment through effective combination of multi-source data synchronous acquisition, kinematic prediction, visual measurement, data fusion and closed-loop control. The limitations of single sensing mode are overcome, the anti-interference ability and positioning stability of the system are improved, and the reliability and fidelity of flight simulation training are ensured.
[0046] In order to solve the problem of insufficient fusion accuracy of multi-source sensing data in a vibration environment, in some embodiments, step 104: based on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data, a preset Kalman filter is used for fusion processing to output the spatial pose offset of the three-dimensional adjustable connecting piece, as shown in Figure 2 The method comprises the following steps: Step 201: convert the three-dimensional coordinate point cloud data into a first observation vector, and convert the three-dimensional visual coordinate data into a second observation vector.
[0047] In step 201, the first observation vector is a spatial position feature vector obtained by mean calculation of the three-dimensional coordinate point cloud data, representing the connecting piece center point coordinate estimate value measured by the time difference ranging system. The second observation vector is a visual measurement feature vector obtained by coordinate conversion and filtering processing of the three-dimensional visual coordinate data, representing the connecting piece surface marker point center coordinate calculated by the binocular vision system.
[0048] In the embodiments of the present application, all point coordinates in the three-dimensional coordinate point cloud data generated by the time difference ranging system are calculated by arithmetic mean to obtain the three-dimensional coordinates of the point cloud center point, which is taken as the three components of the first observation vector. At the same time, the multiple sets of three-dimensional visual coordinate data generated by the binocular vision system are processed by weighted average algorithm to obtain the visual measurement center point coordinates, which are taken as the three components of the second observation vector. The two observation vectors respectively represent the spatial position information obtained by two different measurement methods.
[0049] Step 202: synchronously input the first observation vector and the second observation vector into the Kalman filter, wherein the Kalman filter takes the displacement prediction parameter as a state transition constraint.
[0050] In step 202, the state transition constraint is a system state change rule constructed based on the displacement prediction parameter output by the platform kinematic model, which is used to constrain the evolution process of the state vector in the Kalman filter.
[0051] In the embodiment of the present application, the first observation vector and the second observation vector are simultaneously input into a pre-configured Kalman filter program, and a state transition matrix of the filter is dynamically adjusted according to displacement prediction parameters output by a platform kinematics model. The displacement prediction parameters provide prior knowledge of system motion, which is used as a constraint condition in the prediction stage of the filter to ensure that the state prediction conforms to the actual motion law.
[0052] Step 203: Based on the state transition constraint, a state estimation value at the next time is predicted by a time update unit of the Kalman filter.
[0053] In step 203, the time update unit is a calculation module in the Kalman filter responsible for predicting the state at the next time according to the system model. The state estimation value is the optimal estimation of the current state of the system obtained by prediction calculation.
[0054] In the embodiment of the present application, the time update unit of the Kalman filter uses the state transition constraint to calculate the state estimation value at the next time by a state prediction formula. The specific process is to perform matrix multiplication operation between the state transition matrix and the state estimation value at the last time, and then add the influence of the process noise to obtain the predicted state at the current time. This predicted state fuses the prior information provided by the kinematics model.
[0055] Step 204: Based on the state estimation value, the first observation vector and the second observation vector, a spatial pose offset of the three-dimensional adjustable connecting piece is generated by a measurement update unit of the Kalman filter.
[0056] In step 204, the measurement update unit is a calculation module in the Kalman filter responsible for fusing observation data and updating state estimation.
[0057] In the embodiment of the present application, the measurement update unit of the Kalman filter fuses the state estimation value with the two observation vectors. First, the Kalman gain matrix is calculated, which determines the weight of the observation data in the state update. Then, the gain matrix is used to weight and fuse the predicted state and the observation value to obtain the final state estimation value. Finally, the position and attitude deviation components are extracted from the state estimation value to form the spatial pose offset output.
[0058] The following is a specific example: In the precise positioning process of the three-dimensional adjustable connection of the flight simulator, based on the three-dimensional coordinate point cloud data containing 150 points obtained from the foregoing embodiment, the point cloud range is 1.95-2.35 meters in the X direction, -1.20 to -0.90 meters in the Y direction, and 0.15-0.30 meters in the Z direction, the arithmetic mean of the coordinates of all points of the point cloud data is calculated to obtain the first observation vector in the form of transpose of 2.15 meters, -1.05 meters and 0.22 meters, and the three-dimensional visual coordinate data of the eight marker points generated based on the binocular vision system has a coordinate variance of 0.12 mm, and the weighted average of the visual coordinate data is calculated, and the weight is allocated according to the marker point confidence to obtain the second observation vector in the form of transpose of 2.18 meters, -1.02 meters and 0.20 meters. The first observation vector and the second observation vector are synchronously input into a preset Kalman filter, and the displacement prediction parameter 200 mm, -150 mm and 50 mm output by the platform kinematics model is used as the state transition constraint, wherein the displacement prediction parameter is converted into 0.20 m, -0.15 m and 0.05 m in meter unit, and is used to construct a state transition matrix. Through the time update unit of the Kalman filter, the state estimation value at the next time is predicted based on the state transition constraint, the state transition matrix is set as an identity matrix, the process noise covariance matrix is set as 0.01 times the identity matrix, and the state estimation value at the last time is initialized as the transpose of the displacement prediction parameter 0.20 m, -0.15 m and 0.05 m, and the state prediction formula is used to calculate, wherein represents the current state estimation value, F represents the state transition matrix, and I is used to represent the identity matrix in the embodiment, represents the state estimation value at the last time, and the predicted state estimation value is . Through the measurement update unit of the Kalman filter, the spatial pose offset of the three-dimensional adjustable connection is generated based on the state estimation value, the first observation vector and the second observation vector. First, the Kalman gain matrix is calculated using the formula , wherein K represents the Kalman gain matrix, I represents the identity matrix, and represents the state prediction covariance matrix initialized as 0.01 times the identity matrix, H represents the observation matrix set as the identity matrix, and R represents the observation noise covariance matrix set as a diagonal matrix with diagonal elements of 0.0004, 0.0004 and 0.0004. The numerical calculation is performed to obtain , and after simplification , the gain matrix is . Then the state estimation value is updated using the formula , wherein represents the observation vector fusion value, represents the predicted state estimation value at the current time, K represents the Kalman gain matrix, and the example is , substituting obtains, , . Compare the state estimate value with the theoretical pose , obtains , complete the Kalman filter fusion processing.
[0059] In the embodiments of the present application, through the collaborative fusion processing of multi-source observation data, the limitations of single sensing mode are effectively overcome, and the accuracy and reliability of pose measurement in the vibration environment are improved, providing a reliable data basis for subsequent precise control.
[0060] In order to solve the problem of insufficient fusion accuracy and stability of multi-source data in the vibration environment, in some embodiments, step 204: based on the state estimate value, the first observation vector and the second observation vector, the spatial pose offset of the three-dimensional adjustable connecting piece is generated, as shown in Figure 3 , comprising: Step 301: based on the first observation vector and the second observation vector, the Kalman gain matrix is calculated through the adaptive weight distribution network in the measurement update unit.
[0061] In step 301, the adaptive weight distribution network is a neural network model that dynamically adjusts the calculation parameters according to the real-time environmental conditions and data quality. The Kalman gain matrix is a coefficient matrix used to balance the weights of the predicted value and the observed value in the state update.
[0062] In the embodiments of the present application, the adaptive weight distribution network in the measurement update unit receives the first observation vector and the second observation vector as input, analyzes the noise characteristics and confidence of the vector through the internal multi-layer perceptron structure, outputs the adaptive weight coefficient for each observation vector, then adjusts the observation noise covariance matrix according to these weight coefficients, and finally obtains the optimized Kalman gain matrix through the standard Kalman gain calculation formula.
[0063] Step 302: based on the Kalman gain matrix, the state estimate value is weighted and corrected to obtain a corrected state estimate value.
[0064] In step 302, the weighted correction is a process of weighting and adjusting the difference between the state prediction value and the observation value using the Kalman gain matrix. The corrected state estimate value is the optimal estimation value of the system state after data fusion optimization.
[0065] In the embodiments of the present application, the Kalman gain matrix is subjected to matrix multiplication operation with the difference between the observation vector and the state prediction value, to obtain a correction amount, and then the correction amount is added to the original state estimate value to obtain a corrected state estimate value closer to the true state. This process effectively integrates the data advantages of motion prediction and actual observation.
[0066] Step 303: Resolve the position deviation component and the angle deviation component from the corrected state estimate value.
[0067] In step 303, the position deviation component is the difference between the corrected state estimate value and the theoretical pose in the translational dimension. The angle deviation component is the difference between the corrected state estimate value and the theoretical pose in the rotational dimension.
[0068] In the embodiments of the present application, the first three elements of the corrected state estimate value are extracted as the position component, and the last three elements are extracted as the angle component. The corresponding components of the theoretical pose are subtracted to obtain the position deviation component and the angle deviation component, which directly reflect the pose error of the connecting member at the current time.
[0069] Step 304: Perform motion smoothing filtering on the position deviation component and the angle deviation component, respectively.
[0070] In step 304, motion smoothing filtering is a signal processing method using the sliding average principle to eliminate high-frequency noise and jitter in the measurement data. The filtered components are stable signal outputs after smoothing processing.
[0071] In the embodiments of the present application, a first-order low-pass filter is used to process the position deviation component and the angle deviation component, respectively. The smoothing degree is controlled by adjusting the time constant of the filter, the effective low-frequency trend signal is retained, and the high-frequency noise component is filtered out, so that the output deviation signal is more stable and reliable.
[0072] Step 305: Combine the filtered position deviation component and the filtered angle deviation component to generate the spatial pose offset of the three-dimensional adjustable connecting member.
[0073] In the embodiments of the present application, the filtered position deviation component and the filtered angle deviation component are spliced and combined in a predetermined order. The position component is in the first three dimensions, and the angle component is in the last three dimensions, forming a complete six-dimensional spatial pose offset. This offset is used as the final output for pose correction of the control system.
[0074] The following is a specific example: In the precise positioning process of the three-dimensional adjustable connecting member of the flight simulator, based on the obtained final state estimate value meters and the theoretical pose meters, first calculate the Kalman gain matrix through the adaptive weight distribution network in the measurement update unit. The network receives the first observation vector meters and the second observation vector Using millimeters as input, the data quality is analyzed, and a weighted coefficient vector [0.7, 0.3] is output. The weight of the first observation vector (0.7) is derived from the stability of the point cloud data, and the weight of the second observation vector (0.3) is calculated based on the visual coordinate variance of 0.12 millimeters. This is then processed using the formula... It equals W multiplied by the Kalman gain matrix of the previous time step, where W represents the weight coefficient vector, and the Kalman gain matrix of the previous time step is... The new Kalman gain matrix is calculated as follows: Based on this Kalman gain matrix, the state estimates are weighted and corrected using the formula... ,in This represents the corrected state estimate. This represents the new Kalman gain matrix. This represents the state estimate before correction. The theoretical pose coordinates are used to obtain the corrected state estimate. The positional deviation component is extracted from this estimate. The angular deviation component is calculated using the spatial geometric relationship of the marked points on the connector surface. The position deviation component is subjected to motion smoothing filtering using a first-order low-pass filter formula. ,in This represents the current filtered output value. Represents the filter coefficients. This represents the input value at the current moment. This represents the filtered output value at the previous moment, calculated as follows: The angular deviation component is also processed in the same way. Finally, the filtered position deviation components Meter and angular deviation components Degree combination generates spatial pose offset of three-dimensional adjustable connector. This completes the calculation of spatial pose offset.
[0075] In this embodiment, the accuracy and stability of pose offset calculation are effectively improved through the coordinated processing of adaptive weight allocation and motion smoothing filtering, ensuring that smooth and reliable pose compensation data can still be obtained in a vibration environment, providing an important guarantee for precise control.
[0076] To address the issue of unstable fusion accuracy caused by dynamic changes in the quality of observation data under vibration environments, in some embodiments, step 301: calculating the Kalman gain matrix based on the first observation vector and the second observation vector through an adaptive weight allocation network in the measurement update unit includes: Step 401: input the first observation vector and the second observation vector into an adaptive weight allocation network, and generate an environmental interference coefficient through an environment perception module of the adaptive weight allocation network.
[0077] In step 401, the environment perception module is a calculation unit responsible for analyzing external environmental conditions in the adaptive weight allocation network. The environmental interference coefficient is a parameter that quantifies the degree of influence of the current environment on the measurement data, with a value range of zero to one. The larger the value, the more serious the environmental interference.
[0078] In the embodiments of the present application, the environment perception module receives environmental monitoring data from sensors in real time, including vibration intensity, light change and electromagnetic interference level. These data are processed through a multi-layer neural network to output a comprehensive environmental interference coefficient, which reflects the overall influence of the current environment on the reliability of the observation data.
[0079] Step 402: calculate the feature importance score of the first observation vector and the second observation vector respectively through an attention mechanism module of the adaptive weight allocation network.
[0080] In step 402, the attention mechanism module is a calculation component in the adaptive weight allocation network for evaluating the importance of data features. The feature importance score is a score value indicating the reliability of each dimension of the observation vector.
[0081] In the embodiments of the present application, the attention mechanism module analyzes the first observation vector and the second observation vector respectively, calculates the data consistency, noise level and trend features of each vector, and calculates the feature importance score of each vector through attention weight. The higher the score, the better the data quality of the observation vector.
[0082] Step 403: combine the environmental interference coefficient and the feature importance score to generate real-time confidence weights of the first observation vector and the second observation vector respectively.
[0083] In step 403, the real-time confidence weight is a weight value calculated dynamically according to the environmental conditions and data quality, which is used to determine the contribution of each observation vector in data fusion.
[0084] In the embodiments of the present application, the environmental interference coefficient and the feature importance score are comprehensively calculated. When the environmental interference is serious, the weight of the optical observation vector is appropriately reduced. When the data quality is high, the weight of the vector is correspondingly increased. Finally, the real-time confidence weights of the first observation vector and the second observation vector are generated.
[0085] Step 404: generate a Kalman gain matrix based on the real-time confidence weight through a Kalman gain calculation formula.
[0086] In step 404, the Kalman gain calculation formula is a mathematical expression for calculating the optimal estimation weight, which adjusts the traditional gain calculation process by incorporating real-time confidence weight.
[0087] In the embodiments of the present application, real-time confidence weight is introduced into the calculation process of the observation noise covariance matrix, and the adjusted noise covariance matrix is involved in the Kalman gain calculation, so that the gain matrix can dynamically adapt to environmental changes and data quality fluctuations, and finally output the optimized Kalman gain matrix.
[0088] The following is a specific example: In the precise positioning process of the three-dimensional adjustable connector of the flight simulator, based on the obtained first observation vector m and the second observation vector m, first input the two observation vectors into the adaptive weight distribution network, generate the environmental disturbance coefficient through the environmental perception module of the network, collect vibration sensor data to obtain a vibration intensity of 3 levels, collect light sensor data to obtain a light change rate of 50 lux per second, and collect electromagnetic interference detector data to obtain an electromagnetic interference level of 10 decibels. These parameters are input into the three-layer neural network calculation module, wherein the vibration intensity weight is 0.5, the light change rate weight is 0.3, and the electromagnetic interference weight is 0.2. The calculation obtains , wherein dividing by 100 is to normalize to the range of 0-1; then the feature importance score of the two observation vectors is calculated through the attention mechanism module of the adaptive weight distribution network. The module first analyzes the data characteristics of the first observation vector, calculates its variance as 0.015, signal-to-noise ratio as 28 decibels, and stability index as 0.85, and calculates its feature importance score as through the attention weight formula. Similarly, the second observation vector is analyzed to obtain a variance of 0.012, a signal-to-noise ratio of 32 decibels, and a stability index of 0.9, and its feature importance score is calculated as ; then, combined with the environmental disturbance coefficient 0.185 and the feature importance score, the real-time confidence weight is generated through the confidence weight calculation formula, the real-time confidence weight of the first observation vector is equal to , and the real-time confidence weight of the second observation vector is equal to , the first observation vector weight , and the second observation vector weight after normalization; finally, based on these real-time confidence weights, the Kalman gain matrix is generated through the Kalman gain calculation formula.
[0089] In the embodiments of the present application, through the dual regulation of environmental perception and attention mechanism, the Kalman gain matrix can adapt to environmental changes and data quality fluctuations in real time, improving the accuracy and stability of data fusion in the vibration environment, and providing more reliable guarantee for pose estimation.
[0090] To solve the problem of insufficient visual measurement accuracy in the vibration environment, in some embodiments, step 103: the sub-pixel recognition and optical distortion compensation of the vibration interference image data are performed by using a marker point recognition algorithm, and three-dimensional visual coordinate data is generated, comprising: Step 501: Obtain the camera internal parameters, lens distortion coefficients, spatial position relationship and attitude parameters of the binocular vision system in the flight target.
[0091] In step 501, the binocular vision system is fixedly installed around the motion environment of the flight target, and is used to collect image data of the three-dimensional adjustable connecting piece on the flight target in real time, and obtain the spatial position information of the connecting piece relative to the reference coordinate system of the flight target through the principle of stereo vision measurement. The camera internal parameters are a set of parameters describing the optical characteristics of the camera, including focal length, principal point coordinates and pixel size, etc. The lens distortion coefficient is a parameter quantifying the degree of lens optical distortion. The spatial position relationship is the relative position and distance relationship between the left and right cameras. The attitude parameter is the rotation angle of the camera coordinate system relative to the world coordinate system.
[0092] In the embodiments of the present application, these parameters are obtained through a pre-performed camera calibration process. The calibration process uses a high-precision calibration board to collect multiple groups of images, and calculates the internal parameters of the camera, the distortion coefficients, the baseline distance and the relative attitude angle between the two cameras through an optimization algorithm. All parameters are stored in a configuration file for subsequent processing and calling.
[0093] Step 502: Extract the pixel area of the visual marker point from the vibration interference image data, calculate the gray distribution center of gravity of the pixel area, and take the gray distribution center of gravity as the sub-pixel level coordinate position.
[0094] In step 502, the visual marker point is a specific pattern point formed by setting a high-reflectivity material on the surface of the three-dimensional adjustable connecting piece. These marker points have a pre-set geometric arrangement feature, which is used to provide stable recognition and positioning features in the image. The pixel area is a connected region in the image containing the visual marker point. The gray distribution center of gravity is the weighted average position of all pixel gray values in the pixel area, which can provide sub-pixel level coordinate accuracy.
[0095] In the embodiments of the present application, first, the vibration interference image is subjected to threshold segmentation and connected region analysis, and all possible marker point regions are identified. Then, the weighted center position of the gray value of each region is calculated, which is accurate to the sub-pixel level and serves as the preliminary coordinate position of the marker point.
[0096] Step 503: Establishing an optical distortion compensation model based on the camera internal parameters and the lens distortion coefficients.
[0097] In step 503, the optical distortion compensation model is a mathematical model for correcting lens distortion, which describes the distortion characteristics by a polynomial function.
[0098] In the embodiments of the present application, the distortion correction model is constructed according to the camera internal parameters and the lens distortion coefficients, which contains compensation polynomials of radial distortion and tangential distortion, and the polynomial coefficients are determined by the calibration process, which are used to map the distorted coordinates to the undistorted coordinates.
[0099] Step 504: Inputting the sub-pixel level coordinate position into the optical distortion compensation model, performing a non-linear transformation on the sub-pixel level coordinate position by the polynomial coefficients stored in the optical distortion compensation model, and outputting the corrected coordinates after eliminating the lens distortion.
[0100] In step 504, the polynomial coefficients refer to the mathematical parameters in the optical distortion compensation model for describing the lens distortion characteristics, which are obtained by the camera calibration process, and together with the camera internal parameters and the lens distortion coefficients, form the mathematical basis of the optical distortion compensation model, but are not the camera internal parameters and the lens distortion coefficients themselves. The non-linear transformation is a process of mapping and calculating the coordinates by a polynomial function. The corrected coordinates are the ideal coordinate positions after eliminating the distortion effects.
[0101] In the embodiments of the present application, the sub-pixel level coordinate position is input into the optical distortion compensation model, and the stored polynomial coefficients are used for coordinate transformation calculation, and the accurate coordinate position after eliminating the distortion is obtained by iterative optimization, which is closer to the real physical projection relationship.
[0102] Step 505: According to the spatial position relationship and the attitude parameters, using a stereo matching algorithm, calculating the horizontal position difference value of the corrected coordinates in the left and right images of the binocular vision system, and generating the disparity information based on the horizontal position difference value.
[0103] In step 505, the stereo matching algorithm is a method for finding corresponding points in left and right images. The left and right images are obtained by synchronously collecting the left camera and the right camera in the binocular vision system installed around the flight target motion environment, and correspond to two image data containing the visual marker points collected from different angles at the same time. The horizontal position difference value is the coordinate difference of the same marker point in the horizontal direction of the left and right images. The disparity information is the result of the horizontal position difference value after standardization processing.
[0104] In the embodiments of the present application, according to the spatial position relationship and the attitude parameter of the dual cameras, a epipolar constraint relationship is established, a matching point pair is searched in the corrected coordinates of left and right images, and a coordinate difference value of the point pair in the horizontal direction is calculated, which reflects the depth information of the object.
[0105] Step 506: generating three-dimensional visual coordinate data of the visual marker point in a camera coordinate system based on the parallax information by a triangulation principle.
[0106] In step 506, the triangulation principle refers to observing a same target point by two cameras with known positions and attitudes at the same time, calculating a horizontal position difference, i.e. parallax, of the target point in left and right camera images, combining a baseline distance and optical parameters between the cameras, and calculating three-dimensional space coordinates of the target point relative to the camera coordinate system based on a similar triangle geometric relationship.
[0107] In the embodiments of the present application, three-dimensional coordinates of the marker point are calculated by a triangulation formula based on the parallax information and the camera internal parameters, the calculation process converts two-dimensional image coordinates to three-dimensional space coordinates by a similar triangle principle, and finally accurate three-dimensional position information is obtained.
[0108] The following is a specific example: In the precise positioning process of the three-dimensional adjustable connecting piece of the flight simulator, based on the vibration interference image data collected by the binocular vision system, the pre-calibrated camera internal parameters including a focal length of 1200 pixels, principal point coordinates of 640 pixels and 480 pixels, and lens distortion coefficients including a radial distortion coefficient and , a tangential distortion coefficient and , the spatial position relationship is that the baseline distance of left and right cameras is 0.5 meters, and the attitude parameter is that the rotation angle of the right camera relative to the left camera is zero degrees; a pixel area of the visual marker point is extracted from the vibration interference image data, the coordinate range of the area in the left image is 620 to 660 pixels and 470 to 510 pixels, and the corresponding area in the right image is 580 to 620 pixels and 470 to 510 pixels, the gray distribution barycenter of the pixel area of the left image is calculated to obtain the sub-pixel level coordinate positions 640.5 pixels and 490.2 pixels, and the gray distribution barycenter of the pixel area of the right image is calculated to obtain the sub-pixel level coordinate positions 600.2 pixels and 489.7 pixels; an optical distortion compensation model is established based on the camera internal parameters and the lens distortion coefficient, the sub-pixel level coordinate positions are input into the optical distortion compensation model, the left image coordinates 640.5 pixels and 490.2 pixels are corrected to obtain the left image correction coordinates 639.8 pixels and 489.5 pixels, and the right image coordinates are also processed to obtain 600.2 pixels and 489.7 pixels; according to the spatial position relationship and the attitude parameter, a stereo matching algorithm is used to calculate the horizontal position difference value of the correction coordinates in the left and right images, the difference value between the left image x coordinate 639.8 pixels and the right image x coordinate 600.2 pixels is , the difference value is the parallax information; based on the parallax information 39.6 pixels, three-dimensional visual coordinate data of the visual marker point in the camera coordinate system is generated through the triangulation principle, and the calculation result is , the calculation result is , the calculation result is , and finally the three-dimensional visual coordinate data of the visual marker point is 8.08 meters, 6.18 meters and 15.15 meters, and the conversion process from image data to three-dimensional coordinates is completed.
[0109] In the embodiments of the present application, through the complete image processing and three-dimensional reconstruction process, the influence of vibration interference and optical distortion is effectively overcome, and high-precision three-dimensional visual coordinate data is obtained, which provides a reliable visual measurement basis for subsequent data fusion and pose control.
[0110] In order to solve the problem of three-dimensional coordinate measurement precision and efficiency in a vibration environment, in some embodiments, step 102: generating three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameter, comprising: Step 601: converting the displacement prediction parameter into a space scanning trigger instruction of a plurality of time difference ranging base stations, and controlling the plurality of time difference ranging base stations to emit ultra-wideband signals according to a preset time sequence by using the space scanning trigger instruction.
[0111] In step 601, the time difference of arrival base station is fixedly installed around the moving environment of the flight target, and the spatial position relationship of the connecting piece relative to the reference coordinate system of the flight target is determined in real time by measuring the time difference of arrival of the ultra-wideband signal from the base station to the three-dimensional adjustable connecting piece on the flight target, so as to provide positioning reference for the flight target. The space scanning trigger instruction is a timing control signal generated according to the displacement prediction parameter, which is used to coordinate the transmission timing of multiple time difference of arrival base stations. The ultra-wideband signal is a radio wave signal with a nanosecond-level pulse width, which is suitable for high-precision distance measurement.
[0112] In the embodiment of the present application, the spatial coordinate components in the displacement prediction parameter are converted into time delay signals, each coordinate component corresponds to the trigger delay of a base station, and the trigger instructions are sent to each time difference of arrival base station through the control bus. The base station transmits the ultra-wideband signal according to the predetermined time sequence according to the received instruction.
[0113] Step 602: receiving the echo signal of the ultra-wideband signal reflected by the surface of the three-dimensional adjustable connecting piece, and measuring the signal propagation time difference of each time difference of arrival base station based on the echo signal.
[0114] In step 602, the echo signal is the electromagnetic wave signal returned after the ultra-wideband signal is reflected by the surface of the connecting piece. The signal propagation time difference is the time difference experienced by the signal from transmission to reception.
[0115] In the embodiment of the present application, the receiver of the time difference of arrival base station continuously monitors the reflected echo signal, accurately measures the arrival time of each signal through a correlation detection algorithm, calculates the difference between the transmission time and the reception time, and obtains accurate signal propagation time difference data.
[0116] Step 603: calculating the signal propagation path length according to the signal propagation time difference.
[0117] In step 603, the signal propagation path length is the actual distance traveled by the radio wave from transmission to reception.
[0118] In the embodiment of the present application, according to the principle that the propagation speed of electromagnetic wave is constant, the measured signal propagation time difference is multiplied by the speed of light and then divided by two to obtain the one-way propagation path length, which represents the straight-line distance from the base station to the surface of the connecting piece.
[0119] Step 604: generating a three-dimensional coordinate set of the surface reflection point of the three-dimensional adjustable connecting piece based on the signal propagation path length and the spatial geometric distribution relationship of each time difference of arrival base station.
[0120] In step 604, the geometric distribution relationship is obtained through accurate calibration of the base station installation position, which refers to the fixed coordinate position of multiple base stations in three-dimensional space and their relative orientation relationship, and is used to provide spatial geometric constraints when calculating signal propagation path length based on signal arrival time difference. The three-dimensional coordinate set is a set of surface point coordinate data calculated by space intersection.
[0121] In the embodiments of the present application, the path length data measured by multiple base stations is combined with the known base station coordinate position, and the spatial coordinates of the surface reflection points of the connecting member are calculated by a trilateration algorithm. Each base station measurement value determines a sphere, and the intersection of multiple spheres is the three-dimensional coordinates of the reflection points.
[0122] Step 605: based on the spatial position change amount in the displacement prediction parameter, performing spatial clustering processing on the three-dimensional coordinate set to form three-dimensional coordinate point cloud data.
[0123] In step 605, the spatial position change amount is calculated by kinematics forward solution according to the real-time stroke length and instantaneous angle change data of the motion control rod through the kinematics model, which reflects the position change trend of the flight target in three-dimensional space. Spatial clustering processing is a method of grouping coordinate data according to spatial proximity.
[0124] In the embodiments of the present application, according to the spatial position change trend provided by the displacement prediction parameter, the original coordinate set is subjected to density clustering analysis, points with similar spatial positions are classified into the same category, isolated noise points are removed, and point cloud data representing the surface features of the connecting member are extracted.
[0125] The following is a specific example: In the precise positioning process of the three-dimensional adjustable connecting member of the flight simulator, based on the displacement prediction parameters X direction displacement 200 mm, Y direction displacement negative 150 mm, and Z direction displacement 50 mm output by the platform kinematics model, the displacement prediction parameters are first converted into spatial scanning trigger instructions of four time difference ranging base stations, wherein the X coordinate 200 mm corresponds to the base station A trigger delay 0 ms, the Y coordinate negative 150 mm corresponds to the base station B trigger delay 2 ms, the Z coordinate 50 mm corresponds to the base station C trigger delay 4 ms, and the base station D is used as a reference base station with a trigger delay of 6 ms. The spatial scanning trigger instructions are used to control the base stations to emit ultra-wideband signals in sequence; the echo signals of the received ultra-wideband signals reflected by the surface of the three-dimensional adjustable connecting member are used to measure the signal propagation time difference of each time difference ranging base station, and the base station A propagation time difference is 15 nanoseconds, the base station B propagation time difference is 16 nanoseconds, the base station C propagation time difference is 14 nanoseconds, and the base station D propagation time difference is 17 nanoseconds; the signal propagation path length is calculated according to the signal propagation time difference, and the formula The distance is calculated, wherein represents the first a signal propagation path length from the first base station to the surface reflection point of the three-dimensional adjustable connecting element, represents the speed of light , represents the signal propagation time difference of the first base station, the path length of base station A is calculated , the path length of base station B is calculated , the path length of base station C is calculated , and the path length of base station D is calculated ; based on the signal propagation path length and the spatial geometric distribution relationship of each time difference ranging base station, the base station coordinates are base station A (0, 0, 0), base station B (2, 0, 0), base station C (0, 2, 0), and base station D (0, 0, 2), respectively, a three-dimensional coordinate set of the surface reflection point of the three-dimensional adjustable connecting element is generated by a three-dimensional positioning algorithm, and the formula is used in the algorithm, wherein is the coordinate to be solved, is the base station coordinate, and the equation set is solved to obtain 150 surface point coordinates, the coordinate range is 1.95 to 2.35 meters in the X direction, -1.20 to -0.90 meters in the Y direction, and 0.15 to 0.30 meters in the Z direction; based on the spatial position change amount in the displacement prediction parameter, the X direction is 0.02 meters, the Y direction is 0.01 meters, and the Z direction is 0.03 meters, spatial clustering processing is performed on the three-dimensional coordinate set, a density clustering algorithm is adopted, a neighborhood radius of 0.05 meters is set, a minimum point number of 10 is set, 150 points are clustered into 3 main cluster groups, the centroid coordinates of each cluster group are taken, and finally three-dimensional coordinate point cloud data is formed, including three core point coordinates , , , and the point cloud data generation process is completed.
[0126] In the embodiments of the present application, through the time sequence control of the multi-base station cooperative measurement and the intelligent data processing, the accuracy and reliability of the three-dimensional coordinate measurement in the vibration environment are effectively improved, and high-quality point cloud data basis is provided for subsequent pose calculation.
[0127] In order to solve the problem of accurate conversion of the pose offset to the control instruction of the actuator, in some embodiments, step 105: generating a displacement compensation instruction according to the spatial pose offset, and inputting the displacement compensation instruction to a closed-loop position controller of the flight target, adjusting the spatial pose of the three-dimensional adjustable connecting element through the closed-loop position controller, comprising: Step 701: decomposing the spatial pose offset into three orthogonal linear displacement components and three rotation angle components.
[0128] In step 701, the linear displacement component is the translation of the spatial pose offset in the directions of the three orthogonal coordinate axes. The rotation angle component is the rotation of the spatial pose offset around the three coordinate axes.
[0129] In the embodiments of the present application, the six-dimensional spatial pose offset is decomposed into the first three elements as linear displacement components, corresponding to the translation amounts of the X, Y, and Z axes, respectively, and the last three elements as rotation angle components, corresponding to the rotation angles around the X, Y, and Z axes, respectively. This decomposition facilitates subsequent independent control of each motion axis.
[0130] Step 702: According to the linear displacement component and the rotation angle component, and in combination with the motion characteristics of the electrically controlled displacement mechanism, the displacement compensation amount required for each motion axis is calculated.
[0131] In step 702, the electrically controlled displacement mechanism refers to an electromechanical execution device installed in the flight target structure for accurately adjusting the spatial pose of the three-dimensional adjustable connecting piece. By receiving the instructions of the closed-loop position controller, the servo motor is driven to generate precise displacement, and the pose deviation of the connecting piece relative to the reference coordinate system of the flight target is corrected in real time, ensuring that the connecting piece maintains precise synchronization with the motion trajectory of the flight target in a dynamic vibration environment. The motion characteristics of the electrically controlled displacement mechanism refer to the mechanical motion performance parameters exhibited by the mechanism under electrical signal control, including but not limited to the torque-speed characteristics of the servo motor, the transmission ratio and precision of the reduction mechanism, the stiffness and friction characteristics of the guide rail, the maximum stroke and resolution of each motion axis, the dynamic response characteristics of the mechanism, and the nonlinear error compensation parameters during the motion process, which are key physical characteristics affecting displacement accuracy and control effect. The displacement compensation amount is the actual distance or rotation angle that each motion axis needs to move.
[0132] In the embodiments of the present application, the displacement amount required for each linear motion axis is calculated based on the linear displacement component, and the rotation amount required for each rotary motion axis is calculated based on the rotation angle component in combination with the kinematic model of the mechanism, while considering the mechanical characteristics of the electrically controlled displacement mechanism such as lead screw pitch and reduction ratio, to ensure that the calculated displacement compensation amount is within the executable range of the mechanism.
[0133] Step 703: Convert the displacement compensation amount into a displacement compensation instruction in the form of a pulse control signal.
[0134] In step 703, the pulse control signal is a digital signal that represents the displacement amount through pulse quantity and frequency.
[0135] In the embodiments of the present application, the displacement compensation amount is converted into corresponding pulse number and pulse frequency. The pulse number is obtained by dividing the displacement amount by the pulse equivalent, and the pulse frequency is determined according to the motion speed requirement, generating a standardized pulse control signal as the displacement compensation instruction.
[0136] Step 704: input the displacement compensation instruction into the digital signal processing unit of the closed-loop position controller, adjust the displacement compensation instruction in real time through the digital signal processing unit, and drive the servo motor of the electric control displacement mechanism to adjust the spatial pose of the three-dimensional adjustable connecting piece based on the adjusted displacement compensation instruction.
[0137] In step 704, the digital signal processing unit is the core computing component of the closed-loop position controller. The servo motor is an electric mechanism that performs displacement operations.
[0138] In the embodiments of the present application, the pulse control signal is input into the digital signal processing unit, which monitors the execution state in real time and adjusts the pulse output according to the feedback signal to drive the servo motor to operate according to the instruction requirements, and drives the connecting piece to produce corresponding pose adjustment through the mechanical transmission mechanism.
[0139] The following is a specific example: In the precise positioning process of the three-dimensional adjustable connecting piece of the flight simulator, based on the obtained spatial pose offset , first, the spatial pose offset is decomposed into three orthogonal linear displacement components and three rotation angle components, where the linear displacement components are X-axis negative 0.04 meters, Y-axis negative 0.04 meters, and Z-axis negative 0.04 meters, and the rotation angle components are calculated through the spatial geometric relationship of the connecting piece surface marker points to be 0.5 degrees around the X-axis, negative 0.3 degrees around the Y-axis, and 0.2 degrees around the Z-axis; according to the linear displacement components and the rotation angle components, the displacement compensation amount required by each motion axis is calculated in combination with the motion characteristics of the electric control displacement mechanism, where the electric control displacement mechanism adopts ball screw transmission, the screw lead is 5mm, which is equal to 0.005m, the servo motor encoder resolution is 10000 pulses per revolution, the X-axis displacement compensation amount is calculated, the Y-axis needs , the Z-axis needs , the rotation mechanism reduction ratio is 10 to 1, the corresponding pulse number for rotating 0.5 degrees around the X-axis is calculated , the corresponding pulse number for rotating negative 0.3 degrees around the Y-axis is , and the corresponding pulse number for rotating 0.2 degrees around the Z-axis is ; the displacement compensation amount is converted into a displacement compensation instruction in the form of a pulse control signal, the pulse frequency is set to 1000 Hz, the pulse width is set to 20 microseconds, X-axis instruction negative 8000 pulses, Y-axis instruction negative 8000 pulses, Z-axis instruction negative 8000 pulses, rotation axis instruction 139 pulses, negative 83 pulses, 56 pulses are generated; the displacement compensation instruction is input to the digital signal processing unit of the closed-loop position controller, the unit uses a 32-bit processor, the sampling period is 1 millisecond, the displacement compensation instruction is adjusted in real time through the digital signal processing unit, fine adjustment is performed according to the actual displacement amount fed back by the position sensor, and the spatial pose of the three-dimensional adjustable connecting piece is adjusted based on the adjusted displacement compensation instruction. The servo motor of the electric control displacement mechanism drives the three-dimensional adjustable connecting piece to adjust the spatial pose of the three-dimensional adjustable connecting piece. The rated speed of the servo motor is 3000 revolutions per minute, and the torque is 5 newton-meters. First, X-axis negative 8000 pulses correspond to a displacement of negative 0.04 meters, Y-axis negative 8000 pulses correspond to a displacement of negative 0.04 meters, and Z-axis negative 8000 pulses correspond to a displacement of negative 0.04 meters. Then, 139 pulses of the rotation axis correspond to a rotation of 0.5 degrees around the X-axis, negative 83 pulses correspond to a rotation of negative 0.3 degrees around the Y-axis, and 56 pulses correspond to a rotation of 0.2 degrees around the Z-axis. The position sensor detects that the actual displacement is negative 0.039 meters, negative 0.039 meters, and negative 0.039 meters, and the actual rotation angle is 0.49 degrees, negative 0.29 degrees, and 0.19 degrees. The feedback is fed back to the closed-loop position controller to generate an adjustment instruction. After 3 iterations of adjustment, the displacement error is less than 0.001 meters, and the rotation angle error is less than 0.02 degrees. Finally, the precise positioning of the spatial pose of the three-dimensional adjustable connecting piece is realized.
[0140] In the embodiments of the present application, accurate instruction conversion and closed-loop control are used to realize accurate mapping from the pose offset to mechanical execution, so that the three-dimensional adjustable connecting piece can still be quickly and accurately adjusted to the target pose in a vibrating environment, and the positioning accuracy and stability of the system are improved.
[0141] Figure 4 The structure diagram of the precise positioning system of the three-dimensional adjustable connecting piece of the flight simulator provided in the embodiments of the present application is described in the specific implementation manner part: The acquisition module 41 is configured to acquire real-time stroke length, instantaneous rotation angle change data of the motion control lever in the flight target, and vibration interference image data of the three-dimensional adjustable connecting piece.
[0142] The input module 42 is configured to input the real-time stroke length and the instantaneous rotation angle change data to a pre-trained platform kinematics model, output displacement prediction parameters of the flight target, and generate three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameters.
[0143] The compensation module 43 is configured to perform sub-pixel identification and optical distortion compensation on the vibration interference image data by using a marker point recognition algorithm to generate three-dimensional visual coordinate data.
[0144] a fusion module 44, configured to fuse the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data by using a preset Kalman filter, and output a spatial pose offset of the three-dimensional adjustable connecting piece.
[0145] a generation module 45, configured to generate a displacement compensation instruction according to the spatial pose offset, and input the displacement compensation instruction to a closed-loop position controller of the flight target, so as to adjust the spatial pose of the three-dimensional adjustable connecting piece by using the closed-loop position controller, and realize accurate positioning of the three-dimensional adjustable connecting piece relative to the reference coordinate system of the flight target.
[0146] The accurate positioning system of the flight simulator three-dimensional adjustable connecting piece according to the embodiments of the present application is used to realize the accurate positioning method of the flight simulator three-dimensional adjustable connecting piece as described above, and therefore the specific embodiments of the accurate positioning system of the flight simulator three-dimensional adjustable connecting piece can be seen from the embodiment part of the accurate positioning method of the flight simulator three-dimensional adjustable connecting piece as described above, and the specific embodiments can be referred to the description of the corresponding embodiment part, which will not be described here again.
[0147] The present application also provides an electronic device, comprising: a memory configured to store a computer program; and a processor configured to execute the computer program to implement the steps of the accurate positioning method of the flight simulator three-dimensional adjustable connecting piece as described above.
[0148] The present application also provides a computer readable storage medium, wherein the computer readable storage medium stores a computer program, and the computer program is executed by a processor to implement the steps of the accurate positioning method of the flight simulator three-dimensional adjustable connecting piece as described above.
[0149] In an exemplary embodiment, the computer readable storage medium as described above can include, but is not limited to, a U disk, a read-only memory, a random access memory, a mobile hard disk, a magnetic disk or an optical disk, and various media that can store computer programs.
[0150] The embodiments of the present application also provide a computer program product, wherein the computer program product comprises a computer program, and the computer program is executed by a processor to implement the steps in the accurate positioning method of the flight simulator three-dimensional adjustable connecting piece as described above.
[0151] Those skilled in the art will further realize that the mere concepts, teachings, and embodiments described herein are merely meant to provide an enabling description of embodiments of the present application and are not intended to limit the scope of the present application. Accordingly, embodiments as described herein contemplate all modifications that come within the scope of the present application as recited by the claims set forth below and any equivalents thereto, with the scope of the present application being measured by the broadest interpretation of those claims set forth below.
[0152] The above has carried out the detailed introduction to the precision positioning method, system, equipment and storage medium of the three-dimensional adjustable connecting piece of the flight simulator provided by the application. The principle and implementation mode of the application are described in the specific examples in this paper, and the above example description is only used to help understand the method and core idea of the application. It should be pointed out that for ordinary skilled in the art, without departing from the principle of the application, the application can be improved and modified, and these improvements and modifications also fall within the protection scope of the application.
Claims
1. A method for precision positioning of a three-dimensional adjustable connection of a flight simulator, characterized in that The method comprises the following steps: acquiring real-time stroke length, instantaneous rotation angle change data of a motion control lever in a flight target, and vibration interference image data of a three-dimensional adjustable connecting piece; inputting the real-time stroke length and the instantaneous rotation angle change data into a pre-trained platform kinematics model to output displacement prediction parameters of the flight target, and generating three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameters; performing sub-pixel recognition and optical distortion compensation on the vibration interference image data by using a marker point recognition algorithm to generate three-dimensional visual coordinate data; based on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data, performing fusion processing by using a preset Kalman filter to output a spatial pose offset of the three-dimensional adjustable connecting piece; generating displacement compensation instructions according to the spatial pose offset, and inputting the displacement compensation instructions into a closed-loop position controller of the flight target to adjust the spatial pose of the three-dimensional adjustable connecting piece, so as to realize accurate positioning of the three-dimensional adjustable connecting piece relative to a reference coordinate system of the flight target.
2. The method of claim 1, wherein, The method of performing fusion processing by using a preset Kalman filter based on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data to output a spatial pose offset of the three-dimensional adjustable connecting piece comprises the following steps: converting the three-dimensional coordinate point cloud data into a first observation vector, and converting the three-dimensional visual coordinate data into a second observation vector; synchronously inputting the first observation vector and the second observation vector into the Kalman filter, wherein the Kalman filter takes the displacement prediction parameters as a state transition constraint; predicting a state estimation value at a next time point based on the state transition constraint by using a time update unit of the Kalman filter; generating the spatial pose offset of the three-dimensional adjustable connecting piece based on the state estimation value, the first observation vector and the second observation vector by using a measurement update unit of the Kalman filter.
3. The method of claim 2, wherein, The method of generating the spatial pose offset of the three-dimensional adjustable connecting piece based on the state estimation value, the first observation vector and the second observation vector comprises the following steps: calculating a Kalman gain matrix by using an adaptive weight distribution network in the measurement update unit based on the first observation vector and the second observation vector; performing weighted correction on the state estimation value based on the Kalman gain matrix to obtain a corrected state estimation value; analyzing a position deviation component and an angle deviation component from the corrected state estimation value; respectively performing motion smoothing filtering processing on the position deviation component and the angle deviation component; combining the filtered position deviation component and the filtered angle deviation component to generate the spatial pose offset of the three-dimensional adjustable connecting piece.
4. The method of claim 3, wherein, The method of calculating a Kalman gain matrix by using an adaptive weight distribution network based on the first observation vector and the second observation vector comprises the following steps: inputting the first observation vector and the second observation vector into the adaptive weight distribution network, and generating an environmental interference coefficient by using an environment perception module of the adaptive weight distribution network. The attention mechanism module of the adaptive weight distribution network is used to calculate feature importance scores of the first observation vector and the second observation vector, respectively; The real-time confidence weights of the first observation vector and the second observation vector are generated by combining the environmental interference coefficients and the feature importance scores, respectively; Based on the real-time confidence weights, a Kalman gain matrix is generated through a Kalman gain calculation formula.
5. The method of claim 1, wherein, The sub-pixel recognition and optical distortion compensation of the vibration interference image data are performed by using the marker point recognition algorithm to generate three-dimensional visual coordinate data, including: Obtaining the camera internal parameters, lens distortion coefficients, spatial position relationship and attitude parameters of the binocular vision system in the flight target; Extracting the pixel area of the visual marker point from the vibration interference image data, calculating the gray distribution barycenter of the pixel area, and taking the gray distribution barycenter as the sub-pixel level coordinate position; Based on the camera internal parameters and the lens distortion coefficients, an optical distortion compensation model is established; The sub-pixel level coordinate position is input into the optical distortion compensation model, and the sub-pixel level coordinate position is nonlinearly transformed by the polynomial coefficients stored in the optical distortion compensation model to output the corrected coordinates after eliminating the lens distortion; According to the spatial position relationship and the attitude parameters, the horizontal position difference of the corrected coordinates in the left and right images of the binocular vision system is calculated by using a stereo matching algorithm, and the disparity information is generated based on the horizontal position difference; Based on the disparity information, the three-dimensional visual coordinate data of the visual marker point in the camera coordinate system is generated by the principle of triangulation.
6. The method of claim 1, wherein, The three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece is generated based on the displacement prediction parameters, including: The displacement prediction parameters are converted into spatial scanning trigger instructions of multiple time difference ranging base stations, and the spatial scanning trigger instructions are used to control multiple time difference ranging base stations to emit ultra-wideband signals according to a preset time sequence; The echo signals of the ultra-wideband signals reflected by the surface of the three-dimensional adjustable connecting piece are received, and the signal propagation time differences of each time difference ranging base station are measured based on the echo signals; According to the signal propagation time differences, the signal propagation path lengths are calculated; Based on the signal propagation path lengths, the three-dimensional coordinate set of the surface reflection points of the three-dimensional adjustable connecting piece is generated in combination with the spatial geometric distribution relationship of each time difference ranging base station; Based on the spatial position change amount in the displacement prediction parameters, the three-dimensional coordinate set is subjected to spatial clustering processing to form three-dimensional coordinate point cloud data.
7. The method of claim 1, wherein, The displacement compensation instructions are generated according to the spatial pose offset amount, and the displacement compensation instructions are input into the closed-loop position controller of the flight target to adjust the spatial pose of the three-dimensional adjustable connecting piece, including: The spatial pose offset amount is decomposed into three orthogonal linear displacement components and three rotation angle components; According to the linear displacement components and the rotation angle components, the displacement compensation amounts required by each motion axis are calculated in combination with the motion characteristics of the electrically controlled displacement mechanism; The displacement compensation amounts are converted into displacement compensation instructions in the form of pulse control signals. The displacement compensation instruction is input to a digital signal processing unit of the closed-loop position controller, the displacement compensation instruction is adjusted in real time by the digital signal processing unit, and based on the adjusted displacement compensation instruction, a servo motor of the electric control displacement mechanism is driven to adjust the spatial pose of the three-dimensional adjustable connecting piece.
8. A precision positioning system for a three-dimensional adjustable connection of a flight simulator, characterized in that The method comprises the steps of: An acquisition module is configured to acquire real-time stroke length, instantaneous angle change data of a motion control lever in a flight target, and vibration interference image data of a three-dimensional adjustable connecting piece; An input module is configured to input the real-time stroke length and the instantaneous angle change data to a pre-trained platform kinematics model, output displacement prediction parameters of the flight target, and generate three-dimensional coordinate point cloud data of the three-dimensional adjustable connecting piece based on the displacement prediction parameters; A compensation module is configured to perform sub-pixel identification and optical distortion compensation on the vibration interference image data by using a marker point recognition algorithm, and generate three-dimensional visual coordinate data; A fusion module is configured to perform fusion processing on the three-dimensional coordinate point cloud data and the three-dimensional visual coordinate data by using a preset Kalman filter, and output a spatial pose offset of the three-dimensional adjustable connecting piece; A generation module is configured to generate a displacement compensation instruction according to the spatial pose offset, input the displacement compensation instruction to a closed-loop position controller of the flight target, adjust the spatial pose of the three-dimensional adjustable connecting piece by the closed-loop position controller, and achieve accurate positioning of the three-dimensional adjustable connecting piece relative to a reference coordinate system of the flight target.
9. A computing device, comprising: The method comprises the steps of: A memory is configured to store a computer program; A processor is configured to execute the computer program to implement the steps of the accurate positioning method of the three-dimensional adjustable connecting piece of the flight simulator according to any one of claims 1 to 7.
10. A computer-readable storage medium, characterized in that, The computer program is stored in the computer-readable storage medium, and when executed by the processor, the computer program can implement the accurate positioning method of the three-dimensional adjustable connecting piece of the flight simulator according to any one of claims 1 to 7.
Citation Information
Patent Citations
Rocket engine structural member pose motion compensation method in vibration environment
CN113610763A
Fixed-wing unmanned aerial vehicle attitude correction and precise flight control method fused with visual navigation
CN120540363A
Position controller
JP2000148207A
Cited By
Full-mover fusion positioning method and system based on XR handle
CN121437638A
Vision-based servo rotating table plate automatic centering control method and system
CN121982049A
Logistics cabinet cooperation device and control method thereof
CN122059190A
A logistics cabinet collaborative device and its control method
CN122059190B
Flight simulator multi-execution mechanism vibration cooperative control method and system
CN122308496A