A drone take-off and landing nest and its control method

By combining the intelligent site adaptive subsystem, the multimodal recognition and docking subsystem, and the software-defined service subsystem with RTK and machine vision fusion guidance, the problem of adaptive leveling and precise landing of UAV take-off and landing sites in complex terrain has been solved, realizing flexible UAV services.

CN123114014APending Publication Date: 2026-11-17SHANGHAI BINY ELECTRIC
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611563167.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-10-10
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Existing drone take-off and landing sites lack environmental adaptability, have low landing guidance accuracy, and are inflexible in hardware design, resulting in high operating costs and poor compatibility.

Method used

The system employs an intelligent site adaptive subsystem, a multimodal recognition and docking subsystem, and a software-defined service subsystem, combined with RTK and machine vision fusion guidance, to achieve adaptive leveling and precise landing of the drone nest, and adapts to different drone models through the software-defined service subsystem.

Benefits of technology

It improves the landing accuracy of drones from meters to centimeters, reduces the risk of accidents, and enables rapid deployment of drone nests in complex terrain and flexible service for different types of drones.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123114014A_ABST
    Figure CN123114014A_ABST
Patent Text Reader

Abstract

This invention provides a UAV takeoff and landing pod and its control method, relating to the technical field of UAV ground infrastructure technology. The method includes: after the UAV takeoff and landing pod is powered on, the task scheduling master control unit triggers the intelligent site adaptive subsystem to perform site status assessment and adaptive leveling; the task scheduling master control unit receives operation task instructions from the cloud and parses the instructions to obtain UAV identification and service configuration parameters; during the UAV's return phase, the task scheduling master control unit guides the UAV to land in a predetermined docking area based on RTK differential positioning data and visual sensor data; after detecting the UAV's landing, the task scheduling master control unit performs physical fixation and energy replenishment operations for the UAV. This invention solves the problem of insufficient UAV guidance accuracy, thereby improving the UAV guidance accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of unmanned aerial vehicle (UAV) ground infrastructure, and more specifically, to a UAV take-off and landing pod and its control method. Background Technology

[0002] A fully automated unmanned aerial vehicle (UAV) operation system typically consists of three parts: the UAV platform, the onboard payload, and the ground-based take-off and landing dock. The take-off and landing dock, as the UAV's "home," undertakes critical tasks such as storage, energy replenishment, data transmission, and remote deployment.

[0003] However, existing drone take-off and landing sites have many systemic technical defects in practical applications, which restrict the degree of automation and application scope of drone operations.

[0004] First, existing drone nests generally lack the ability to proactively adapt to their deployment environment. Their installation process requires extremely high ground flatness, typically necessitating lengthy manual site leveling or the pouring of concrete foundations. This prevents rapid deployment of nests in complex terrains such as mountainous areas and temporary field work sites. Furthermore, during long-term operation, even minor ground settlement can cause the nest to tilt, potentially leading to malfunctions such as jammed hatches or drones slipping off.

[0005] Secondly, the existing takeoff and landing guidance process is an "open-loop" system. The drone nest itself cannot actively sense the relative position of the drone, but only passively waits for the drone to land using its own GPS or RTK navigation. In the last few meters of the landing phase, due to the multipath effect or blockage of satellite signals, the positioning accuracy of the drone often only reaches the meter level, which can easily lead to accidents such as landing deviation and collision with the edge of the nest.

[0006] Finally, the existing drone housing's service functions (such as charging ports and mounting mechanisms) are rigidly designed for specific drone models. When operators need to change or upgrade drone models, it often requires complex hardware modifications to the internal mechanical structure of the housing, or even scrapping the entire drone. This inflexible hardware architecture leads to high operating costs and poor compatibility. Summary of the Invention

[0007] This invention provides a drone take-off and landing nest and its control method to at least solve the problem of unreliable landing guidance in related technologies.

[0008] According to an embodiment of the present invention, a method for controlling the take-off and landing nests of unmanned aerial vehicles (UAVs) is provided, comprising: After the UAV take-off and landing nest is powered on, the task scheduling master control unit triggers the intelligent site adaptive subsystem to perform site status assessment and adaptive leveling. The task scheduling main control unit receives the task instructions sent from the cloud and parses the task instructions to obtain the drone's identity and service configuration parameters; During the UAV's return phase, the task scheduling master control unit activates the multimodal recognition and docking subsystem, and guides the UAV to land in the predetermined docking area based on RTK differential positioning data and visual sensing data. After detecting the landing of the UAV, the task scheduling master control unit drives the software-defined service subsystem based on the service configuration parameters to perform physical anchoring and energy replenishment operations for the UAV.

[0009] According to another embodiment of the present invention, a drone take-off and landing nest is provided, comprising: Airframe structure, the airframe structure including an openable protective hatch and a landing platform; The intelligent station adaptive subsystem includes an inertial measurement unit, a meteorological sensor, and four independently controlled electrically operated support push rods, used to monitor environmental conditions and adjust the horizontal attitude of the take-off and landing platform; The multimodal recognition and docking subsystem, which includes an RTK base station module, an industrial camera, and a wireless communication module, is used to provide phased positioning and guidance data during the UAV's return journey. The software-defined service subsystem, which includes a three-axis servo manipulator, a replaceable charging probe, and a gripping mechanism, is used to perform physical operations according to the service configuration file. The task scheduling master control unit is communicatively connected to the intelligent station adaptive subsystem, the multimodal recognition and docking subsystem, and the software-defined service subsystem, and is used to execute the aforementioned method.

[0010] According to yet another embodiment of the present invention, a computer-readable storage medium is also provided, wherein a computer program is stored therein, wherein the computer program is configured to perform the steps in any of the above method embodiments when executed.

[0011] According to yet another embodiment of the present invention, an electronic device is also provided, including a memory and a processor, wherein the memory stores a computer program and the processor is configured to run the computer program to perform the steps in any of the above method embodiments.

[0012] This invention uses the fusion of RTK and machine vision for guidance, and introduces a multi-source height fusion verification mechanism to transform the landing process from "blind landing" to "visual guidance," improving landing accuracy from the meter level to the centimeter level and reducing the risk of accidents. Therefore, it can solve the problem of low landing guidance accuracy and achieve the effect of improving landing guidance accuracy. Attached Figure Description

[0013] Figure 1 This is a structural block diagram of a drone take-off and landing pod according to an embodiment of the present invention; Figure 2 This is a flowchart of a drone takeoff and landing nest control method according to an embodiment of the present invention; Figure 3 This is a schematic diagram illustrating the principle of an embodiment of the present invention. Detailed Implementation

[0014] The technical solutions of the embodiments of this application will be described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of this application, and not all embodiments.

[0015] In the following description, the terms "first," "second," etc., are used for descriptive purposes only and should not be construed as indicating or implying relative importance or implicitly specifying the number of technical features indicated. Therefore, a feature defined with "first," "second," etc., may explicitly or implicitly include one or more of that feature. In the description of this application, unless otherwise stated, "a plurality of" means two or more.

[0016] Furthermore, in this application, directional terms such as "upper," "lower," "left," and "right" may be defined relative to the orientation of the components shown in the accompanying drawings. It should be understood that these directional terms can be relative concepts, used for relative description and clarification, and may change accordingly depending on the orientation of the components in the accompanying drawings.

[0017] In this application, unless otherwise expressly specified and limited, the term "connection" should be interpreted broadly. For example, "connection" can be a fixed connection, a detachable connection, or an integral part; it can be a direct connection or an indirect connection through an intermediate medium. Furthermore, the term "coupled" can refer to an electrical connection that enables signal transmission.

[0018] As used herein, “about,” “approximately,” or “approximately” includes the stated value and the average value within an acceptable range of deviation from the given value, wherein the acceptable range of deviation is determined by a person skilled in the art taking into account the measurement under discussion and the error associated with the measurement of the given quantity (i.e., the limitations of the measurement system).

[0019] Example 1 This embodiment provides a drone takeoff and landing nest, which is designed as an intelligent terminal entity integrating environmental perception, precise guidance, and flexible services. Physically, the nest system mainly consists of an airframe structure, an intelligent site adaptive subsystem, a multimodal recognition and docking subsystem, a software-defined service subsystem, and a task scheduling control unit.

