Method and device for quickly correcting position of shipborne helicopter deck
By analyzing and optimizing the landing position deviation of the carrier helicopter carrier robot, formulating trajectory planning strategies and control parameters, the problems of cumbersome deck correction methods and low accuracy are solved, and the efficiency and safety of calibration operations are improved.
Patent Information
- Application Number
- CN202411085767.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-08
- Publication Date
- 2024-11-22
AI Technical Summary
The deck correction method of the carrier helicopter carrier robot is cumbersome and the calibration operation accuracy is low. The existing technology has failed to effectively solve the helicopter landing error and subsequent traction process error correction control methods and corresponding strategies due to environmental factors.
By analyzing the deviations of the landing postures of different aircraft, formulating trajectory planning strategies, based on dynamic modeling and motion characteristics analysis of the traction system and power device, multivariate optimization algorithm is used to optimize the control parameters during the traction process, and form different landings for different landings Correction operation control strategy for position correction.
It has achieved simplification of the deck correction method and improved the accuracy of calibration operations, reduced manual assistance, and improved the safety and efficiency of helicopter transport.
Smart Images

Figure CN119002560A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of mechanical control, and in particular to a method and a device for quickly correcting the position of a shipboard helicopter deck. Background Art
[0002] The shipborne helicopter carrier robot has the integrated operation function of capturing and towing the helicopter, which effectively improves the safety and efficiency of the deck operation during the helicopter landing process, especially in the high sea conditions operation environment, its advantages are more obvious. Due to the influence of harsh environment and human factors during the helicopter landing process, the actual landing position is uncertain within a certain range. A poor landing position will cause the helicopter to be unable to be towed into the warehouse, affecting the safety of the operation and making it impossible to carry out the subsequent automated operation process. Therefore, the helicopter needs a carrier robot to perform deck correction operations to reduce a large amount of manual assistance and realize the automated and integrated process of "assisted landing-mooring-correction-warehouse". As the core work content of the shipborne helicopter carrier robot, the correction operation directly affects the safety and efficiency of the shipborne helicopter transfer. Since the movement of the shipborne helicopter carrier robot is only controlled by the left and right winches of the towing system, and there are many factors that affect the correction accuracy. The current shipborne helicopter carrier robot correction operation faces key problems such as cumbersome deck correction methods and low correction operation accuracy.
[0003] At present, the existing relevant patents on the research of shipborne helicopter carrier robots mainly focus on the research of towing equipment structure, the positioning of carrier-based aircraft landing target points, and the path trajectory planning during the subsequent towing process. However, the helicopter landing error caused by environmental factors and the subsequent towing process error correction control method and corresponding strategy are not considered, so that the crew still needs to manually correct the helicopter posture during the towing process to facilitate the subsequent storage operation. In summary, the existing shipborne helicopter carrier robot correction operation control methods and strategies are rare, and the control effect and landing automation need to be further improved. Therefore, it is urgent to provide a shipborne helicopter carrier robot correction towing system correction method and correction operation control strategy. Summary of the invention
[0004] According to the above-mentioned technical problem that there is no helicopter landing error and subsequent towing process error correction control method and corresponding strategy, a method and device for rapid correction of the deck position of a ship-borne helicopter are provided. First, the present invention analyzes different aircraft landing postures caused by random factors, decomposes and quantifies the landing deviation, and formulates a trajectory planning strategy based on the characteristics of different postures; then, through a correction method based on the dynamic modeling and motion characteristic analysis of the towing system and the power unit, the coupling relationship of various variables in the towing motion is clarified; finally, an optimization algorithm that considers multiple variable factors of the towing process is used to optimize the various variables of the towing process, and the optimized control parameters for different landing postures are systematically integrated to form a correction operation control strategy for the ship-borne helicopter carrier robot under different landing postures, thereby solving the problem of cumbersome deck correction methods and low correction operation accuracy.
[0005] The technical means adopted by the present invention are as follows:
[0006] A method for quickly correcting the position of a ship-borne helicopter deck comprises the following steps:
[0007] S1. Based on different landing postures of the helicopter, the lateral offset deviation and the angular offset deviation under the current landing posture of the helicopter are determined by performing deviation quantitative analysis on different landing postures of the helicopter; a dynamic model of the mooring device is established based on the traction system unit of the correction device and the ship-borne helicopter carrier robot unit;
[0008] S2. Based on the dynamic model of the tethered device and the motion characteristics analysis, a correction trajectory planning strategy is formulated for the lateral offset deviation and the angular offset deviation of the current helicopter through a correction method based on speed coordinated control;
[0009] S3. When formulating the correction trajectory planning strategy, use the optimal trajectory multivariable solution method for different postures. By using the multivariable collaborative optimization algorithm of the traction process, the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle are solved;
[0010] S4. Correct the shipborne helicopter based on the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle.
[0011] Furthermore, the deviation quantification analysis in S1 specifically includes the following steps:
[0012] With the ideal storage position of the helicopter as a reference, the initial angle offset deviation of the fuselage orientation angle of the shipborne helicopter landing is measured by the angle sensor arranged on the shipborne helicopter carrier robot, and the initial lateral offset deviation of the shipborne helicopter is measured by the displacement sensor arranged on the shipborne helicopter carrier robot.
[0013] Furthermore, in S1, the steps of establishing the kinetic model of the mooring device are as follows:
[0014] The motion characteristics of the left track tractor, the right track tractor and the ship-borne helicopter carrier robot are simplified into the plane motion of the rigid body; by taking the right track tractor which only has relative rotation around its own axis as the origin of the coordinate point, the initial position of the right manipulator of the ship-borne helicopter carrier robot as the y-axis, and the transverse slide of the manipulator as the x-axis to establish the coordinate system, the velocity relationship between the left track tractor and the right track tractor can be obtained as follows:
[0015]
[0016] Among them, v a is the vertical speed of the left track tractor; v b is the vertical speed of the right track tractor, ω is the rotational angular velocity of the main body of the ship-borne helicopter transport robot; r is the distance between the left track tractor and the right track tractor, and L is the distance between the two traction tracks;
[0017] r can be expressed as:
[0018]
[0019] In the formula, θ is the body orientation angle, that is, the angle between the current position of the ship-borne helicopter carrier robot and the initial horizontal position;
[0020] The angular velocity ω of the ship-borne helicopter carrying robot body is:
[0021]
[0022] During the rotation correction process, when the helicopter moves with the ship-borne helicopter carrier robot, the relationship between the initial fuselage orientation angle, the initial fuselage lateral offset and the deflection angle γ of the helicopter steering wheel in the correction trajectory is:
[0023]
[0024] Among them, L3 is the distance from the center point of the main wheel axis to the center of the steering wheel, θ0 is the initial fuselage heading angle offset, and d0 is the initial fuselage lateral offset.
[0025] Furthermore, S2 specifically includes the following steps:
[0026] S21. According to the set rated values of lateral offsets of different helicopter models, different landing postures of the helicopter are divided into two cases of a larger lateral offset and a smaller lateral offset. For the landing posture of the smaller lateral offset, correction control by trajectory optimization is adopted; the offset of the case of the larger lateral offset exceeds the rated value, and the offset of the case of the smaller lateral offset does not exceed the rated value;
[0027] S22: The landing posture with a large lateral offset is divided into two cases, parallel landing and non-parallel landing, according to whether the fuselage orientation angle θ is equal to zero. For the parallel landing, a two-segment arc correction control method is adopted; the correction strategy for the non-parallel landing is S23 or S24;
[0028] S23, the non-parallel landing situation is divided into two situations: the positive and negative directions of the yaw angle and the lateral offset are on the same side and the yaw angle and the lateral offset are on opposite sides, and a multi-stage planning and correction control method is adopted;
[0029] S24, using trajectory optimization correction control method;
[0030] S25. Integrate the posture correction strategies obtained in S21 to S24 to form an optimal decision database.
[0031] Furthermore, in S21, the conditions for the parallel landing are as follows: the fuselage heading angle offset θ0=0°, the lateral posture offset x0≠0, and the posture correction strategy for the parallel landing is:
[0032] First, according to the initial lateral offset d0, the direction of the steering wheel deflection angle γ is set. When d0 is positive, γ is positive, and when d0 is negative, γ is negative. The deflection angle can be set arbitrarily, which is specifically operated manually by the helicopter pilot. After the deflection angle is set, the steering wheel is locked, and then the helicopter performs the first segment of the trajectory for straightening movement under the traction of the mooring device; when the displacement sensor detects that the lateral offset d is reduced to half of the initial lateral offset d0, the center point of the main wheel shaft just reaches the center point of the helicopter correction trajectory; at this time, the driver deflects the steering wheel in the opposite direction by the same angle, and then the helicopter will perform straightening movement according to the second segment of the trajectory. After the lateral offset d returns to zero, the center point of the main wheel shaft just reaches the end of the trajectory; finally, the driver turns the steering wheel back to the positive position, and the posture straightening operation is completed;
[0033] In S22, the condition for the non-parallel landing is as follows: when the lateral offset x0 is lower than the lateral offset setting value of the aircraft model, and the yaw angle and the lateral offset are on the same side, that is, θ0>0° and x0>0 or θ0<0° and x0<0, the multi-stage planning posture correction strategy for the non-parallel landing is:
[0034] Since the initial lateral offset d0 is small, the landing posture of the helicopter needs to be converted from the current posture to the parallel landing posture with a larger initial lateral offset d0 in S21; first, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter towards the direction close to the hangar. When the displacement sensor detects that the lateral offset d exceeds the rated value of the lateral offset of the helicopter model, the steering wheel deflection angle γ is set to |d0|×45° / d0; when the angle sensor detects that the current fuselage yaw angle θ=0°, the helicopter deck posture is transformed from the initial lateral offset d0 being small, θ0≠0° to the initial lateral offset d0 being large, θ0=0°, that is, the condition of the helicopter parallel landing deck posture is met; subsequently, the method in S21 is used to calibrate the helicopter; this method has a long longitudinal traction distance and is not suitable for traction conditions where the helicopter is close to the hangar, but has the advantage of small calculation amount and can use the helicopter deflection angle database for parallel landing.
[0035] When the yaw angle and the lateral offset are on opposite sides, that is, θ0>0° and x0<0 or θ0<0° and x0>0, the multi-segment planning posture correction strategy is:
[0036] Since the initial lateral offset d0 is small, the landing posture of the helicopter must first be converted from the current posture to the parallel landing posture with a larger initial lateral offset d0 in S21. First, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter towards the hangar. When the displacement sensor detects that the lateral offset d exceeds the rated value of the lateral offset of the helicopter model, the steering wheel deflection angle γ is set to -|d0|×45° / d0. When the angle sensor detects that the current fuselage yaw angle θ=0°, the helicopter deck posture changes from the initial lateral offset d0 being small, θ0≠0° to the initial lateral offset d0 being large, θ0=0°, which satisfies the condition of the helicopter parallel landing deck posture. The method in S21 is subsequently used to calibrate the helicopter;
[0037] In S23, the landing posture of the helicopter is as follows: the lateral offset x0 is lower than the lateral offset setting value of the aircraft type, the fuselage heading angle offset θ0≠0°, and the trajectory optimization posture correction strategy for the non-parallel landing is:
[0038] When the initial lateral offset d0 of the helicopter is small, a two-stage rotation correction is used for deck correction. Compared with S21, the starting points of the two-stage rotation correction trajectories of this correction strategy are selected as follows: if the initial posture of the helicopter is d0>0 and θ0<0, θ0 is the starting point of the first rotation correction trajectory, then the posture of the starting point of the second rotation correction trajectory, that is, the end point of the first rotation correction trajectory, is d1<0 and θ0<θ1<0, and the first rotation correction must be that the carrier robot pulls the helicopter away from the hangar; the second rotation correction must be that the carrier robot pulls the helicopter away from the hangar, and the end point of the second rotation correction trajectory must be d2=0 and θ2=0. When the angle sensor detects that the current fuselage yaw angle θ=0°, the pilot turns the steering wheel back to the right, thereby completing the posture straightening operation;
[0039] In S24, the trajectory optimization conditions are as follows: the lateral offset x0 exceeds the rated value, and the fuselage heading angle offset θ0≠0°; the posture correction strategy is as follows:
[0040] When the initial lateral offset d0 of the helicopter is large, parallel traction is required to reduce the lateral offset d before rotation correction. First, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter to move in a straight line in the direction of the initial fuselage yaw angle θ0. When the displacement sensor detects that the lateral offset d meets the rated value of the rotation correction lateral offset of the helicopter model, the steering wheel deflection angle γ is set to -|d0||θ0|×45° / (θ0d0) and rotation correction is performed. When the angle sensor detects that the current fuselage yaw angle θ=0°, the pilot turns the steering wheel back to the right position, thus completing the posture straightening operation.
[0041] Furthermore, S3 specifically includes the following steps:
[0042] S31, substituting the lateral offset deviation and the angular offset deviation into the mooring device dynamics model to solve the constraint conditions, summarizing the correction trajectory characteristics of the helicopter under different landing postures, obtaining the correction trajectory planning strategy according to the posture correction strategy obtained in S21 to S24, and forming the correction trajectory planning best decision database, and at the same time summarizing the helicopter front wheel deflection angle with the best current landing deviation and the recommended values of the fuselage orientation angle at the beginning and end of different correction trajectories to form a helicopter deflection angle database;
[0043] S32, inputting the relationship between the helicopter lateral offset, offset angle and heading angle into the BP neural network training and then into the trajectory prediction database, and outputting the optimization curve weight and feasibility of each turn under different correction trajectories;
[0044] S33, obtaining the current landing deviation, retrieving the current best steering decision from the best decision database based on the current landing deviation, retrieving the recommended deflection angle and the direction angle range of the current posture from the helicopter deflection angle database based on the current landing deviation, using an adaptive genetic algorithm to optimize the left traction winch speed, the right traction winch speed, the number of optimal trajectory curves, the optimal length of each trajectory, and the optimal helicopter deflection angle control variables of each trajectory during the traction process for the current best steering decision and the recommended deflection angle and the direction angle range of the current posture, and using the trajectory prediction database to calculate the individual fitness of the population, and finally outputting the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle after the population converges to the optimal point under the current working condition, and the judgment condition of the optimal point is that the population fitness variance is less than 0.01.
[0045] The present invention also provides a shipborne helicopter deck position rapid correction device, which is used to implement any of the above-mentioned shipborne helicopter deck position rapid correction methods, comprising: a traction system unit, a track unit, a shipborne helicopter transport robot unit, a helicopter unit and a control system unit;
[0046] The traction system unit includes a left traction winch and a right traction winch; the track unit includes a right track, a right track tractor, a left track and a left track tractor; the ship-borne helicopter carrying robot unit includes a ship-borne helicopter carrying robot body, a ship-borne helicopter carrying robot right mechanical arm and a ship-borne helicopter carrying robot left mechanical arm; the helicopter unit includes a helicopter right rear wheel, a helicopter left rear wheel, a helicopter body and a helicopter front wheel;
[0047] The left traction winch is connected to the left track tractor through a steel cable, and the left track tractor is arranged at the end of the left track. The right traction winch is connected to the right track tractor through a steel cable, and the right track tractor is arranged at the end of the right track. The left track tractor is arranged at the bottom of the shell of the ship-borne helicopter carrier robot. The bottom of the shell of the ship-borne helicopter carrier robot performs translational or rotational movement under the traction of the right track tractor and the left track tractor; the left track tractor and the right track tractor are respectively located at the left end and the right end of the ship-borne helicopter carrier robot;
[0048] The left mechanical arm and the right mechanical arm of the ship-borne helicopter carrying robot are installed on a sliding support, and the sliding support slides left and right along the support slide rail on the ship-borne helicopter carrying robot under the drive of the hydraulic cylinder; the left mechanical arm and the right mechanical arm of the ship-borne helicopter carrying robot grab and fix the left rear wheel of the helicopter and the probe on the right rear wheel of the helicopter.
[0049] Furthermore, the probe rods on the left rear wheel of the helicopter and the right rear wheel of the fixed helicopter are fixed by the double-claw ship-borne helicopter carrier robot. When the ship-borne helicopter carrier robot is driven by the traction steel cable, the helicopter will be driven forward or backward in a direction perpendicular to the ship-borne helicopter carrier robot; when the front wheels of the helicopter are deflected by a certain angle, due to the lateral floating of the right and left mechanical arms on the ship-borne helicopter carrier robot, the helicopter can move forward or backward, and at the same time can move left and right in a direction horizontal to the ship-borne helicopter carrier robot.
[0050] Furthermore, compared with the right track tractor, the left track tractor is additionally provided with a slide groove that can extend the main body of the ship-borne helicopter carrier robot for lateral movement; the left track tractor and the ship-borne helicopter carrier robot shell not only have relative sliding along the slide groove direction, but also have relative rotation around their own axis; the right track tractor and the device shell only have relative rotation around their own axis; so that the horizontal directions of the left track tractor and the right track tractor are always equal during the rotation of the ship-borne helicopter carrier robot unit and the helicopter unit.
[0051] Compared with the prior art, the present invention has the following advantages:
[0052] The correction operation trajectory optimization process of the present invention contains 5 control variables, namely the number of optimal trajectory curves, the optimal length of each trajectory segment, the optimal deflection angle of the helicopter for each trajectory segment, the left traction winch speed, and the right traction winch speed. After the optimization algorithm is used to solve the combination of the optimal control variables, the optimal control of the correction operation under different landing postures can be achieved. The trajectory planning strategy formulated based on different postures can provide the core boundary conditions for the optimization of trajectory optimization variables, reduce the optimization calculation amount, and improve the optimization accuracy.
[0053] The correction method based on speed coordinated control, the relationship between the helicopter's lateral offset, offset angle and heading angle, and the trajectory prediction database constructed by the BP neural network toolbox in the present invention can predict the helicopter trajectory under various parameters by simulating the actual correction operation process, thereby reducing the frequency of on-site testing, improving optimization efficiency, and shortening the optimization cycle.
[0054] The control method of the present invention contains multiple sets of constraint conditions, such as: the maximum spacing distance between the left and right connecting axes, the maximum lateral offset, the maximum deflection angle of the helicopter, the maximum number of trajectory curves, etc., which reduces the inapplicability of the optimization process and the invalid solutions in the actual process, and improves the accuracy of the prediction and the speed of the calculation. BRIEF DESCRIPTION OF THE DRAWINGS
[0055] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0056] Figure 1 A system diagram showing the hardware configuration of the correction traction system of the present invention.
[0057] Figure 2 A flow chart showing the optimization control strategy for the overall correction operation of the present invention.
[0058] Figure 3 A schematic diagram showing the trajectory planning strategy based on different postures of the present invention.
[0059] Figure 4 Trajectory diagrams under different trajectory planning strategies of the present invention are shown.
[0060] Figure 5 A schematic diagram showing the multivariable optimization algorithm of the present invention.
[0061] In the figure: 1. Left traction winch; 2. Right traction winch; 3. Right track; 4. Right track tractor; 5. Shipborne helicopter carrier robot body; 6. Shipborne helicopter carrier robot right mechanical arm; 7. Helicopter right rear wheel; 8. Helicopter left rear wheel; 9. Helicopter body; 10. Shipborne helicopter carrier robot left mechanical arm; 11. Left track; 12. Left track tractor; 13. Helicopter front wheel. DETAILED DESCRIPTION
[0062] It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments can be combined with each other. The present invention will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.
[0063] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0064] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit exemplary embodiments according to the present invention. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprising" and / or "including" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0065] Unless otherwise specifically stated, the relative arrangement of the parts and steps described in these embodiments, the numerical expressions and numerical values do not limit the scope of the present invention. At the same time, it should be clear that, for ease of description, the sizes of the various parts shown in the drawings are not drawn according to the actual proportional relationship. The technology, methods and equipment known to ordinary technicians in the relevant field may not be discussed in detail, but in appropriate cases, the technology, methods and equipment should be regarded as part of the authorization specification. In all examples shown and discussed here, any specific value should be interpreted as merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar numbers and letters represent similar items in the following drawings, so once an item is defined in one drawing, it does not need to be further discussed in subsequent drawings.
[0066] In the description of the present invention, it is necessary to understand that the directions or positional relationships indicated by directional words such as "front, back, up, down, left, right", "lateral, vertical, perpendicular, horizontal" and "top, bottom" are usually based on the directions or positional relationships shown in the drawings. They are only for the convenience of describing the present invention and simplifying the description. Unless otherwise specified, these directional words do not indicate or imply that the device or element referred to must have a specific direction or be constructed and operated in a specific direction. Therefore, they cannot be understood as limiting the scope of protection of the present invention: the directional words "inside and outside" refer to the inside and outside relative to the contours of each component itself.
[0067] For ease of description, spatially relative terms such as "above", "above", "on the upper surface of", "above", etc. may be used here to describe the spatial positional relationship between a device or feature and other devices or features as shown in the figure. It should be understood that spatially relative terms are intended to include different orientations of the device in use or operation in addition to the orientation described in the figure. For example, if the device in the accompanying drawings is inverted, the device described as "above other devices or structures" or "above other devices or structures" will be positioned as "below other devices or structures" or "below their position devices or structures". Thus, the exemplary term "above" can include both "above" and "below". The device can also be positioned in other different ways (rotated 90 degrees or in other orientations), and the spatially relative descriptions used here are interpreted accordingly.
[0068] In addition, it should be noted that the use of terms such as "first" and "second" to limit components is only for the convenience of distinguishing the corresponding components. If not otherwise stated, the above terms have no special meaning and therefore cannot be understood as limiting the scope of protection of the present invention.
[0069] like Figure 1 As shown, the present invention provides a device for quickly correcting the position of a ship-borne helicopter deck, comprising: a traction system unit, a track unit, a ship-borne helicopter transport robot unit, and a helicopter unit;
[0070] The traction system unit includes: a left traction winch 1, a right traction winch 2; the track unit includes: a right track 3, a right track tractor 4, a left track 11, and a left track tractor 12; the ship-borne helicopter carrier robot unit includes: a ship-borne helicopter carrier robot body 5, a ship-borne helicopter carrier robot right mechanical arm 6, and a ship-borne helicopter carrier robot left mechanical arm 10; the helicopter unit includes: a helicopter right rear wheel 7, a helicopter left rear wheel 8, a helicopter body 9, and a helicopter front wheel 13;
[0071] The specific connection relationship of this system is as follows:
[0072] The left traction winch 1 and the right traction winch 2 are connected with the left track tractor 12 and the right track tractor 4 through the steel cables of the left traction winch 1 and the right traction winch 2. The left traction winch 1 and the right traction winch 2 pull the left track tractor 12 and the right track tractor 4 to move along the left track 11 and the right track 3 through the steel cables. The left track tractor 12 and the right track tractor 4 are respectively installed at the bottom of the shell of the ship-borne helicopter carrying robot body. The ship-borne helicopter carrying robot body performs translational or rotational movement under the traction of the left track tractor 12 and the right track tractor 4.
[0073] The left track tractor 12 and the right track tractor 4 are respectively installed on both sides of the bottom of the ship-borne helicopter carrier robot body 5, and are used to tow the ship-borne helicopter carrier robot body 5, and also have the deck position locking function. The left track tractor 12 and the right track tractor 4 are connected to the towing steel cable, so that the ship-borne helicopter carrier robot body can move along the deck track under the traction of the left traction winch 1 and the right traction winch 2.
[0074] The ship-borne helicopter carrier robot 5 grabs and fixes the probes on the helicopter right rear wheel 7 and the helicopter left rear wheel 8 through the ship-borne helicopter carrier robot right mechanical arm 6 and the ship-borne helicopter carrier robot left mechanical arm 10. The ship-borne helicopter carrier robot right mechanical arm 6 and the ship-borne helicopter carrier robot left mechanical arm 10 are installed on the sliding support, and the sliding support can slide left and right along the support slide rail on the ship-borne helicopter carrier robot body under the drive of the hydraulic cylinder.
[0075] The probes on the right rear wheel 7 and the left rear wheel 8 of the helicopter are fixed by the double-claw ship-borne helicopter carrier robot. When the ship-borne helicopter carrier robot is driven by the traction steel cable, the helicopter will be driven forward or backward in a direction perpendicular to the ship-borne helicopter carrier robot; when the front wheels of the helicopter are deflected by a certain angle, due to the lateral floating of the right mechanical arm 6 and the left mechanical arm 10 of the ship-borne helicopter carrier robot, the helicopter can not only move forward or backward, but also move left and right in a direction horizontal to the ship-borne helicopter carrier robot.
[0076] The present invention also provides a method for rapid correction of the position of a shipboard helicopter deck, which is implemented based on a rapid correction device for the position of a shipboard helicopter deck. The specific flow chart of the overall optimization control strategy for the correction operation is as follows: Figure 2 As shown;
[0077] S1. According to different landing postures of the helicopter, the lateral offset deviation and the angular offset deviation of the current helicopter are determined by using a deviation quantification analysis method of different landing postures;
[0078] By analyzing the characteristics of the ship-borne helicopter carrier robot and the helicopter traction motion mechanism during the correction operation, it is concluded that for a controllable steering wheel helicopter, when the deflection angle is 0°, the helicopter will move in the direction of the fuselage. If the helicopter moves in the direction of reducing the lateral offset, the lateral offset can be reset to zero, that is, the midpoint of the main wheel shaft will be translated to the center axis of the left and right tracks. When the deflection angle is 90°, the helicopter will rotate around the center point of the main wheel shaft, so that the direction of the fuselage can be adjusted to make the fuselage parallel to the track. Therefore, the entire correction operation process can be decomposed into a finite number of ordered combinations of translations and rotations, and these combinations can be integrated into multiple curves or straight line trajectories. From the above conclusions, it can be obtained that the deviation quantification decomposition method takes the ideal storage position of the helicopter as a reference, and decomposes the actual landing position deviation of the aircraft into lateral offset and angular offset through random landing position deviation decomposition for error quantification.
[0079] Based on the mechanical connection characteristics between the track tractor and the main body of the ship-borne helicopter carrier robot, the left tractor (left connecting shaft a) and the main body of the ship-borne helicopter carrier robot not only have relative sliding along the direction of the slide groove, but also have relative rotation around their own axis, while the right tractor (right connecting shaft b) and the main body of the ship-borne helicopter carrier robot only have the characteristics of relative rotation around their own axis. The motion characteristics of the track tractor and the main body of the ship-borne helicopter carrier robot are simplified to the plane motion of a rigid body. By establishing a coordinate system with the right connecting shaft b that only has relative rotation around its own axis as the coordinate point, the velocity relationship between the left and right tractors can be obtained as follows:
[0080]
[0081] The distance r between the left connecting axis a and the right connecting axis b can be expressed as:
[0082]
[0083] Where θ is the angle between the current position of the shipborne helicopter carrier robot and its initial horizontal position.
[0084] Then, it can be concluded that the rotation angular velocity ω of the ship-borne helicopter carrying robot body is:
[0085]
[0086] During the rotation correction process, when the helicopter moves with the ship-borne helicopter carrier robot, the relationship between the initial fuselage orientation angle, the initial fuselage lateral offset and the deflection angle γ of the helicopter steering wheel in the correction trajectory is:
[0087]
[0088] Among them, L3 is the distance from the center point of the main wheel axis to the center of the steering wheel, θ0 is the initial fuselage heading angle offset, and d0 is the initial fuselage lateral offset.
[0089] By determining the coupling relationship between the fuselage heading angle, the fuselage lateral offset and the helicopter steering wheel deflection angle in the correction trajectory, a theoretical basis is provided for the subsequent establishment of a helicopter deflection angle database, that is, selecting the recommended helicopter steering wheel deflection angle according to the fuselage heading angle and the fuselage lateral offset.
[0090] When the helicopter moves with the ship-borne helicopter carrier robot, the relationship between the initial fuselage orientation angle, the initial fuselage lateral offset and the deflection angle γ of the helicopter steering wheel in the correction trajectory is:
[0091]
[0092] Where L3 is the distance from the center of the main wheel axis to the center of the steering wheel, θ0 is the initial fuselage heading angle offset, and d0 is the initial fuselage lateral offset.
[0093] By determining the coupling relationship between the fuselage heading angle, the fuselage lateral offset and the helicopter steering wheel deflection angle in the correction trajectory, a theoretical basis is provided for the subsequent establishment of a helicopter deflection angle database, that is, selecting the recommended helicopter steering wheel deflection angle according to the fuselage heading angle and the fuselage lateral offset.
[0094] S2. Based on the dynamic modeling and motion characteristics analysis of the traction system and the mooring device, a trajectory planning strategy is formulated for the lateral offset deviation and the angular offset deviation of the current helicopter through a correction method based on speed coordinated control; the principle diagram of the trajectory planning strategy formulated based on different postures is shown in the figure below. Figure 3 As shown in the figure, due to the different landing postures of helicopters, the same correction method cannot meet the correction accuracy requirements of all lateral offset corrections. Therefore, a variety of trajectory optimization strategies are adopted. By analyzing the characteristics of different types of landing postures, the characteristics are summarized and the corresponding correction trajectory optimization strategies are designed. According to the difficulty of different posture correction operations and the different correction strategies, it is divided into the following five cases:
[0095] First, the different landing postures of the helicopter are divided into two cases: one with a large lateral offset and the other with a small lateral offset. For the landing posture with a small lateral offset, trajectory optimization correction control is used. The specific boundary conditions of the optimal trajectory are as follows: Figure 4 (d)
[0096] Secondly, the landing posture of the helicopter with a large lateral offset is further divided into two cases: parallel landing and non-parallel landing. For the case of parallel landing (i.e., 1. the fuselage orientation angle offset θ0 = 0°, 2. the lateral posture offset x0 ≠ 0), a two-segment arc correction control method is adopted. The specific boundary conditions for the optimal trajectory are as follows: Figure 4 (a)
[0097] Afterwards, the non-parallel landing posture is subdivided into two cases: the yaw angle and the lateral offset are on the same side as the offset angle (i.e., 1.θ0>0° and x0>0 or 2.θ0<0° and x0<0) and the lateral offset is on the opposite side (i.e., 1.θ0>0° and x0<0 or 2.θ0<0° and x0>0). The control method of multi-segment planning correction can be adopted. The specific boundary conditions of the optimal trajectory are as follows: Figure 4 (b) and 4(c), the correction method of multi-segment planning is suitable for the correction position far away from the hangar, and the optimization calculation amount is small;
[0098] The non-parallel landing posture can also use the correction control method of trajectory optimization. The specific boundary conditions of the optimization trajectory are as follows: Figure 4 As shown in (e), this method is suitable for the correction position far away from the hangar. The longitudinal correction distance is shorter than that of multi-segment planning, but the optimization calculation amount is larger;
[0099] Finally, the above posture correction strategies are integrated to form a trajectory planning strategy, which is called under different correction operation conditions. The advantages of this strategy are: it not only meets the correction operation requirements of all landing postures, but also ensures that the accuracy after correction meets the operation requirements. It can also provide the core boundary conditions for the subsequent trajectory optimization variable optimization and reduce the optimization calculation amount.
[0100] S2 specifically includes the following steps:
[0101] S21. According to the set rated values of lateral offsets of different helicopter models, different landing postures of the helicopter are divided into two cases of a larger lateral offset and a smaller lateral offset. For the landing posture of the smaller lateral offset, correction control by trajectory optimization is adopted; the offset of the case of the larger lateral offset exceeds the rated value, and the offset of the case of the smaller lateral offset does not exceed the rated value;
[0102] S22: The landing posture with a large lateral offset is divided into two cases, parallel landing and non-parallel landing, according to whether the fuselage orientation angle θ is equal to zero. For the parallel landing, a two-segment arc correction control method is adopted; the correction strategy for the non-parallel landing is S23 or S24;
[0103] S23, the non-parallel landing situation is divided into two situations: the positive and negative directions of the yaw angle and the lateral offset are on the same side and the positive and negative directions of the yaw angle and the lateral offset are on opposite sides, and a control method of multi-stage planning correction is adopted;
[0104] S24, using trajectory optimization correction control method;
[0105] S25. Integrate the posture correction strategies obtained in S21 to S24 to form an optimal decision database.
[0106] In S21, the conditions for parallel landing are as follows: the fuselage orientation angle offset θ0=0°, the lateral posture offset x0≠0, and the posture correction strategy for parallel landing is:
[0107] First, according to the initial lateral offset d0, the direction of the steering wheel deflection angle γ is set. When d0 is positive, γ is positive, and when d0 is negative, γ is negative. The deflection angle can be set arbitrarily, which is specifically operated manually by the helicopter pilot. After the deflection angle is set, the steering wheel is locked, and then the helicopter performs the first segment of the trajectory for straightening movement under the traction of the mooring device; when the displacement sensor detects that the lateral offset d is reduced to half of the initial lateral offset d0, the center point of the main wheel shaft just reaches the center point of the helicopter correction trajectory; at this time, the driver deflects the steering wheel in the opposite direction by the same angle, and then the helicopter will perform straightening movement according to the second segment of the trajectory. After the lateral offset d returns to zero, the center point of the main wheel shaft just reaches the end of the trajectory; finally, the driver turns the steering wheel back to the positive position, and the posture straightening operation is completed;
[0108] In S22, the condition for the non-parallel landing is as follows: when the lateral offset x0 is lower than the lateral offset setting value of the aircraft model, and the yaw angle and the lateral offset are on the same side, that is, θ0>0° and x0>0 or θ0<0° and x0<0, the multi-stage planning posture correction strategy for the non-parallel landing is:
[0109] Since the initial lateral offset d0 is small, the landing posture of the helicopter needs to be converted from the current posture to the parallel landing posture with a larger initial lateral offset d0 in S21; first, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter towards the direction close to the hangar. When the displacement sensor detects that the lateral offset d exceeds the rated value of the lateral offset of the helicopter model, the steering wheel deflection angle γ is set to |d0|×45° / d0; when the angle sensor detects that the current fuselage yaw angle θ=0°, the helicopter deck posture is transformed from the initial lateral offset d0 being small, θ0≠0° to the initial lateral offset d0 being large, θ0=0°, that is, the condition of the helicopter parallel landing deck posture is met; subsequently, the method in S21 is used to calibrate the helicopter; this method has a long longitudinal traction distance and is not suitable for traction conditions where the helicopter is close to the hangar, but has the advantage of small calculation amount and can use the helicopter deflection angle database for parallel landing.
[0110] When the yaw angle and the lateral offset are on opposite sides, that is, θ0>0° and x0<0 or θ0<0° and x0>0, the multi-segment planning posture correction strategy is:
[0111] Since the initial lateral offset d0 is small, the landing posture of the helicopter needs to be converted from the current posture to the parallel landing posture with a larger initial lateral offset d0 in S21. First, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter to move in the direction close to the hangar. When the displacement sensor detects that the lateral offset d exceeds the rated value of the lateral offset of the helicopter model, the steering wheel deflection angle γ is set to -|d0|×45° / d0. When the angle sensor detects that the current fuselage yaw angle θ=0°, the helicopter deck posture is transformed from the initial lateral offset d0 is small, θ0≠0° to the initial lateral offset d0 is large, θ0=0°, that is, the condition of the helicopter parallel landing deck posture is met. The method in S21 is subsequently used for helicopter correction. This method has a long longitudinal traction distance and is not suitable for traction conditions where the helicopter is close to the hangar, but its advantage is that the calculation amount is small and the helicopter deflection angle database for parallel landing can be used.
[0112] In S23, the landing posture of the helicopter is as follows: the lateral offset x0 is lower than the lateral offset setting value of the aircraft type, the fuselage heading angle offset θ0≠0°, and the trajectory optimization posture correction strategy for the non-parallel landing is:
[0113] When the initial lateral offset d0 of the helicopter is small, a two-stage rotation correction is used for deck correction. Compared with S21, the starting points of the two-stage rotation correction trajectories of this correction strategy are selected as follows: if the initial posture of the helicopter is d0>0 and θ0<0 (the starting point of the first rotation correction trajectory), then the posture of the starting point of the second rotation correction trajectory (the end point of the first rotation correction trajectory) is d1<0 and θ0<θ1<0, and the first rotation correction must be that the carrier robot tows the helicopter away from the hangar; the second rotation correction must be that the carrier robot tows the helicopter away from the hangar, and the end point of the second rotation correction trajectory must be d2=0 and θ2=0. When the angle sensor detects that the current fuselage yaw angle θ=0°, the pilot will turn the steering wheel back to the correct position, thereby completing the posture straightening operation.
[0114] In S24, the trajectory optimization conditions are as follows: the lateral offset x0 exceeds the rated value, and the fuselage heading angle offset θ0≠0°; the posture correction strategy is as follows:
[0115] When the initial lateral offset d0 of the helicopter is large, parallel traction is required to reduce the lateral offset d before rotation correction. First, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter to move in a straight line in the direction of the initial fuselage yaw angle θ0. When the displacement sensor detects that the lateral offset d meets the rated value of the lateral offset for rotation correction of the helicopter model, the steering wheel deflection angle γ is set to -|d0||θ0|×45° / (θ0d0) and then rotation correction is performed. When the angle sensor detects that the current fuselage yaw angle θ=0°, the driver turns the steering wheel back to the right position, thus completing the posture alignment operation.
[0116] S3, using the optimal trajectory multivariable solution method with different postures, by using the traction process multivariable collaborative optimization algorithm, solve the left traction winch speed, right traction winch speed, the number of optimal trajectory curves, the optimal length of each trajectory, the optimal deflection angle of the helicopter for each trajectory and other control variables under each curve of the optimized correction trajectory; the principle diagram of the multivariable optimization algorithm is as follows Figure 5 shown.
[0117] Firstly, according to the key characteristics of the helicopter correction position, the constraints are solved by substituting them into the dynamic model of the tethered device, and the correction trajectory characteristics of the helicopter under different landing postures are summarized. The optimal correction curve steering direction decision for the continuous correction process is proposed, namely parallel landing planning, multi-segment planning and trajectory optimization decision, to form the best decision database;
[0118] Then, the relationship between the helicopter's lateral offset, offset angle and heading angle is imported into the trajectory prediction database after training with a BP neural network, which is used to predict the weight and feasibility of the optimized curve of each turn under different correction trajectories.
[0119] Finally, the current landing deviation is substituted into the optimization algorithm, the current best turning decision is retrieved from the best decision database, the recommended deflection angle and heading angle range of the current posture are retrieved from the helicopter deflection angle database, the adaptive genetic algorithm is used to optimize the variables of the traction process, and the trajectory prediction database is used to calculate the individual fitness of the population. After meeting the optimization conditions, the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle are output.
[0120] S3 specifically includes the following steps:
[0121] S31, substitute the lateral offset deviation and the angular offset deviation into the mooring device dynamics model to solve the constraint conditions, summarize the correction trajectory characteristics under different landing postures of the helicopter, and obtain the correction trajectory planning strategy according to the posture correction strategy obtained in claims S21 to S24, and form the best decision database for correction trajectory planning. At the same time, summarize the recommended values of the front wheel deflection angle of the helicopter with the best current landing deviation and the fuselage orientation angle at the beginning and end of different correction trajectories;
[0122] S32, inputting the relationship between the helicopter lateral offset, offset angle and heading angle into the BP neural network training and then into the trajectory prediction database, and outputting the optimization curve weight and feasibility of each turn under different correction trajectories;
[0123] S33, obtaining the current landing deviation, retrieving the current best steering decision from the best decision database based on the current landing deviation, retrieving the recommended deflection angle and the direction angle range of the current posture from the helicopter deflection angle database based on the current landing deviation, using an adaptive genetic algorithm to optimize the current best steering decision and the recommended deflection angle and the direction angle range of the current posture, such as the left traction winch speed, the right traction winch speed, the number of optimal trajectory curves, the optimal length of each trajectory, the optimal helicopter deflection angle of each trajectory, and other control variables during the traction process, and using the trajectory prediction database to calculate the individual fitness of the population, and finally outputting the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle after the population converges to the optimal point under the current working condition (the genetic algorithm termination judgment condition: the population fitness variance <0.01).
[0124] S4. Correct the shipborne helicopter based on the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle. The optimal values of each variable of the correction trajectory under different landing postures are included in the expert control database to form a multivariable collaborative control strategy for the traction process, which is convenient for subsequent correction operations.
[0125] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A method for quickly correcting the position of a shipboard helicopter deck, characterized in that: The steps include: S1. Based on different landing postures of the helicopter, the lateral offset deviation and the angular offset deviation under the current landing posture of the helicopter are determined by performing deviation quantitative analysis on different landing postures of the helicopter; a dynamic model of the mooring device is established based on the traction system unit of the correction device and the ship-borne helicopter carrier robot unit; S2. Based on the dynamic model of the tethered device and the motion characteristics analysis, a correction trajectory planning strategy is formulated for the lateral offset deviation and the angular offset deviation of the current helicopter through a correction method based on speed coordinated control; S3. When formulating the correction trajectory planning strategy, use the optimal trajectory multivariable solution method for different postures. By using the multivariable collaborative optimization algorithm of the traction process, the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle are solved; S4. Correct the shipborne helicopter based on the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle.
2. The method for rapid correction of the position of a shipborne helicopter deck according to claim 1, characterized in that: The deviation quantification analysis in S1 specifically includes the following steps: With the ideal storage position of the helicopter as a reference, the initial angle offset deviation of the fuselage orientation angle of the shipborne helicopter landing is measured by the angle sensor arranged on the shipborne helicopter carrier robot, and the initial lateral offset deviation of the shipborne helicopter is measured by the displacement sensor arranged on the shipborne helicopter carrier robot.
3. The method for rapid correction of the position of a shipborne helicopter deck according to claim 1, characterized in that: In S1, the steps to establish the tethered device dynamic model are as follows: The motion characteristics of the left track tractor, the right track tractor and the ship-borne helicopter carrier robot are simplified into the plane motion of the rigid body; by taking the right track tractor which only has relative rotation around its own axis as the origin of the coordinate point, the initial position of the right manipulator of the ship-borne helicopter carrier robot as the y-axis, and the transverse slide of the manipulator as the x-axis to establish the coordinate system, the velocity relationship between the left track tractor and the right track tractor can be obtained as follows: Among them, v a is the vertical speed of the left track tractor; v b is the vertical speed of the right track tractor, ω is the rotational angular velocity of the main body of the ship-borne helicopter transport robot; r is the distance between the left track tractor and the right track tractor, and L is the distance between the two traction tracks; r can be expressed as: In the formula, θ is the body orientation angle, that is, the angle between the current position of the ship-borne helicopter carrier robot and the initial horizontal position; The angular velocity ω of the ship-borne helicopter carrying robot body is: During the rotation correction process, when the helicopter moves with the ship-borne helicopter carrier robot, the relationship between the initial fuselage orientation angle, the initial fuselage lateral offset and the deflection angle γ of the helicopter steering wheel in the correction trajectory is: Among them, L3 is the distance from the center point of the main wheel axis to the center of the steering wheel, θ0 is the initial fuselage heading angle offset, and d0 is the initial fuselage lateral offset.
4. The method for rapid correction of the position of a shipborne helicopter deck according to claim 1, characterized in that: S2 specifically includes the following steps: S21. According to the set rated values of lateral offsets of different helicopter models, different landing postures of the helicopter are divided into two cases of a larger lateral offset and a smaller lateral offset. For the landing posture of the smaller lateral offset, correction control by trajectory optimization is adopted; the offset of the case of the larger lateral offset exceeds the rated value, and the offset of the case of the smaller lateral offset does not exceed the rated value; S22: The landing posture with a large lateral offset is divided into two cases, parallel landing and non-parallel landing, according to whether the fuselage orientation angle θ is equal to zero. For the parallel landing, a two-segment arc correction control method is adopted; the correction strategy for the non-parallel landing is S23 or S24; S23, the non-parallel landing situation is divided into two situations: the positive and negative directions of the yaw angle and the lateral offset are on the same side and the positive and negative directions of the yaw angle and the lateral offset are on opposite sides, and a control method of multi-stage planning correction is adopted; S24, using trajectory optimization correction control method; S25. Integrate the posture correction strategies obtained in S21 to S24 to form an optimal decision database.
5. The method for rapid correction of the position of a shipborne helicopter deck according to claim 4, characterized in that: In S21, the conditions for parallel landing are as follows: the fuselage orientation angle offset θ0=0°, the lateral posture offset x0≠0, and the posture correction strategy for parallel landing is: First, according to the initial lateral offset d0, the direction of the steering wheel deflection angle γ is set. When d0 is positive, γ is positive, and when d0 is negative, γ is negative. The deflection angle can be set arbitrarily, which is specifically operated manually by the helicopter pilot. After the deflection angle is set, the steering wheel is locked, and then the helicopter performs the first segment of the trajectory for straightening movement under the traction of the mooring device; when the displacement sensor detects that the lateral offset d is reduced to half of the initial lateral offset d0, the center point of the main wheel shaft just reaches the center point of the helicopter correction trajectory; at this time, the driver deflects the steering wheel in the opposite direction by the same angle, and then the helicopter will perform straightening movement according to the second segment of the trajectory. After the lateral offset d returns to zero, the center point of the main wheel shaft just reaches the end of the trajectory; finally, the driver turns the steering wheel back to the positive position, and the posture straightening operation is completed; In S22, the condition for the non-parallel landing is as follows: when the lateral offset x0 is lower than the lateral offset setting value of the aircraft model, and the yaw angle and the lateral offset are on the same side, that is, θ0>0° and x0>0 or θ0<0° and x0<0, the multi-stage planning posture correction strategy for the non-parallel landing is: Since the initial lateral offset d0 is small, the landing posture of the helicopter needs to be converted from the current posture to the parallel landing posture with a larger initial lateral offset d0 in S21; first, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter towards the direction close to the hangar. When the displacement sensor detects that the lateral offset d exceeds the rated value of the lateral offset of the helicopter model, the steering wheel deflection angle γ is set to |d0|×45° / d0; when the angle sensor detects that the current fuselage yaw angle θ=0°, the helicopter deck posture is transformed from the initial lateral offset d0 being small, θ0≠0° to the initial lateral offset d0 being large, θ0=0°, that is, the condition of the helicopter parallel landing deck posture is met; subsequently, the method in S21 is used to calibrate the helicopter; this method has a long longitudinal traction distance and is not suitable for traction conditions where the helicopter is close to the hangar, but has the advantage of small calculation amount and can use the helicopter deflection angle database for parallel landing. When the yaw angle and the lateral offset are on opposite sides, that is, θ0>0° and x0<0 or θ0<0° and x0>0, the multi-segment planning posture correction strategy is: Since the initial lateral offset d0 is small, the landing posture of the helicopter must first be converted from the current posture to the parallel landing posture with a larger initial lateral offset d0 in S21. First, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter towards the hangar. When the displacement sensor detects that the lateral offset d exceeds the rated value of the lateral offset of the helicopter model, the steering wheel deflection angle γ is set to -|d0|×45° / d0. When the angle sensor detects that the current fuselage yaw angle θ=0°, the helicopter deck posture changes from the initial lateral offset d0 being small, θ0≠0° to the initial lateral offset d0 being large, θ0=0°, which satisfies the condition of the helicopter parallel landing deck posture. The method in S21 is subsequently used to calibrate the helicopter; In S23, the landing posture of the helicopter is as follows: the lateral offset x0 is lower than the lateral offset setting value of the aircraft type, the fuselage heading angle offset θ0≠0°, and the trajectory optimization posture correction strategy for the non-parallel landing is: When the initial lateral offset d0 of the helicopter is small, a two-stage rotation correction is used for deck correction. Compared with S21, the starting points of the two-stage rotation correction trajectories of this correction strategy are selected as follows: if the initial posture of the helicopter is d0>0 and θ0<0, θ0 is the starting point of the first rotation correction trajectory, then the posture of the starting point of the second rotation correction trajectory, that is, the end point of the first rotation correction trajectory, is d1<0 and θ0<θ1<0, and the first rotation correction must be that the carrier robot pulls the helicopter away from the hangar; the second rotation correction must be that the carrier robot pulls the helicopter away from the hangar, and the end point of the second rotation correction trajectory must be d2=0 and θ2=0. When the angle sensor detects that the current fuselage yaw angle θ=0°, the pilot turns the steering wheel back to the right, thereby completing the posture straightening operation; In S24, the trajectory optimization conditions are as follows: the lateral offset x0 exceeds the rated value, and the fuselage heading angle offset θ0≠0°; the posture correction strategy is as follows: When the initial lateral offset d0 of the helicopter is large, parallel traction is required to reduce the lateral offset d before rotation correction. First, the steering wheel deflection angle γ of the helicopter is set to 0°, and the helicopter carrier robot pulls the helicopter to move in a straight line in the direction of the initial fuselage yaw angle θ0. When the displacement sensor detects that the lateral offset d meets the rated value of the rotation correction lateral offset of the helicopter model, the steering wheel deflection angle γ is set to -|d0||θ0|×45° / (θ0d0) and rotation correction is performed. When the angle sensor detects that the current fuselage yaw angle θ=0°, the pilot turns the steering wheel back to the right position, thus completing the posture straightening operation.
6. The method for rapid correction of the position of a shipborne helicopter deck according to claim 5, characterized in that: S3 specifically includes the following steps: S31, substituting the lateral offset deviation and the angular offset deviation into the mooring device dynamics model to solve the constraint conditions, summarizing the correction trajectory characteristics of the helicopter under different landing postures, obtaining the correction trajectory planning strategy according to the posture correction strategy obtained in S21 to S24, and forming the correction trajectory planning best decision database, and at the same time summarizing the helicopter front wheel deflection angle with the best current landing deviation and the recommended values of the fuselage orientation angle at the beginning and end of different correction trajectories to form a helicopter deflection angle database; S32, inputting the relationship between the helicopter lateral offset, offset angle and heading angle into the BP neural network training and then into the trajectory prediction database, and outputting the optimization curve weight and feasibility of each turn under different correction trajectories; S33, obtaining the current landing deviation, retrieving the current best steering decision from the best decision database based on the current landing deviation, retrieving the recommended deflection angle and the direction angle range of the current posture from the helicopter deflection angle database based on the current landing deviation, using an adaptive genetic algorithm to optimize the left traction winch speed, the right traction winch speed, the number of optimal trajectory curves, the optimal length of each trajectory, and the optimal helicopter deflection angle control variables of each trajectory during the traction process for the current best steering decision and the recommended deflection angle and the direction angle range of the current posture, and using the trajectory prediction database to calculate the individual fitness of the population, and finally outputting the length of each curve under the optimal trajectory of the current landing posture and the corresponding helicopter deflection angle after the population converges to the optimal point under the current working condition, and the judgment condition of the optimal point is that the population fitness variance is less than 0.
01.
7. A device for quickly correcting the position of a shipboard helicopter deck, used to implement the method for quickly correcting the position of a shipboard helicopter deck as claimed in any one of claims 1 to 6, characterized in that: include: Traction system unit, track unit, ship-borne helicopter transport robot unit, helicopter unit and control system unit; The traction system unit includes a left traction winch and a right traction winch; the track unit includes a right track, a right track tractor, a left track and a left track tractor; the ship-borne helicopter carrying robot unit includes a ship-borne helicopter carrying robot body, a ship-borne helicopter carrying robot right mechanical arm and a ship-borne helicopter carrying robot left mechanical arm; the helicopter unit includes a helicopter right rear wheel, a helicopter left rear wheel, a helicopter body and a helicopter front wheel; The left traction winch is connected to the left track tractor through a steel cable, and the left track tractor is arranged at the end of the left track. The right traction winch is connected to the right track tractor through a steel cable, and the right track tractor is arranged at the end of the right track. The left track tractor is arranged at the bottom of the shell of the ship-borne helicopter carrier robot. The bottom of the shell of the ship-borne helicopter carrier robot performs translational or rotational movement under the traction of the right track tractor and the left track tractor; the left track tractor and the right track tractor are respectively located at the left end and the right end of the ship-borne helicopter carrier robot; The left mechanical arm and the right mechanical arm of the ship-borne helicopter carrying robot are installed on a sliding support, and the sliding support slides left and right along the support slide rail on the ship-borne helicopter carrying robot under the drive of the hydraulic cylinder; the left mechanical arm and the right mechanical arm of the ship-borne helicopter carrying robot grab and fix the left rear wheel of the helicopter and the probe on the right rear wheel of the helicopter.
8. The device for rapid correction of the position of a shipborne helicopter deck according to claim 7, characterized in that: The probe rods on the left rear wheel of the helicopter and the right rear wheel of the fixed helicopter are fixed by the double-claw ship-borne helicopter carrier robot. When the ship-borne helicopter carrier robot is driven by the traction steel cable, it will drive the helicopter forward or backward in a direction perpendicular to the ship-borne helicopter carrier robot; when the front wheels of the helicopter are deflected by a certain angle, due to the lateral floating of the right mechanical arm and the left mechanical arm on the ship-borne helicopter carrier robot, the helicopter can move forward or backward, and at the same time can move left and right in a direction horizontal to the ship-borne helicopter carrier robot.
9. The device for rapid correction of the position of a shipborne helicopter deck according to claim 7, characterized in that: Compared with the right track tractor, the left track tractor is additionally provided with a slide groove that can extend the main body of the ship-borne helicopter carrier robot for lateral movement; the left track tractor and the ship-borne helicopter carrier robot shell not only have relative sliding along the slide groove direction, but also have relative rotation around their own axis; the right track tractor and the device shell only have relative rotation around their own axis; so that the horizontal directions of the left track tractor and the right track tractor are always equal during the rotation of the ship-borne helicopter carrier robot unit and the helicopter unit.