[0020] The airframe structure includes a high-strength metal frame, a take-off and landing platform for carrying the UAV, and an openable protective door. The protective door adopts a two-section sliding structure, which can fully expose the take-off and landing platform when opened to facilitate the take-off, landing, and operation of the UAV. The base of the UAV nest refers to a rigid frame consisting of the take-off and landing platform, the load-bearing beam located below the take-off and landing platform, and the mounting points of the four electrically powered support push rods. The take-off and landing platform is rigidly connected to the load-bearing beam, and no vibration isolation elements or movable connectors are installed between the take-off and landing platform and the base of the UAV nest.

[0021] The intelligent station adaptive subsystem is responsible for the nest's self-sensing and environmental adaptation. It includes a high-precision six-axis inertial measurement unit (IMU), a meteorological sensor array (including an anemometer and rain gauge), and four independently driven electric support rods. These electric support rods are installed at the four bottom corners of the fuselage structure. Each rod is equipped with a built-in Hall effect sensor or absolute encoder for real-time feedback of its extension length. By sensing the nest's attitude through the IMU and adjusting the nest's angle relative to the ground using the electric support rods, this subsystem ensures that the takeoff and landing platform remains absolutely level on uneven ground.

[0022] For example, the IMU uses a high-precision six-axis sensor module, which integrates a three-axis gyroscope and a three-axis accelerometer; the IMU connects to the underlying microcontroller via an SPI bus, and the sampling frequency is set to [value missing]. To eliminate temperature drift, the module integrates a constant-temperature heating circuit to lock the operating temperature at a specific level. In terms of quantitative metrics, the acceleration range of this IMU is configured as follows: Zero bias stability is better than ; Gyroscope range configuration is Zero bias stability is better than This high-precision sensor selection ensures accurate determination of the static tilt angle of the nacelle base relative to the vertical line of gravity, even under conditions of strong winds and vibrations in the field. Each push rod employs a DC brushless motor-driven ball screw structure, with a physical stroke of... The maximum lifting thrust is (Sufficient to support the cell's own weight and maximum wind load), the extension and retraction speed of the push rod is adjustable, ranging from... The feedback element is an absolute magnetic encoder built into the tail of the push rod, with a resolution of [resolution value missing]. (i.e., the 4096 line), which means that every time the putter moves... The encoder generates approximately Changes in count values ​​(assuming the lead screw is ) (Corresponding to the full scale range), achieving sub-millimeter-level monitoring of the extension length. Furthermore, its underlying controller uses a position-based PID algorithm to drive the push rod; here, the target extension amount is set to... The current encoder feedback length is ,error Control output The PWM duty cycle is calculated as follows: The parameters are tuned as follows: (Provides rapid response) (Eliminate steady-state error) (Suppressing overshoot), this control loop uses The frequency of operation ensures that the push rod can stop precisely at the target position calculated in step S130, with a steady-state error. .

[0023] The multimodal recognition and docking subsystem is responsible for the return guidance and precise landing of the UAV. This subsystem integrates an RTK base station module, a high frame rate industrial camera, an infrared beacon transmitter, and a wireless communication module in terms of hardware. The RTK base station module is used to send carrier phase differential data to the UAV, providing a wide-area centimeter-level positioning reference. The industrial camera is installed at the center or edge of the take-off and landing platform with its lens pointing vertically upward, and is used to capture the visual tag on the bottom of the UAV in the near field. The multimodal recognition and docking subsystem constructs a seamless guidance link from the far field to the near field by fusing satellite positioning data and visual image data.

[0024] For example, the RTK module uses a multi-frequency, multi-satellite GNSS receiver. This module supports GPS L1 / L2 / L5 and BeiDou B1 / B2 / B3 frequency bands. Its antenna is mounted on an unobstructed pole high outside the receiver housing. The module communicates via a UART interface... The baud rate outputs a differentially corrected data stream in RTCM3.3 format to the main control unit, with a data update rate of [missing information]. The camera resolution is... Pixel, cell size Lens selection Fixed-focus low-distortion lens with a field of view (FOV) of [missing information]. This wide-angle configuration ensures that when the drone is in When hovering at a high altitude, the camera's field of view can cover the ground. The area, thus even if the drone's RTK positioning exists. Error, visual label (size) This information will inevitably appear in the image, eliminating the risk of "missing" it. Furthermore, to achieve high-level fusion of multiple sources, the system establishes a unified timestamp mechanism. The main control unit utilizes the FPGA as a hardware trigger source, and each... Simultaneously triggering a camera exposure and an ultrasonic altitude readout ensures image data... and altitude data Time deviation less than This ensures the accuracy of subsequent fusion calculations.

[0025] It should be noted that in the timestamp mechanism, the FPGA latches the height data of the ultrasonic ranging module while outputting a trigger pulse to the industrial camera. The width of the trigger pulse is 10μs. Both the image data and the height data carry the FPGA's count value as an acquisition time identifier. The task scheduling master control unit pairs the image data and the height data according to the acquisition time identifier. Image data that fails to pair does not participate in the weighted fusion. The horizontal offset between the antenna phase center of the RTK base station module and the optical center of the industrial camera is no greater than 100mm. This horizontal offset is written into the task scheduling master control unit as an installation parameter. When broadcasting differential data to the UAV, the task scheduling master control unit compensates for the coordinates of the antenna phase center according to the horizontal offset, so that the differential positioning reference is consistent with the center of the predetermined docking area.

[0026] The software-defined service subsystem is responsible for the physical support operations after the UAV lands. This subsystem includes a three-axis servo manipulator, a set of replaceable charging probes, and an adaptive gripping mechanism. The three-axis servo manipulator can perform precise position control on the X, Y, and Z Cartesian coordinate axes. The task scheduling main control unit dynamically sets the target coordinates and action logic of the manipulator by reading the configuration file for a specific UAV model, thereby achieving compatibility with different models.

[0027] The task scheduling master control unit is usually implemented by a high-performance embedded industrial computer (such as an industrial control board based on ARM or x86 architecture). It communicates with the above subsystems through CAN bus, RS485 bus or Ethernet and is responsible for task parsing, status monitoring, logic judgment and instruction issuance.

[0028] Example 2 This embodiment provides a method for controlling the take-off and landing of UAVs based on the above system. This method realizes full-process automation from UAV deployment and mission execution to return-to-base support.

[0029] refer to Figure 2 The method includes the following steps: S100, after the task scheduling master control unit is powered on in the machine nest, it triggers the intelligent station adaptive subsystem to perform station status assessment and adaptive leveling.

[0030] In unstructured field environments, the ground often has a certain slope and undulation. In order to ensure the safety of UAV take-off and landing and the normal operation of the mechanical structure, the nest must first establish a horizontal working benchmark. This step aims to eliminate the influence of terrain factors on the nest attitude through closed-loop control logic.

[0031] The site status assessment and adaptive leveling are triggered at the following times: when the nacelle is powered on, before each task begins, and when the task scheduling control unit reads an absolute value of roll or pitch exceeding [a certain threshold] during standby. The latter two triggering times execute the same sub-steps as when powered on. The site status assessment also includes determining the terrain adaptability range. When the vertical height difference between any two of the four support points exceeds 300mm, the task scheduling main control unit determines that the current terrain exceeds the adaptability range of the nest, locks the protective hatch, and reports terrain alarm information.

[0032] Specifically, it includes the following sub-steps: S110 collects current roll and pitch angle data through an inertial measurement unit located on the base of the cradle.

[0033] The inertial measurement unit (IMU) is rigidly fixed to the geometric center of the takeoff and landing platform via four mounting holes. The takeoff and landing platform is rigidly connected to the base of the crater via a load-bearing beam. No vibration isolation elements or movable connectors are installed between the takeoff and landing platform and the crater base. Therefore, the roll and pitch angles of the takeoff and landing platform are consistent with those of the crater base. The roll and pitch angle data collected by the IMU can be directly used as the attitude angles of the crater base for leveling calculations. The coordinate system of the IMU is aligned with the body coordinate system of the crater. When the crater is powered on, the accelerometers and gyroscopes inside the IMU begin to work, and after internal attitude calculation algorithms (such as Kalman filtering or complementary filtering), the current attitude angles of the crater are output.

[0034] In this embodiment, the attitude calculation algorithm determines that the deviation between the resultant acceleration output by the accelerometer and the gravitational acceleration is less than [a certain value]. Furthermore, the magnitude of the three-axis angular velocity of the gyroscope is less than... When the homing is determined to be in a stationary state, the attitude angle for leveling is output only in the stationary state to avoid the vibration caused by wind load being calculated as tilt angle; the attitude angle output period of the IMU is 5ms, and the task scheduling master control unit takes the arithmetic mean of the roll angle and pitch angle of 20 consecutive output cycles, and uses the arithmetic mean as the acquisition result of this step.

[0035] For example, assume the current roll angle output by the inertial measurement unit. for Pitch angle for These two values ​​indicate that the nest is currently tilted, with the left side higher than the right and the front lower than the back.

[0036] S120 obtains the vertical height difference between the four support points of the nest base based on roll angle data, pitch angle data, and nest geometry parameters.

[0037] In this step, the task scheduling control unit uses the principles of rigid body kinematics to calculate the vertical deviation of each support leg mounting point relative to the center of the nest (or the ideal horizontal plane). Assuming the nest base is rectangular and the four support legs... They are located at the four corners respectively.

[0038] For example, the coordinates of the nest center are defined as the origin. The horizontal installation coordinates of the four support legs are as follows: The unit is millimeters. Based on the acquired roll angle ( ) and pitch angle ( Using the small angle approximation formula The vertical height difference between each point can be calculated. : for point: .

[0039] for point: .

[0040] for point: .

[0041] for point: .

[0042] The above calculation results show that, The point is lowest relative to the center (and needs to extend the most). The point is the highest relative to the center.

[0043] It should be noted that the small-angle approximation formula applies when the absolute value of the tilt angle is less than... When this condition is met, the relative deviation of the vertical height difference does not exceed 0.5%, where the relative deviation is the deviation between the calculation result of the small angle approximation formula and the precise solution result of the rotation matrix; when the absolute value of the roll angle or the pitch angle is not less than At that time, the task scheduling master control unit switched to using a rotation matrix to accurately calculate the vertical height difference of each support point.

[0044] S130, using the point with the highest vertical height among the four support points as a reference, obtain the target compensation height of the other three support points relative to the reference point.

[0045] To ensure that all four support legs are firmly in contact with the ground and that the entire nest is not suspended in mid-air, the leveling strategy typically involves either "extending without retracting" or "using the lowest point as the zero reference." In this embodiment, the highest vertical height point (i.e., the one with the largest numerical value) is selected. As the "lowest position" in physics (because the nacelle is a rigid body, a raised corner means that the leg at that corner is at its maximum height off the ground, or that the push rod corresponding to that corner needs to extend the least).

[0046] Based on the aforementioned calculation results, The height value of the point is (lowest), The height value of the point is (Highest). To level the points, all points need to be raised to the highest point. On the horizontal surface.

[0047] Therefore, the target elongation of each leg The calculation is as follows: .

[0048] .

[0049] (Keep it stationary as a reference point).

[0050] .

[0051] The target compensation height is also constrained by the physical stroke of the push rod. When the target elongation corresponding to any support point exceeds 300mm, the task scheduling main control unit stops the current leveling action and outputs an alarm message indicating that the terrain exceeds the adaptation range. When the target elongation corresponding to all four support points does not exceed 300mm, the task scheduling main control unit issues drive commands in descending order of target elongation to avoid momentary tilting of the machine nest during the leveling process.

[0052] S140 generates drive commands based on the target compensation height to control the corresponding electric support push rod to extend until the roll angle and pitch angle data collected by the inertial measurement unit are both less than the preset horizontal threshold.

[0053] The task scheduling master control unit will calculate the results. The values ​​are converted into motor pulse counts or encoder target values ​​and sent to the drivers of the four electric linear actuators via the CAN bus. The drivers then control the actuator movements.

[0054] To prevent open-loop control errors, this process is a closed-loop iterative process. That is, after the push rod action is completed, the system will execute S110 again to read the new data. and .

[0055] After the push rod action is completed, the task scheduling main control unit executes S110 and S120 again to determine whether the levelness meets the standard. If it does not meet the standard, the residual of this operation is used as the new target compensation height, and S130 and S140 are executed repeatedly. The upper limit of the extension speed of the four electric support push rods is 15mm / s. During the leveling process, the task scheduling main control unit compares the extension length of the four electric support push rods at a period of 100ms. If the difference in extension length between any two electric support push rods exceeds 5mm, the action is paused, and the action continues after the difference in extension length falls back to within 5mm. Optionally, when the installation points of the four electric support push rods do not form a rectangle, the task scheduling main control unit substitutes the actual coordinates of each installation point in the body coordinate system. The vertical height difference between each support point is obtained. During standby, the task scheduling main control unit compares the current encoder values ​​of the four electric support push rods at 10-minute intervals; if the change in any encoder value relative to the horizontal reference value exceeds 1 mm, S100 is re-executed.

[0056] For example, the preset horizontal threshold is set to If after the initial balancing, it is detected The system will then recalculate the fine-tuning amount based on this residual and execute it until the condition is met. and and If leveling fails, the task scheduling main control unit locks the protective hatch and reports a leveling failure alarm to the cloud management platform. Upon successful leveling, the task scheduling main control unit saves the current encoder values ​​of the four electric support push rods as horizontal reference values ​​and uses these horizontal reference values ​​as the comparison object for subsequent settlement monitoring.

[0057] In the S200, the task scheduling main control unit receives the task instructions sent from the cloud and parses the task instructions to obtain the UAV's identity and service configuration parameters.

[0058] When the hive is ready, it maintains a heartbeat connection with the cloud server via a 4G / 5G network, and then the operation process begins.

[0059] The task instruction is usually an encrypted data packet, which is decrypted and parsed by the task scheduling master unit.

[0060] Before parsing, the task instruction undergoes an integrity check. The task scheduling master control unit verifies the message verification field and timestamp of the task instruction. If the verification fails or the timestamp deviates from the local clock by more than 60 seconds, the task instruction is discarded and a retransmission is requested from the cloud management platform. If the verification passes, the task scheduling master control unit matches the UAV's identity with the locally stored service capability database. If the match is successful, the corresponding service configuration file is invoked and cached in local memory. If the match fails, the UAV's identity is reported to the cloud management platform, and the protective hatch remains locked. The task instruction is encrypted using a symmetric encryption algorithm. Its session key is negotiated and updated by the task scheduling master control unit and the cloud management platform at a preset period. If decryption fails, the task scheduling master control unit discards the task instruction and requests a retransmission. The task instruction also includes a task execution time limit. If the task scheduling master control unit fails to complete the return guidance within the execution time limit, it terminates the task, removes the task instruction from local memory, and reports the task timeout information.

[0061] For example, the received job task instruction is a data stream in JSON format: { "task_id":"T20231027-001", "uav_id":"UAV-Type-X-09", "mission_route":"Waypoints_File_A.kml", "service_profile":{ "charge_voltage": 24.5, "clamp_torque":15.0, "probe_offset":{"x":120,"y":0,"z":50} } } After parsing, the main control unit identified the UAV model, "UAV-Type-X-09," as the drone about to perform the mission and extracted its unique service configuration parameters. profile These parameters will be temporarily stored in local memory for service assurance in subsequent steps.

[0062] In the S300 mission scheduling and control unit, during the UAV's return phase, the multimodal recognition and docking subsystem is activated. Based on RTK differential positioning data and visual sensing data, the UAV is guided to land in the predetermined docking area.

[0063] S300 specifically includes the following sub-steps: S310, when the drone is located in the far field area of ​​the nest, broadcast RTK base station differential data to the drone via a wireless data link to guide the drone to a hovering point above the nest based on satellite positioning navigation.

[0064] The "far field area" is usually defined as the airspace where the horizontal distance from the nest is greater than 10 meters or the height is greater than 10 meters. At this stage, machine vision has difficulty capturing the target, so it mainly relies on RTK GPS.

[0065] The RTK base station module built into the nest observes satellite signals in real time, calculates its own positioning error correction (differential data), and transmits it to the drone in RTCM format via a data radio or 4G network. The drone combines its own GPS observations with this differential data to achieve centimeter-level global positioning and autonomously flies to a preset coordinate point directly above the nest (e.g., altitude). ).

[0066] It should be noted that the RTK base station module determines the quality of the differential data before broadcasting it, and only broadcasts the differential data to the UAV when the calculated number of visible satellites is not less than 12, the position accuracy factor is not greater than 2, and the differential data age is not greater than 2 seconds. If any of the above conditions are not met, the multimodal recognition and docking subsystem suspends broadcasting and sends a hovering wait command to the UAV. The UAV simultaneously transmits its position calculation status and remaining battery status back on the link receiving the differential data. The descent rate of the UAV in the far-field region is not greater than 2 m / s, and the descent rate after entering the near-field region is not greater than 0.5 m / s. When the remaining battery status is lower than the safe return battery level, the task scheduling master control unit suspends the current guidance and requests the cloud management platform to reissue the operation task command. The exposure time of the industrial camera is adaptively adjusted based on the ambient light. Under the condition that the drone's descent speed is no greater than 0.5 m / s, the motion blur of the visual tag in the image data does not exceed 2 pixels, and the upper limit of the exposure time is determined by this condition. The image processing algorithm's processing latency for a single frame image is no greater than 15 ms, and the end-to-end latency from image acquisition by the industrial camera to the issuance of the physical space correction vector is no greater than 50 ms. After installation, the industrial camera undergoes a center alignment calibration, and the installation deviation obtained from the calibration is... The installation deviation is the deviation between the image center and the center of the predetermined docking area, which is written into the non-volatile storage area of ​​the task scheduling master unit; the task scheduling master unit deducts the installation deviation when calculating the pixel deviation.

[0067] S320, when the drone reaches the hovering point, the visual sensor set in the predetermined docking area is activated to collect image data including the visual tag on the bottom of the drone.

[0068] When the drone reaches the hovering point (e.g., directly above the pod) (At the location), enter the "near field area"; at this time, although RTK has high accuracy, it may be affected by multipath interference near the metal structure of the nest, and cannot eliminate the installation error of the nest itself. Therefore, the system switches to vision guidance mode.

[0069] Subsequently, the task scheduling main control unit activates the industrial camera (a specific visual tag (such as AprilTag or ArUcoMarker) is pre-attached to the bottom of the drone), and the camera operates at a high frame rate (e.g., ...). Acquire image streams.

[0070] The switching condition between the far-field region and the near-field region is that the horizontal distance and relative height of the UAV relative to the nest are both less than 10m. The visual tag is a quadrilateral coded tag, and the coded bits inside the quadrilateral coded tag are used to identify the UAV. The tag identifier is obtained by decoding the image data. If the tag identifier is inconsistent with the UAV identifier obtained in S200, it is determined that the current guidance target is incorrect, the current landing guidance is stopped, and the industrial camera is put back into the search state.

[0071] S330 obtains the pixel deviation value of the visual label center relative to the center of the predetermined docking area based on image data, and converts the pixel deviation value into a physical space correction vector by combining the multi-source fusion altitude data of the UAV.

[0072] First, such as Figure 3 As shown, image processing algorithms are used to locate the corner points of visual labels in an image and calculate the coordinates of their center points. The coordinates of the image center (i.e., the landing target point) are known to be... Then the pixel deviation is .

[0073] In this embodiment, the image processing algorithm sequentially performs grayscale conversion, adaptive threshold binarization, edge detection, and quadrilateral contour fitting. Encoded bits are decoded within the fitted quadrilateral contour, and sub-pixel correction is performed on the pixel coordinates of the four corner points. The sub-pixel correction converges when the reprojection error between the coordinates of the four corner points and the fitted line is less than 0.5 pixels. The radial and tangential distortions of the industrial camera are corrected based on a pre-calibrated intrinsic parameter matrix and distortion coefficients. The equivalent focal length in the intrinsic parameter matrix is... and The pixel coordinate system of the image data has its origin at the top left corner of the image. The axis points to the right side of the image and The axis points downwards from the image; the platform coordinate system of the predetermined docking area has its origin at the center of the predetermined docking area. The axis points to the right side of the nest and The axis points to the front of the machine nest, and the task scheduling main control unit switches according to the installation orientation of the industrial camera. The symbol, then output. This ensures that the direction of the physical space correction vector is consistent with the coordinate system of the UAV flight control system.

[0074] To avoid guidance jitter caused by noise in a single frame image, the task scheduling master control unit only outputs the pixel deviation when the difference between the pixel deviations of three consecutive frames is less than 5 pixels. When the visual tag is occluded or fails to be decoded, the task scheduling master control unit extrapolates the current pixel deviation based on the pixel deviation of the previous frame, and sends a hovering command to the UAV when it fails to decode for 10 consecutive frames.

[0075] It should be noted that the weighting coefficients are determined based on the error characteristics of the two types of ranging data: the relative error of the second relative height data is determined by the corner positioning error of the visual tag and the calibration error of the equivalent focal length, and its value does not change with height; the absolute error of the first relative height data is determined by the ranging accuracy of the ultrasonic ranging module, and its value is 1% of the range, i.e., 50mm, which does not change with height. Comparing absolute errors, the absolute error of the second relative height data decreases as height decreases, and is always less than the absolute error of the first relative height data within the measurement range of the ultrasonic ranging module. Therefore, the task scheduling control unit increases the weight of the second relative height data as height decreases, and resets the weight of the first relative height data to zero when the height is less than 250mm.

[0076] For example, when the drone descends to When the pixel deviation is ,but The modulus value is no greater than 20mm, and the task scheduling master control unit determines that the UAV is directly above the predetermined docking area. If the near-field guidance time exceeds 60s from the start time and the vertical descent condition is not met, the task scheduling master control unit sends a go-around command to the UAV, and the UAV returns to the hovering point and re-executes S320; if the near-field guidance retry count reaches 3 and landing is still not completed, the task scheduling master control unit terminates the current landing guidance and reports the guidance failure information to the cloud management platform.

[0077] To ensure control accuracy, accurate altitude H must be obtained. This embodiment adopts a multi-source fusion strategy: (1) Obtain the first relative altitude data measured by the ultrasonic ranging module set at the bottom of the UAV. (2) Based on the known physical dimensions of visual labels in the image (e.g. Using the perspective n-point (PnP) algorithm or the principle of similar triangles, the second relative height data is calculated. (3) Normalize and weight the two data streams according to the validity criteria to generate the multi-source fusion height data. .

[0078] The nominal measurement range of the ultrasonic ranging module is 0.2m to 5m, and its ranging accuracy is 1% of the range, meaning the absolute error of the first relative height data is 50mm and does not change with height. The relative error of the second relative height data is jointly determined by the corner positioning error of the visual tag and the calibration error of the equivalent focal length, exemplarily 0.5%, and its absolute error is directly proportional to height. The second relative height data is inversely proportional to the square root of the imaging area of ​​the visual tag in the image data.

[0079] Before being fused, the first relative height data undergoes an effective range determination. The effective lower limit of the effective range determination is 250mm, which is obtained by superimposing the lower limit of the nominal measurement range (0.2m) with the absolute error (50mm). This lower limit is used to retain a measurement margin not less than the absolute error within the nominal measurement range. When the measured height is not less than 250mm and not greater than 5000mm, the first relative height data is determined to be valid, and its validity is indicated by... 1. When the measured height is less than 250mm, or when the ultrasonic ranging module returns an over-range status word, the first relative height data is determined to be invalid, and its validity flag is... The value is set to 0, and the invalid data is not written to the fusion queue.

[0080] The second relative height data undergoes an imaging validity determination before being incorporated into the fusion process. The second relative height data is deemed valid if the imaging area of ​​the visual tag in the image data is not less than 50 pixels × 50 pixels, and if the encoded bits of the visual tag are successfully decoded. Its validity flag is then displayed. Set to 1. If the visual label is obscured, the encoded bit fails to decode, or the imaging area is less than the aforementioned lower limit, the second relative height data is determined to be invalid, and its validity flag is set to 1. Take 0.

[0081] The multi-source fusion height data is generated by normalizing and weighting according to the validity flag, that is... The aforementioned With the When all are 1, the With the Values ​​are retrieved based on height partitioning. Take 0 and the said When the value is 1, the above expression degenerates into: The task scheduling master control unit marks the data source status as single-source visual ranging status. Take 1 and the said When the expression is 0, the above expression degenerates into: The task scheduling master control unit simultaneously sends a hovering command to the UAV until the visual tag is re-decoded. With the When all values ​​are 0, the task scheduling master control unit maintains the multi-source fused altitude data of the previous valid frame, and sends a go-around command to the UAV when 10 consecutive frames are invalid.

[0082] The With the The value is determined by comparing the absolute errors of the two data streams. When the height is greater than 2m and not greater than 5000mm, the value is taken as... , When the height is not less than 250mm and not more than 2m, take , When the height is less than 250mm, the following is stated: If the value is 0, the weighted fusion is solely composed of the second relative height data. The absolute error of the second relative height data decreases monotonically as altitude decreases, based on the fact that the absolute error of the first relative height data decreases as altitude decreases, while the absolute error of the first relative height data does not change with altitude.

[0083] Before fusion, the first relative height data and the second relative height data undergo a consistency comparison. The consistency comparison criterion is that the relative deviation between the two does not exceed 10%. When the relative deviation exceeds 10%, the task scheduling master control unit compares the confidence levels of the two data streams, outputs the multi-source fused height data based on the stream with higher confidence, and records the result of this comparison as a ranging anomaly event. The confidence level is determined by the absolute error of the two data streams, with the smaller absolute error indicating higher confidence. The height at which the absolute errors of the two data streams are equal is 50mm ÷ 0.5% = 10m. This height exceeds the 5000mm range limit of the ultrasonic ranging module. Therefore, within the effective range of the ultrasonic ranging module, the absolute error of the second relative height data is always less than the absolute error of the first relative height data, and the stream with higher confidence is the second relative height data.

[0084] The multi-source fused altitude data does not experience numerical jumps during the switch from two-way weighted ranging to the single-source visual ranging state. The task scheduling master control unit only allows the switch if the relative deviation is no greater than 10% in the three consecutive frames before the switch. The weighted value of the last frame before the switch is used as the reference value for the single-source visual ranging state. If the difference between the second relative altitude data and the reference value after the switch exceeds 20mm, the task scheduling master control unit determines that the ranging link is abnormal, re-executes the validity determination, and sends a hovering command to the UAV.

[0085] In the single-source visual ranging state, when the inter-frame variation of the multi-source fused height data is no greater than 5mm, and the change in the center coordinates of the visual tag in the image data is less than 3 pixels within 10 consecutive frames, the task scheduling main control unit guides the UAV to descend at a descent rate of no more than 0.1m / s until the multi-source fused height data is no greater than 100mm. The upper limit of the descent rate is determined based on the following: in the single-source visual ranging state, the sole source of the height data is the imaging area of ​​the visual tag. When the upper limit of the descent rate is 0.1m / s, the height variation between two adjacent frames (frame interval 33ms) is no greater than 3.3mm, which is greater than the resolution of the second relative height data at a height of 100mm.

[0086] The effective lower limit of 250mm is greater than the 100mm threshold of the multi-source fused altitude data in the landing determination condition. Therefore, the final stage of the landing determination must be in the single-source visual ranging state. The inter-frame variation constraint and the upper limit of the descent rate in the single-source visual ranging state are used to ensure that the altitude data in this final stage is still available, and the landing determination does not depend on the output of the ultrasonic ranging module below the effective lower limit.

[0087] For example, Because visual ranging is more accurate in the near field; assuming the fused height Camera focal length The pixel deviation calculated by the visual algorithm is , Then the physical space correction vector The calculation is as follows: The single output amplitude of the physical space correction vector is limited to within 200mm. When the magnitude of the calculated correction vector exceeds 200mm, the task scheduling main control unit scales the physical space correction vector proportionally, causing the UAV to gradually approach the predetermined docking area at a horizontal speed not exceeding 0.3m / s. When the magnitude of the physical space correction vector corresponding to the pixel deviation is not greater than 20mm, it is determined that the UAV is directly above the predetermined docking area and enters the vertical descent phase. The error of the multi-source fusion altitude data is jointly determined by the calibration error of the equivalent focal length and the corner point positioning error of the visual tag. When the calibration error is 1%, the relative error of the physical space correction vector is on the order of 1%.

[0088] S340 sends a physical space correction vector to the drone, guiding it to perform position correction and descend vertically.

[0089] The task scheduling master control unit will calculate the correction vector It is encapsulated as control commands and sent to the UAV flight control system via a low-latency data link.

[0090] The control commands include a command sequence number, a timestamp, a horizontal correction amount, and a vertical descent permission bit. The command sequence number increments with each issuance. The UAV flight control system discards control commands with a command sequence number less than the most recently executed command sequence number and executes a vertical descent maneuver when the vertical descent permission bit is valid. The control commands are issued at a frequency of 10Hz. Between two control commands, the UAV flight control system performs position correction according to the current command and reduces the horizontal position correction amount when the altitude drops below 0.5m until the UAV's landing gear contacts the takeoff and landing platform.

[0091] S400: After detecting the landing of the UAV, the task scheduling master control unit drives the software-defined service subsystem based on the service configuration parameters to perform physical fixation and energy replenishment operations for the UAV.

[0092] The landing determination conditions for the UAV are as follows: the center coordinates of the visual tag in the image data change by less than 3 pixels within 10 consecutive frames; the multi-source fusion height data is not greater than 100mm and the inter-frame change of the multi-source fusion height data is not greater than 5mm; and at least one of the four electric support push rods exhibits an impact component of not less than 30% of the rated current within 20ms, and the encoder feedback length of the same electric support push rod exhibits an elastic retraction of not less than 0.1mm. When the first relative height data is below its effective lower limit (which can be set to 250mm), the multi-source fusion height data is composed solely of the second relative height data. The upper limit of the descent rate in single-source visual ranging mode is 0.1m / s; therefore, the landing determination does not depend on the output of the ultrasonic ranging module in the blind zone.

[0093] The threshold for the impact component is determined as three times the amplitude of the phase current fluctuation of the electric support push rod during the steady-state section of the leveling operation, exemplarily 30% of the rated current. The threshold for the elastic retraction is determined according to the resolution of the absolute magnetic encoder, exemplarily 0.1 mm, equivalent to 1.4 count values ​​of the absolute magnetic encoder. The impact component and the elastic retraction are transmitted from the lifting platform to the electric support push rod via the load-bearing beam, and their detection is not constrained by the timing of the adaptive clamping mechanism and the three-axis servo manipulator.

[0094] The closing action of the adaptive gripping mechanism and the extension action of the three-axis servo manipulator are both initiated after the landing confirmation signal is output. The gripper remains open before the landing confirmation signal is output. After the landing confirmation signal is output, the task scheduling master control unit sequentially executes the gripping and fixing action S420, the landing deviation correction action S430, and the probe extension action S431. The landing determination is executed at a period of 20ms. When the above three determination conditions are met three times consecutively, the task scheduling master control unit outputs a landing confirmation signal; when any of the above determination conditions are not met in three consecutive determinations, the task scheduling master control unit continues to acquire the multi-source fusion height data and track the visual tag.

[0095] Specifically, it includes the following sub-steps: The S410, based on the drone's identity, retrieves the corresponding service configuration file from the locally stored service capability database. The service configuration file contains the spatial coordinate parameters of the charging interface, the charging voltage parameters, and the clamping torque parameters.

[0096] In the aforementioned steps, the system has already obtained the service. profile The parameters called at this time are as follows: Charging interface coordinate parameters: charge_pos_x=120.0mm, charge_pos_y=0.0mm, charge_pos_z=50.0mm.

[0097] Charging voltage parameter: voltage=24.5V.

[0098] Clamping torque parameter: torque = 15.0 N·m.

[0099] The service capability database uses the UAV's identity identifier as the primary key. Each record includes the UAV model name, spatial coordinate parameters of the charging contacts, charging voltage parameters, clamping torque parameters, probe model, and configuration file version number. The service configuration file carries a version number and a verification field. When the task scheduling main control unit calls the service configuration file, it verifies the verification field. Only after the verification is successful will the parameters recorded in the service configuration file be written into the three-axis servo manipulator, the adaptive clamping mechanism, and the power management module, respectively.

[0100] In this embodiment, the records in the service capability database are updated through incremental configuration files issued by the cloud management platform. The incremental configuration file carries a version number and a verification field. After receiving the incremental configuration file, the task scheduling master control unit verifies whether its version number is higher than the version number of the local record and whether its verification field matches. If both conditions are met, the incremental configuration file is written into the service capability database and the version number of the local record is updated. If either condition is not met, the incremental configuration file is discarded and the original record in the service capability database is retained.

[0101] S420, based on the clamping torque parameters, drives the clamping mechanism to apply a fixing force to the landing gear of the UAV.

[0102] The clamping mechanism inside the drone (such as a lead screw and slider driven by a motor) starts to move and controls the upper limit of the motor current to ensure that the torque applied to the drone landing gear does not exceed the set 15.0 N·m.

[0103] In this embodiment, the closing process of the adaptive clamping mechanism is divided into a rapid approach phase and a torque application phase. The motor speed in the rapid approach phase is the rated speed, and the motor speed in the torque application phase is reduced to 20% of the rated speed. The task scheduling main control unit collects the motor current at a frequency of 1kHz in the torque application phase, estimates the real-time clamping torque based on the motor current, and stops increasing the current and maintains the current value when the real-time clamping torque reaches 90% of the clamping torque parameter until a release command is received.

[0104] The relationship between the real-time clamping torque and the motor current is as follows: ,in The torque constant of the motor is... This is the motor current. The reduction ratio of the lead screw and slider mechanism is given. For transmission efficiency; for example, , , Then the clamping torque parameter is The corresponding motor current is The task scheduling master control unit uses the motor current as the upper limit value of the current limit.

[0105] S430: Based on the image data, confirm the landing deviation vector between the actual landing position of the UAV and the center of the predetermined docking area, and use the landing deviation vector to correct the spatial coordinate parameters of the charging interface.

[0106] To prevent the robotic arm from colliding due to landing errors, the system performs a secondary check.

[0107] After landing, the visual sensor photographed the drone tag again and calculated the residual deviation. ; Assumption The corrected target coordinates for the charging interface are: .

[0108] .

[0109] It should be noted that when the magnitude of the landing deviation vector exceeds 10mm, the task scheduling master control unit prohibits the initiation of the charging process, reports the landing deviation exceeding the limit information to the cloud management platform, and awaits manual handling instructions. The three-axis servo manipulator only receives the coordinate and contact instructions after the adaptive gripping mechanism outputs the gripper closure signal; the release instruction of the adaptive gripping mechanism is only issued after the charging process ends or after receiving a manual handling instruction. The total duration of the service operation from the determination of drone landing to the end of the charging process is no more than 120s, wherein the fixing action of the adaptive gripping mechanism is no more than 10s, and the positioning and contact action of the three-axis servo manipulator is no more than 30s; when the total duration of the service operation exceeds 120s, the task scheduling master control unit terminates the current service operation and reports service timeout information.

[0110] S431, based on the corrected spatial coordinate parameters, drives the three-axis servo manipulator to move the charging probe to the position of the drone's charging contact.

[0111] The three-axis servo robot arm operates according to the corrected coordinates. Plan the motion path to ensure the probe is accurately aligned with the charging contacts.

[0112] In this embodiment, the X-axis and Y-axis of the three-axis servo manipulator are respectively driven by ball screws via servo motors, and the repeatability of the X-axis and Y-axis is [missing information]. The task scheduling master control unit converts the corrected coordinates into the target pulse count for the X-axis and Y-axis, and then issues coordinate commands. After the X-axis and Y-axis reach the target position, the task scheduling master control unit issues a contact command, and the Z-axis drives the charging probe to extend at a speed of 2 mm / s. A contact sensor is provided on the mounting base of the charging probe. When the pressure signal detected by the contact sensor reaches 5N, the task scheduling master control unit determines that the charging probe has contacted the UAV charging contact, controls the Z-axis to retract 0.5mm and maintain this position, so that the contact pressure between the charging probe and the charging contact is maintained near the threshold of the aforementioned pressure signal during the charging process.

[0113] S440: Configure the output voltage of the power management module according to the charging voltage parameters, and start the charging process after the charging probe contacts the charging contact.

[0114] After the probe makes physical contact and confirms a good connection, the task scheduling main control unit configures the programmable power module through the communication protocol, sets its output voltage to 24.5V, and starts charging.

[0115] In this embodiment, before initiating the charging process, the task scheduling master control unit determines the connection status by measuring the contact resistance between the charging probe and the charging contact. The contact resistance is not greater than [value missing]. A good connection is determined at this time. The charging process includes a constant current charging stage and a constant voltage charging stage. The current in the constant current charging stage is 0.2 times the rated capacity of the drone battery, and the output voltage in the constant voltage charging stage is the charging voltage parameter. When the charging current drops to 10% of the current in the constant current charging stage, charging is determined to be complete and output stops. During charging, the task scheduling main control unit collects the temperature and charging current at the charging probe at a frequency of 1Hz. When the temperature exceeds... When the charging current exceeds 1.2 times the constant current charging stage current, charging is stopped, the charging probe is returned to its initial position, and a charging anomaly is reported. After charging is completed, the task scheduling main control unit releases the adaptive clamping mechanism from the landing gear, controls the three-axis servo manipulator to return to its initial position, closes the protective hatch, and the hull returns to standby mode.

[0116] Example 3 To further improve the system's robustness, this embodiment also includes an environmental monitoring and alarm mechanism. Specifically, before S100 or throughout the standby period, the anemometer and rain gauge outside the nest continuously operate. The anemometer's sampling period is 1 second, and the task scheduling control unit takes a moving average of three consecutive sample values ​​to obtain the wind speed data. The rain gauge's pulse count is converted into rainfall data based on a cumulative duration of 10 minutes.

[0117] For example, a safe wind speed threshold is set. (Equivalent to a Force 5 wind), safe rainfall threshold (i.e., no rain).

[0118] If the current wind speed is monitored in real time Exceeded At this point, the main control unit will determine that the environment is not suitable for takeoff and landing, lock the hull in "protection mode", strictly prohibit the opening of the hatch, and send a "strong wind warning, mission suspended" status code to the cloud via the network to prevent damage to the precision equipment caused by severe weather.

[0119] It should be noted that the wind speed data and the rainfall data are considered in parallel. If either data fails to meet its corresponding safety threshold, the task scheduling control unit determines that the environment is unsuitable for takeoff and landing. For example, if the rain gauge outputs 25 pulses cumulatively within 10 minutes, the calculated rainfall data is... If the rainfall exceeds the safe rainfall threshold, the task scheduling master control unit will put the nest into protection mode and report the status code "rainfall alarm, task suspended".

[0120] In this embodiment, the protection mode is deactivated when both the wind speed data and the rainfall data meet their respective safety thresholds for 30 consecutive seconds. After deactivation, the task scheduling master control unit re-executes the site status assessment and adaptive leveling of S100, and then resumes the operation process. In the protection mode, if a UAV has already landed on the take-off and landing platform, the task scheduling master control unit maintains the fixing force of the adaptive clamping mechanism on the UAV, keeping it in its current charging state and rejecting take-off commands from the cloud management platform until the protection mode is deactivated. The environmental anomaly alarm information includes the current wind speed data, rainfall data, nest identifier, and the nest's operating status. The cloud management platform marks this operation task as suspended based on the environmental anomaly alarm information.

[0121] Example 4 The difference from Embodiment 2 is that the ground bearing condition described in this embodiment includes the foundation bearing characteristics and settlement trend below each support point.

[0122] During the execution of S140, the task scheduling master control unit synchronously acquires the phase current sampling value and encoder feedback length of the electric support push rod at a frequency of 1kHz, and pairs the phase current sampling value and encoder feedback length according to the same timestamp to obtain the first... The extension sequence of the electric support push rod With phase current sequence ,in The values ​​are 1 to 4. The phase current sampling value is output by the driver of the electric support push rod, and the encoder feedback length is output by the absolute magnetic encoder at the tail of the electric support push rod.

[0123] The task scheduling master control unit extracts a steady-state segment from the extension sequence. The criteria for determining the steady-state segment are that the rate of change of the phase current sampling value is less than 5%, and the extension speed of the electric support push rod is not greater than 1 mm / s. Within the steady-state segment, the task scheduling master control unit... Calculate the first Based on the load-bearing stiffness index of the aforementioned electric support push rod .in and These are the start and end times of the steady-state segment, respectively. The dimension is A / mm.

[0124] The task scheduling main control unit reads the baseline stiffness index recorded under factory conditions. , and according to Calculate the first Normalized stiffness ratio of each support point The aforementioned benchmark stiffness index The result is calculated from the steady-state segment during the initial leveling of the nest and written into the non-volatile storage area of ​​the task scheduling master control unit.

[0125] During standby, the task scheduling master control unit compares the current encoder values ​​of the four electric support push rods with the horizontal reference value at 10-minute intervals. For support points with a deviation exceeding 0.5mm, the task scheduling master control unit... Calculate the settlement rate of this support point. The change in the current encoder value relative to the horizontal reference value. The time interval between two adjacent comparisons. The task scheduling master control unit is configured according to... Calculate normalized settling rate .

[0126] The task scheduling master control unit uses the normalized settlement rate and the settlement rate threshold as the basis. Three levels of settlement warnings are output. A Level 1 warning is output when the normalized settlement rate is not greater than the settlement rate threshold, and the action for a Level 1 warning is to maintain the current monitoring cycle. A Level 2 warning is output when the normalized settlement rate is greater than the settlement rate threshold but not more than twice the settlement rate threshold, and the action for a Level 2 warning is to shorten the monitoring cycle from 10 minutes to 1 minute and re-execute S100. A Level 3 warning is output when the normalized settlement rate is greater than twice the settlement rate threshold, and the action for a Level 3 warning is to lock the protective hatch, reject work task instructions issued by the cloud management platform, and report the support point number and the normalized settlement rate to the cloud management platform.

[0127] When the task scheduling master control unit outputs a level-three early warning, it adjusts the target compensation height corresponding to the support point according to... Correction, among which The corrected target compensation height is used for the next leveling action after a preset monitoring duration.

[0128] The settlement rate threshold is determined based on the maximum allowable tilt rate of the landing platform. For example, the maximum allowable tilt rate of the landing platform is... If the horizontal distance between adjacent support points is 800mm, then the change rate of the support point height difference calculated from the maximum tilt angular rate is... Take half of the rate of change of the height difference between the support points as the settlement rate threshold, and obtain... .

[0129] For example, the reference stiffness index The task scheduling master control unit calculates the second support point during a certain leveling operation. ,but If the task scheduling main control unit detects that the encoder value of the support point has changed by 1.2 mm relative to the horizontal reference value during the 6-hour standby period, then... , If the normalized settlement rate is greater than twice the settlement rate threshold, the task scheduling main control unit outputs a level three warning, locks the protective hatch, and connects the second support point to... Report to the cloud management platform.

[0130] Optionally, the alternative method for obtaining the phase current sampling value is the PWM duty cycle output by the position-type PID control of the electric support push rod. The PWM duty cycle is proportional to the phase current sampling value. When the driver of the electric support push rod does not provide phase current output, the task scheduling main control unit calculates the bearing stiffness index according to the ratio of the PWM duty cycle to the extension amount.

[0131] Optionally, the normalized stiffness ratio can be obtained by using the convergence ratio of the leveling residual. The task scheduling master control unit records the ratio of the absolute values ​​of the roll angle and the pitch angle before and after each fine-tuning action, and takes the arithmetic mean of three consecutive ratios as the alternative value of the normalized stiffness ratio.

[0132] Example 5 The difference from Embodiment 2 is that, in this embodiment, the task scheduling master control unit, during the execution of S330, processes the first relative height data according to the same acquisition time identifier. Compared with the second relative height data Pair, and press Calculate height deviation The task scheduling master control unit caches the most recent... The height deviation of a successfully paired frame The value is 30; the pairing is performed only when the validity flag v1 of the first relative height data is 1; the time period when v1 is 0 is not included in the N-frame buffer, and the disturbance index maintains the previous valid value.

[0133] The task scheduling main control unit according to Calculate the standard deviation of the height deviation. ,in for The arithmetic mean of the height deviations described in the frame. For the first The height deviation of the frame. The task scheduling master control unit statistics. The number of times the signs of two adjacent frames are opposite in the height deviation described in the frame. , and according to Calculate the zero-crossing rate .

[0134] The task scheduling main control unit according to Calculate disturbance index ,in The zero-crossing rate weight is used. The disturbance index is used to characterize the disturbance intensity of the UAV rotor downwash airflow on the ultrasonic ranging module.

[0135] The task scheduling master control unit outputs three levels of disturbance based on the disturbance index. A normal level is output when the disturbance index is less than 0.08. A medium level is output when the disturbance index is not less than 0.08 and less than 0.15. A strong disturbance level is output when the disturbance index is not less than 0.15.

[0136] The task scheduling master control unit adjusts the upper limit of the descent rate of the control command in S340 according to the disturbance level. Under the normal level, the upper limit of the descent rate is taken as... The upper limit of the descent rate under the medium level is taken as The upper limit of the descent rate under the strong disturbance level is taken as The task scheduling master control unit adds a landing confirmation condition to S400 under the strong disturbance level. In addition to the original judgment conditions of S400, the task scheduling master control unit also requires that the disturbance level drop back to the medium level or the normal level before it can output a landing confirmation signal; when the disturbance level remains at the strong disturbance level, the task scheduling master control unit maintains the acquisition of multi-source fused altitude data and maintains the output of hovering hold command.

[0137] The task scheduling master control unit distinguishes the source of disturbance based on the sign of the altitude deviation. When the first relative altitude data is less than the second relative altitude data, the task scheduling master control unit marks this pairing as a thermal airflow disturbance. When the first relative altitude data is greater than the second relative altitude data, it is marked as a backflow disturbance. The task scheduling master control unit calculates the proportion of the thermal airflow disturbance and the backflow disturbance at a frequency of 1Hz.

[0138] The task scheduling master control unit counts the number of consecutive tasks within the same nest. The number of times the strong disturbance level is output during the second return-to-base guidance. Take 10. When the number of occurrences is not less than 5, the task scheduling master control unit sends an aerodynamic environment review prompt to the cloud management platform. The aerodynamic environment review prompt includes the nest identifier, the average value of the disturbance index, and the disturbance source with the highest proportion.

[0139] The zero-crossing rate weight is chosen so that the standard deviation term and the zero-crossing rate term are of the same order of magnitude in the disturbance index. The threshold value of the standard deviation term is based on the sum of two errors: the ranging accuracy of the ultrasonic ranging module and the calculation error of the second relative height data. For example, the ranging accuracy of the ultrasonic ranging module is 1% of its range, the relative error of the second relative height data is 0.5%, and the combined relative error is 1.1%. Taking twice the combined relative error as the threshold of the standard deviation term yields... The threshold is 0.02, and the zero-crossing rate threshold is 0.12. The two are calculated according to... The threshold of the disturbance index is obtained after weighting. .

[0140] For example, the drone in The task scheduling master control unit calculates the result from 30 frames of paired data when hovering at the location. ,but The number of times the symbols are opposite between two adjacent frames. ,but .according to Calculated If the value is greater than 0.15, the task scheduling master control unit outputs the strong disturbance level and adjusts the upper limit of the descent rate from... Revised to The upper limit of the descent rate will be further modified to 0.1 m / s, while the threshold of 100 mm for the multi-source fusion height data will remain unchanged.

[0141] Optionally, when the first relative height data is unavailable, the task scheduling master control unit replaces the standard deviation term with the inter-frame volatility of the imaging area of ​​the image data based on the visual label. The inter-frame volatility is based on... Calculation, where For the first The imaging area of ​​the frame, for The arithmetic mean of the imaging area of ​​the frame.

[0142] Through the above description of the embodiments, those skilled in the art can clearly understand that the methods according to the above embodiments can be implemented by means of software plus necessary general-purpose hardware platforms. Of course, they can also be implemented by hardware, but in many cases the former is a better implementation method. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, can be embodied in the form of a software product. This computer software product is stored in a storage medium (such as ROM / RAM, magnetic disk, optical disk) and includes several instructions to cause a terminal device (which may be a mobile phone, computer, server, or network device, etc.) to execute the methods described in the various embodiments of the present invention.

[0143] It should be noted that the above modules can be implemented by software or hardware. For the latter, they can be implemented in the following ways, but are not limited to: all the above modules are located in the same processor; or, the above modules are located in different processors in any combination.

[0144] Embodiments of the present invention also provide a computer-readable storage medium storing a computer program, wherein the computer program is configured to perform the steps in any of the above method embodiments when executed.

[0145] In one exemplary embodiment, the aforementioned computer-readable storage medium may include, but is not limited to, various media capable of storing computer programs, such as a USB flash drive, read-only memory (ROM), random access memory (RAM), portable hard disk, magnetic disk, or optical disk.

[0146] Embodiments of the present invention also provide an electronic device including a memory and a processor, the memory storing a computer program and the processor being configured to run the computer program to perform the steps in any of the above method embodiments.

[0147] In one exemplary embodiment, the electronic device may further include a transmission device and an input / output device, wherein the transmission device is connected to the processor and the input / output device is connected to the processor.

[0148] Through the above description of the embodiments, those skilled in the art can clearly understand that, for the sake of convenience and brevity, only the division of the above functional modules is used as an example. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device can be divided into different functional modules to complete all or part of the functions described above.

[0149] In the several embodiments provided in this application, it should be understood that the disclosed apparatus and methods can be implemented in other ways. For example, the apparatus embodiments described above are merely illustrative; for instance, the division of modules or units is only a logical functional division, and in actual implementation, there may be other division methods. For example, multiple units or components may be combined or integrated into another apparatus, or some features may be ignored or not executed. Furthermore, the mutual coupling or direct coupling or communication connection shown or discussed may be through some interfaces; the indirect coupling or communication connection between apparatuses or units may be electrical, mechanical, or other forms.

[0150] The units described as separate components may or may not be physically separate. A component shown as a unit can be one or more physical units; that is, it can be located in one place or distributed in multiple different locations. Some or all of the units can be selected to achieve the purpose of this embodiment according to actual needs.

[0151] Furthermore, the functional units in the various embodiments of this application can be integrated into one processing unit, or each unit can exist physically separately, or two or more units can be integrated into one unit. The integrated unit can be implemented in hardware or as a software functional unit.

[0152] If the integrated unit is implemented as a software functional unit and sold or used as an independent product, it can be stored in a readable storage medium. Based on this understanding, the technical solutions of the embodiments of this application, in essence, or the parts that contribute to the prior art, or all or part of the technical solutions, can be embodied in the form of a software product. This software product is stored in a storage medium and includes several instructions to cause a device (which may be a microcontroller, chip, etc.) or processor to execute all or part of the steps of the methods of the various embodiments of this application. The aforementioned storage medium includes various media capable of storing program code, such as USB flash drives, portable hard drives, read-only memory (ROM), random access memory (RAM), magnetic disks, or optical disks.

[0153] The above description is merely a specific embodiment of this application, but the scope of protection of this application is not limited thereto. Any changes or substitutions within the technical scope disclosed in this application should be included within the scope of protection of this application. Therefore, the scope of protection of this application should be determined by the scope of the claims.

Claims

1. A method for controlling the takeoff and landing nest of an unmanned aerial vehicle (UAV), characterized in that, The UAV takeoff and landing site includes an intelligent site adaptive subsystem, a multimodal recognition and docking subsystem, a software-defined service subsystem, and a task scheduling control unit; the method includes: After the UAV take-off and landing nest is powered on, the task scheduling master control unit triggers the intelligent site adaptive subsystem to perform site status assessment and adaptive leveling. The task scheduling main control unit receives the task instructions sent from the cloud and parses the task instructions to obtain the drone's identity and service configuration parameters; During the UAV's return phase, the task scheduling master control unit activates the multimodal recognition and docking subsystem, and guides the UAV to land in the predetermined docking area based on RTK differential positioning data and visual sensing data. After detecting the landing of the UAV, the task scheduling master control unit drives the software-defined service subsystem based on the service configuration parameters to perform physical anchoring and energy replenishment operations for the UAV.

2. The method of claim 1, wherein, The triggering of the intelligent station adaptive subsystem to perform station status assessment and adaptive leveling includes: The current roll angle and pitch angle data are collected by an inertial measurement unit located on the base of the nest; Based on the roll angle data, the pitch angle data, and the geometric dimensions of the nest, the vertical height difference between the four support points of the nest's base is obtained; Using the point with the highest vertical height among the four support points as a reference, obtain the target compensation height of the other three support points relative to the reference point; Based on the target compensation height, a drive command is generated to control the corresponding electric support push rod to extend until the roll angle and pitch angle data collected by the inertial measurement unit are both less than the preset horizontal threshold.

3. The method of claim 1, wherein, The process of guiding the UAV to land in the predetermined docking area based on RTK differential positioning data and visual sensing data includes: When the drone is located in the far field area of ​​the nest, RTK base station differential data is broadcast to the drone via a wireless data link to guide the drone to a hovering point above the nest based on satellite positioning and navigation; When the drone reaches the hovering point, the visual sensor set in the predetermined docking area is activated to collect image data including the visual tag on the bottom of the drone. Based on the image data, the pixel deviation value of the visual label center relative to the center of the predetermined docking area is obtained, and combined with the multi-source fusion altitude data of the UAV, the pixel deviation value is converted into a physical space correction vector. The physical space correction vector is sent to the UAV to guide it to perform position correction and descend vertically.

4. The method of claim 3, wherein, Obtaining multi-source fusion height data specifically includes: Acquire the first relative altitude data measured by the UAV through the ultrasonic ranging module; Based on the size characteristics of the visual labels in the image data, the second relative height data is obtained; The first relative height data and the second relative height data are weighted and fused to generate the multi-source fused height data.

5. The method of claim 4, wherein, The process of driving the software-defined service subsystem based on the service configuration parameters to perform physical anchoring and energy replenishment operations for the UAV includes: Based on the drone's identity, the corresponding service configuration file is retrieved from the locally pre-stored service capability database. The service configuration file includes the spatial coordinate parameters of the charging interface, the charging voltage parameters, and the clamping torque parameters. Based on the clamping torque parameters, the clamping mechanism is driven to apply a fixing force to the landing gear of the UAV; Based on the image data, the landing deviation vector between the actual landing position of the UAV and the center of the predetermined docking area is confirmed again, and the spatial coordinate parameters of the charging interface are corrected using the landing deviation vector. Based on the corrected spatial coordinate parameters, drive the three-axis servo manipulator to move the charging probe to the position of the drone's charging contact point; Based on the charging voltage parameters, configure the output voltage of the power management module, and start the charging process after the charging probe contacts the charging contact.

6. The method of claim 1, wherein, Before triggering the intelligent station adaptive subsystem to perform station state assessment and adaptive leveling, the method further includes: The current wind speed and rainfall data are collected by meteorological sensors installed outside the nest; Determine whether the wind speed data is less than a preset safe wind speed threshold, and whether the rainfall data is less than a preset safe rainfall threshold; If the judgment result is negative, the task scheduling master control unit locks the hatch of the nest and sends an environmental anomaly alarm message to the cloud management platform.

7. An unmanned aerial vehicle landing pad, comprising: include: Airframe structure, the airframe structure including an openable protective hatch and a landing platform; The intelligent station adaptive subsystem includes an inertial measurement unit, a meteorological sensor, and four independently controlled electrically operated support push rods, used to monitor environmental conditions and adjust the horizontal attitude of the take-off and landing platform; The multimodal recognition and docking subsystem, which includes an RTK base station module, an industrial camera, and a wireless communication module, is used to provide phased positioning and guidance data during the UAV's return journey. The software-defined service subsystem, which includes a three-axis servo manipulator, a replaceable charging probe, and a gripping mechanism, is used to perform physical operations according to the service configuration file. The task scheduling master control unit is communicatively connected to the intelligent station adaptive subsystem, the multimodal recognition and docking subsystem, and the software-defined service subsystem, and is used to execute the method as described in any one of claims 1 to 6.

8. The drone landing pad of claim 7, wherein, The three-axis servo manipulator is configured as follows: Based on the received coordinate instructions, the horizontal position of the charging probe is moved in the X and Y axis directions; Based on the received contact command, the charging probe is driven to extend in the Z-axis direction until the contact sensor detects a pressure signal.

9. A computer-readable storage medium, characterized in that, The computer-readable storage medium stores a computer program, wherein the computer program is configured to perform the method described in any one of claims 1 to 6 when executed. 10.An electronic device comprising a memory and a processor, the electronic device characterized by, The memory stores a computer program, and the processor is configured to run the computer program to perform the method as described in any one of claims 1 to 6.