Method and device for changing battery of unmanned aerial vehicle hangar and electronic equipment
Through the combined sensor method, high-precision grabbing and placement of the drone battery box is achieved, solving the problem of traditional low battery swap efficiency and improving the operating capability and battery swap success rate of the drone.
Patent Information
- Application Number
- CN202411775638.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-12-05
- Publication Date
- 2025-01-03
AI Technical Summary
The storage method of traditional drones occupies a large amount of ground space, and due to the deviation of landing position and mechanical action errors, the success rate of battery replacement is low, reducing the operational ability of the drone.
Using a method of combining the first sensor and the second sensor, the relative position of the gripper and the drone battery box is adjusted through the robotic arm to achieve high-precision grab and placement, reduce manual intervention and improve battery swap efficiency.
It realizes efficient automatic battery swap of the drone, improves operating capabilities, reduces battery damage rate and manual intervention, and improves battery swap success rate.
Smart Images

Figure CN119240037A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of drone technology, and more specifically, to a method, device and electronic equipment for replacing power in a drone hangar. Background Art
[0002] With the rapid development of drone technology, drones are increasingly used in civil, commercial and important fields. The battery box of a drone is a very critical component on the drone body, which carries the battery components that provide power during flight. The storage method of traditional drones takes up a lot of ground space. When the battery components need to be replaced and maintained, the battery replacement gripper is generally controlled electrically. However, due to the deviation of the landing position of the drone and the error of mechanical movement, the success rate of battery replacement is low, resulting in low battery replacement efficiency of the drone and reduced drone operation capacity.
[0003] Therefore, how to provide a technical solution for an efficient and high-precision method of replacing batteries in a drone hangar has become a technical problem that needs to be solved urgently. Summary of the invention
[0004] The purpose of some embodiments of the present application is to provide a method, device and electronic device for replacing the battery in a drone hangar. Through the technical solution of the embodiments of the present application, efficient automatic battery replacement of the drone can be achieved, reducing manual intervention and improving the operation capability of the drone. Specifically, on the basis of the initial positioning of the battery replacement gripper by the first sensor, the second sensor is further used to accurately adjust the position, thereby realizing accurate battery replacement of drone batteries based on the hangar.
[0005] In a first aspect, some embodiments of the present application provide a method for replacing batteries in a drone hangar, including: based on first data collected by a first sensor, adjusting the relative position between a gripper connected to a robotic arm and a drone battery box, and controlling the robotic arm arranged in the hangar to reach a first position; based on the first position and second data collected by a second sensor, further adjusting the relative posture between the gripper and the drone battery box, and controlling the robotic arm to reach a second position; controlling the gripper to grab the drone battery box at the second position, wherein the drone battery box contains a drone battery.
[0006] In some embodiments of the present application, after controlling a robotic arm to move to a first position through first data collected by a first sensor, the robotic arm is controlled to reach a second position through second data collected by a second sensor. At this time, a gripper connected to the robotic arm can be controlled to accurately grasp the battery box of the drone, thereby realizing efficient automatic battery replacement of the drone, reducing manual intervention, and improving the operating capability of the drone.
[0007] In some embodiments, the method further includes: after grabbing the drone battery, controlling the robotic arm to place the drone battery in a built-in battery compartment in the hangar; wherein the charging module of the battery compartment is used to charge the placed drone battery.
[0008] Some embodiments of the present application can realize automatic charging of the battery by placing the captured drone battery into the battery compartment.
[0009] In some embodiments, the method further includes: recording and storing the second position, grabbing a battery that meets preset conditions in the hangar; and controlling the robotic arm to install the grabbed battery with preset conditions in the drone body based on the second position.
[0010] Some embodiments of the present application realize automatic battery replacement for the drone by grabbing a preset condition battery and controlling a robotic arm to place the battery into the drone based on a second position.
[0011] In some embodiments, the first sensor is a visual sensor; the second sensor includes a plurality of distance measuring sensors, and the plurality of distance measuring sensors are arranged at different positions of the gripper.
[0012] Some embodiments of the present application provide data support for accurate grasping of the drone battery box by setting different types of sensors to collect relevant data.
[0013] In some embodiments, before adjusting the relative position between the gripper connected to the robotic arm and the battery box of the drone based on the first data collected by the first sensor, the method further includes: collecting feature points of the battery box of the drone through the visual sensor; converting the feature points into coordinate information to obtain a calibrated position of the battery box.
[0014] Some embodiments of the present application calibrate the position of the drone battery box to obtain the calibrated position of the battery box, thereby providing accurate reference data for subsequent actual capture of the drone battery box.
[0015] In some embodiments, the method further includes: based on the calibrated position of the battery box, when the gripper is controlled to be located at a preset position of the drone battery box, determining the calibration data of the gripper and the drone battery box, wherein the calibration data includes first calibration data and second calibration data.
[0016] In some embodiments, adjusting the angle between the gripper and the drone battery box based on data collected from the side of the gripper includes: obtaining angle data collected by a sensor on one side of the gripper; comparing the angle data with side calibration data to determine a rotation angle; controlling the robotic arm to rotate according to the rotation angle to adjust the angle of the gripper.
[0017] In some embodiments of the present application, the gripper and the drone battery box are in different preset positions, so that calibration data at different positions can be obtained, based on which the movement of the robotic arm can be controlled subsequently so that the gripper can accurately grasp the drone battery box.
[0018] In some embodiments, based on the first data collected by the first sensor, the relative position between the gripper connected to the robotic arm and the battery box of the drone is adjusted to control the robotic arm arranged in the hangar to reach the first position, including: obtaining the current position of the battery box of the drone collected by the visual sensor; generating a planned path based on the deviation data between the current position and the battery calibration position; and controlling the robotic arm to move according to the planned path to reach the first position.
[0019] Some embodiments of the present application generate a planned path for the robotic arm by comparing the current position of the drone battery box with the calibrated battery position to obtain deviation data, thereby achieving precise control of the robotic arm and laying the foundation for subsequent precise grasping of the drone battery box.
[0020] In some embodiments, the obtaining of the current position of the drone battery box collected by the visual sensor includes: using the clamping hole on the drone battery box as a feature point, using a visual camera to collect the feature point position; converting the feature point position into the current position of the drone battery box. Optionally or alternatively, a feature object with a clear mark on the drone battery box can be used as a feature point, or the edge point of the battery shell can be used as a feature point, such as the four corner points of the edge of the battery shell.
[0021] Some embodiments of the present application use the clamping hole as a feature point to accurately obtain the current position of the drone battery box.
[0022] In some embodiments, the relative position between the gripper and the drone battery box is further adjusted based on the first position and the second data collected by the second sensor, including: adjusting the relative height between the gripper and the drone battery box based on the first orientation data collected by the ranging sensor and the first calibration data; adjusting the relative angle between the gripper and the drone battery box based on the second orientation data collected by the ranging sensor and the second calibration data.
[0023] Some embodiments of the present application adjust the relative height and relative angle of the gripper and the drone battery box respectively through the first orientation data, the second orientation data, and the calibration data, so as to accurately grasp the drone battery box.
[0024] In some embodiments, adjusting the relative height between the gripper and the battery box of the drone based on the first orientation data collected by the ranging sensor includes: comparing the first orientation data with the first calibration data to determine height data; and adjusting the relative height between the gripper and the battery box of the drone according to the height data.
[0025] Some embodiments of the present application obtain height data by comparing the first orientation data with the first calibration data to adjust the relative height between the gripper and the drone battery box to ensure that the gripper is in the correct gripping position.
[0026] In some embodiments, adjusting the relative angle between the gripper and the battery box of the drone based on the second orientation data collected by the ranging sensor includes: comparing the second orientation data with the second calibration data to determine angle data; and adjusting the relative angle between the gripper and the battery box of the drone according to the angle data.
[0027] Some embodiments of the present application compare the second orientation data with the second calibration data to obtain angle data to adjust the relative angle between the gripper and the drone battery box to ensure that the gripper is in the correct gripping position.
[0028] In a second aspect, some embodiments of the present application provide a device for replacing batteries in a drone hangar, including: a first control module, used to adjust the relative position between a gripper connected to a robotic arm and a drone battery box based on first data collected by a first sensor, and control the robotic arm arranged in the hangar to reach a first position; a second control module, used to further adjust the relative posture between the gripper and the drone battery box based on the first position and second data collected by a second sensor, and control the robotic arm to reach a second position; a grasping module, used to control the gripper to grasp the drone battery box at the second position, and the drone battery box contains a drone battery.
[0029] In a third aspect, some embodiments of the present application provide a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, can implement the method described in any embodiment of the first aspect.
[0030] In a fourth aspect, some embodiments of the present application provide an electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor can implement a method as described in any embodiment of the first aspect when executing the program.
[0031] In a fifth aspect, some embodiments of the present application provide a computer program product, wherein the computer program product comprises a computer program, wherein the computer program, when executed by a processor, can implement the method described in any embodiment of the first aspect. BRIEF DESCRIPTION OF THE DRAWINGS
[0032] In order to more clearly illustrate the technical solutions of some embodiments of the present application, the drawings required for use in some embodiments of the present application will be briefly introduced below. It should be understood that the following drawings only show some embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.
[0033] Figure 1 System diagram of a UAV power replacement library provided for some embodiments of the present application; Figure 2 An internal structural diagram of a power exchange system provided for some embodiments of the present application; Figure 3 A schematic diagram of a clamping hole of a drone battery box provided in some embodiments of the present application; Figure 4 A flow chart of a method for obtaining calibration data for battery replacement in a drone hangar provided in some embodiments of the present application; Figure 5 One of the flow charts of the method for replacing power in a drone hangar provided in some embodiments of the present application; Figure 6 Flowchart 2 of a method for replacing power in a drone hangar provided for some embodiments of the present application; Figure 7 A block diagram of the device composition for replacing power in a drone hangar provided in some embodiments of the present application; Figure 8 A schematic diagram of an electronic device is provided for some embodiments of the present application.
[0034] In the figure: 100-hangar shell; 200-UAV; 300-UAV landing platform; 400-battery charging station; 500-battery; 600-battery replacement system; 601-three-axis module robotic arm; 602-gripper; 603-visual camera bracket; 604-visual camera; 605-rotation axis; 606-distance measuring sensor. DETAILED DESCRIPTION
[0035] The technical solutions in some embodiments of the present application will be described below in conjunction with the drawings in some embodiments of the present application.
[0036] It should be noted that similar reference numerals 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 defined and explained in subsequent drawings. At the same time, in the description of this application, the terms "first", "second", etc. are only used to distinguish the description and cannot be understood as indicating or implying relative importance.
[0037] In related technologies, drones are widely used in aerial photography, agricultural plant protection, power inspection, logistics distribution, environmental monitoring and other scenarios. At present, drones are mostly stored by simple manual storage or ground fixed facilities. However, drone storage requires a lot of ground space, and the storage capacity cannot be flexibly adjusted. Moreover, drones are directly exposed to the external environment and are easily affected by natural conditions such as wind, rain, and direct sunlight, which shortens their service life. Existing facilities cannot realize the automatic charging and maintenance functions of drones, and often require frequent manual intervention. Moreover, the safety of drones cannot be guaranteed through this external environment storage.
[0038] In view of this, some embodiments of the present application provide a method for replacing batteries in a drone hangar, in which the drone can be stored in a fixed hangar, and the intelligent battery replacement of the drone can be achieved through the combination of a robotic arm, a visual sensor, and a ranging sensor provided in the hangar. Specifically, the visual sensor can locate the position of the drone battery box; the robotic arm can move so that the gripper connected to it can reach the gripping position of the battery. Then, the relevant data collected by the ranging sensor can be used to fine-tune the position between the gripper and the drone battery box, so that the gripper can achieve precise gripping of the drone battery box. Some embodiments of the present application can automatically replace batteries for drones, improve the storage and battery replacement efficiency of drones, reduce manual intervention, and improve the uninterrupted operation capability of drones.
[0039] The following is combined with Figure 1 The overall composition structure of the system of the UAV power replacement hangar provided by some embodiments of the present application is exemplified.
[0040] like Figure 1 As shown, some embodiments of the present application provide a system diagram of a UAV battery replacement hangar, wherein the system of the UAV battery replacement hangar includes: hangar shell 100, UAV 200, UAV landing platform 300, battery charging station 400, battery 500, battery replacement system 600, three-axis module robot arm 601 (including: X-axis, Y-axis, Z-axis), gripper 602, visual camera bracket 603, visual camera 604 (as a specific example of a visual sensor). Among them, the battery replacement system 600 also includes the following Figure 2 The rotating shaft 605 and the distance measuring sensor 606 are shown. Figure 2It can be seen that there are three distance measuring sensors 606, namely, the distance measuring sensor TopRange set at the top of the gripper 602, and a distance measuring sensor installed at the front and rear ends of the left or right side of the gripper 602, respectively, which are recorded as sensors EdgeRange1 and EdgeRange2. Among them, the installation position of the sensor does not interfere with the clamping hole on the drone battery box (such as Figure 3 The partial clamping hole diagram shown in the figure can be used.
[0041] It can be understood that the first sensor in the following text is the visual camera 604, and the second sensor includes: the distance measuring sensor TopRange and the sensors EdgeRange1 and EdgeRange2. It can be seen that the present application also has multiple distance measuring sensors, which are distributed at different positions of the gripper.
[0042] Specifically, the hangar shell 100 provides storage space for the drone 200. The drone landing platform 300 provides a landing site for the drone. When the drone lands, the drone landing platform 300 will leave the hangar. After the drone lands, the drone landing platform 300 will be retracted into the hangar with the drone 200. The battery 500 is arranged on the battery charging station 400, and the battery can be charged. The battery replacement system 600 includes a three-axis module robot arm 601 (referred to as the robot arm), a gripper 602, a rotating shaft 605, a ranging sensor 606, a visual camera bracket 603 and a visual camera 604. The visual camera 604 is fixed to the visual camera bracket 603 by screws, and the visual camera bracket 603 and the gripper 602 are fixed to the hangar by screws and are located above the drone battery compartment (that is, the drone battery box). The visual camera 604 is relatively vertical to the drone battery compartment. It should be noted that the drone battery box is equipped with a drone battery, and the two are an integral structure. The visual camera 604 collects feature points on the drone battery box, which may be a clamping hole on the drone battery box, or a feature with obvious markings on the drone battery box, or an edge point of the battery shell, such as the four corner points of the edge of the battery shell.
[0043] It is understandable that the calibration data for the same model of drone battery box can be the same. In other words, a set of calibration data can be applicable to all drone battery boxes of the same model. In the case of different models, the calibration data of the model can be obtained first, so as to achieve accurate grasping of the drone battery box of the model and realize intelligent battery replacement.
[0044] When the drone landing platform recovers the landed drone, in order to accurately grasp the drone battery box, it is first necessary to provide relevant calibration data for the grasping of the drone battery box, so that the position of the gripper 602 and the drone battery box can be adjusted with reference to the calibration data during grasping to realize intelligent battery replacement.
[0045] The following is combined with Figure 4 The implementation process of obtaining calibration data for battery replacement in a drone hangar provided by some embodiments of the present application is exemplified.
[0046] Please see attached Figure 4 , Figure 4 A flow chart of a method for obtaining calibration data for battery replacement in a drone hangar provided in some embodiments of the present application, the method for obtaining calibration data for battery replacement in a drone hangar may include: S410, collecting feature points of the drone battery box through the visual sensor.
[0047] For example, in some embodiments of the present application, the position of the clamping hole on the drone battery box (as a specific example of a feature point) can be captured by the visual camera 604.
[0048] S420, converting the feature points into coordinate information to obtain a calibrated position of the battery box.
[0049] For example, in some embodiments of the present application, the position of the clamping hole is converted into a calibration coordinate in the coordinate system of the drone battery compartment to obtain the calibration position of the battery box.
[0050] S430, based on the calibrated position of the battery box, when the gripper is controlled to be located at a preset position of the drone battery box, calibration data of the gripper and the drone battery box is determined, wherein the calibration data includes first calibration data and second calibration data.
[0051] For example, in some embodiments of the present application, when the gripper and the drone battery compartment are in different preset positions, distance calibration data (as a specific example of the first calibration data) and side calibration data (as a specific example of the second calibration data) of the gripper and the drone battery compartment can be obtained.
[0052] In some embodiments of the present application, S430 may include: when the gripper is at a first preset position of the drone battery box, obtaining the first calibration data through the ranging sensor.
[0053] For example, in some embodiments of the present application, the control robot arm is located at the pick-up and placement position of the drone battery box, so that the gripper is located directly above the drone battery box (as a specific example of the first preset position), and the distance calibration data between the gripper and the drone battery box is obtained. Among them, the distance calibration data is collected by the sensor TopRange set on the top of the gripper 602. Specifically, the three-axis module robot arm 601 descends along the Z axis to the battery compartment position where the drone needs to pick up and place the battery (i.e., the drone battery compartment), ensuring that the battery gripper (referred to as the gripper) is directly above the center of the drone battery compartment, and the left and right distances of the gripper to the drone battery compartment are roughly the same, and the sensor TopRange data, i.e., TopRange_Data0 (as a specific example of distance calibration data), is recorded.
[0054] In some embodiments of the present application, S430 may include: when the gripper is at a second preset position of the drone battery box, obtaining the second calibration data through the ranging sensor.
[0055] For example, in some embodiments of the present application, when the gripper is in the calibration position, the lateral calibration data of the gripper and the drone battery box is obtained, wherein the calibration position is that the gripper does not touch and is not inserted into the clamping hole of the drone battery box. The lateral calibration data is acquired by sensors EdgeRange1 and EdgeRange2 disposed on one side (left or right) of the gripper 602. Specifically, the gripper is closed to the calibration position so that the battery gripper does not touch and is not inserted into the clamping hole on the battery box, and the data of sensors EdgeRange1 and EdgeRange2 are recorded as EdgeRange1_Data0 and EdgeRange2_Data0 (as a specific example of lateral calibration data).
[0056] Finally, make the gripper clamp the drone battery box, and record the data of sensors EdgeRange1 and EdgeRange2 as EdgeRange1_Data1 and EdgeRange2_Data1 respectively. By converting EdgeRange1_Data1 and EdgeRange2_Data1, we can calibrate the distance information of each sensor when grasping the battery box (that is, the distance between the gripper and the battery box) when grasping the battery box, and record the calibration data in the battery exchange system. EdgeRange1_Data1 and EdgeRange2_Data1 can be used as a measure of whether the gripper grasps the battery box tightly.
[0057] In some embodiments of the present application, after obtaining the above calibration data, when the drone landing platform recovers the drone, it is necessary to actually and accurately grab the drone battery box. Figure 5The specific process of replacing power in a drone hangar provided by some embodiments of the present application is exemplified.
[0058] Please see attached Figure 5 , Figure 5 A flow chart of a method for replacing power in a drone hangar is provided for some embodiments of the present application. The method for replacing power in a drone hangar may include: S510, based on the first data collected by the first sensor, adjust the relative position between the gripper connected to the robotic arm and the battery box of the drone, and control the robotic arm set in the hangar to reach the first position.
[0059] For example, in some embodiments of the present application, when it is necessary to grab the battery box of the drone, the gripper can be in the battery grabbing position by controlling the movement of the mechanical arm, so as to adjust the relative position between the gripper and the drone battery box. The mechanical arm and the gripper are connected, and when the mechanical arm is in the first position, the gripper can be in the battery grabbing position.
[0060] In some embodiments of the present application, S510 may include: obtaining the current position of the drone battery box collected by the visual sensor; generating a planned path based on the deviation data between the current position and the battery calibration position; and controlling the mechanical arm to move according to the planned path to reach the first position. The current position is obtained by the following method: taking the clamping hole on the drone battery box as a feature point, using a visual camera to collect the feature point position; and converting the feature point position into the current position of the drone battery box.
[0061] For example, in some embodiments of the present application, after the drone landing platform recovers the drone, the control end of the three-axis module robotic arm will trigger the visual camera to take a picture of the drone battery replacement calibration position (that is, the drone battery box), obtain the feature point position of the current drone battery box position (that is, the clamping hole position), and convert the feature point position through the algorithm of the visual camera to obtain the coordinate information of the current drone battery replacement position (that is, the drone battery box) (as a specific example of the current position). The control end compares the received coordinate information with the calibrated battery position coordinates (as a specific example of the battery calibration position) to calculate the deviation data of the current drone battery box position. Afterwards, the position information of the current drone battery replacement position in the global coordinate system is obtained through matrix transformation and vector translation. The control end of the three-axis module robotic arm drives the robotic arm to perform motion planning through this position information, so that the Z axis of the three-axis module robotic arm drops to the first position, and the gripper is in the battery gripping position.
[0062] Specifically, the battery exchange system 600 of the drone hangar includes a global coordinate system, a workpiece coordinate system, a gripper tool coordinate system, a camera coordinate system, and a drone battery compartment coordinate system. The global coordinate system is the reference coordinate system of the entire battery exchange system 600 in space, which can determine the relationship between different systems and components. The workpiece coordinate system is the battery coordinate system, which is established with a certain point on the battery as the origin. The tool coordinate system is the gripper coordinate system, which is established with the gripper center as the origin. The camera coordinate system is established with the camera center as the origin.
[0063] The drone battery compartment coordinate system is the coordinate system for placing and taking batteries on the aircraft. There are four clamping holes on the drone battery compartment. The geometric center of the clamping hole is used as the feature point. The coordinates are A 0 Point (x 01 ,y 01 )、B 0 Point (x 02 ,y 02 )、C 0 Point (x 03 ,y 03 )、D 0 Point (x 04 ,y 04 ). The diagonal line connecting the coordinates of the four points is A 0 C 0 , B 0 D 0 , determine the center coordinates O of the object to be identified 0 Point (x 00 ,y 00 ) and the diagonal A 0 C 0 Angle information with respect to the X axis 0 The visual camera 604 obtains the i-th feature point coordinates (that is, the current position coordinates) of the battery compartment during the i-th battery replacement through visual information, and the feature point is identified as A i (x i1 ,y i1 )、B i (x i2 ,y i2 )、C i (x i3 ,y i3 )、D i Point (x i4 ,y i4 ), calculate the center coordinates O of the identified object (i.e., the drone battery box) i Point (x i0 ,y i0 ) and the diagonal A i C i and B i D iAngle information with respect to the X axis i By comparing the i-th feature point coordinates with the calibrated feature point coordinates (i.e., the battery position calibration coordinates), the offset data of the battery compartment in the drone battery compartment coordinate system can be obtained (as a specific example of deviation data).
[0064] By comparing the calibrated feature point coordinates with the i-th feature point coordinates, the translation vector of the robot arm can be calculated. O=( x, y), x=x i0 -x 00 , y=y i0 -y 00 , and the overall translation difference of the robot arm from the calibration position to the current position is calculated. The offset of the battery box position angle can be calculated as follows: The translation vector and the offset angle of the battery box are transformed through matrix transformation and the translation vector and other coordinate systems to finally obtain the position information of the battery box in the global coordinate system. This position information is fed back to the robot controller, and the robot controller plans the robot motion path through the transformed coordinates so that the robot can move correctly.
[0065] S520: Based on the first position and the second data collected by the second sensor, further adjust the relative position between the gripper and the drone battery box to control the robotic arm to reach the second position.
[0066] For example, in some embodiments of the present application, after the robotic arm is adjusted to the first position, under this premise, the robotic arm is controlled to the second position by acquiring data collected by sensors TopRange, EdgeRange1, and EdgeRange2 respectively (as a specific example of the second data), so as to achieve phase posture adjustment between the gripper and the drone battery box.
[0067] In some embodiments of the present application, S520 may include: adjusting the relative height between the gripper and the drone battery box based on the first orientation data and the first calibration data collected by the ranging sensor.
[0068] For example, based on the data distance calibration data and TopRange_Data0 collected by the sensor TopRange set at the top of the gripper, the relative height between the gripper and the battery box of the drone is adjusted.
[0069] In some embodiments of the present application, S520 may include: comparing the first orientation data with the first calibration data to determine height data; and adjusting the relative height between the gripper and the drone battery box according to the height data.
[0070] For example, in some embodiments of the present application, the current data collected by the sensor TopRange at the top of the gripper is used to finely adjust the lifting and lowering in the Z-axis direction, that is, the height (or distance) between the gripper and the drone battery box in the vertical direction. Specifically, the distance data TopRange_Datai (as a specific example of the first orientation data) collected by the sensor TopRange at the top of the gripper is compared with the distance calibration data TopRange_Data0 to obtain the lifting and lowering data. TopRange (as a specific example of height data), i.e. TopRange=TopRange_Datai-TopRange_Data0, Z axis follows TopRange moves to adjust the height between the gripper and the drone battery box.
[0071] In some embodiments of the present application, S520 may include: adjusting the relative angle between the gripper and the drone battery box based on the second orientation data and the second calibration data collected by the ranging sensor.
[0072] For example, based on the data collected by the sensors EdgeRange1 and EdgeRange2 set on the side of the gripper and the EdgeRange1_Data0 and EdgeRange2_Data0 obtained above, the relative angle between the gripper and the drone battery box is adjusted so that the gripper can accurately grasp the drone battery box.
[0073] In some embodiments of the present application, S520 may include: comparing the second orientation data with the second calibration data to determine angle data; and adjusting the relative angle between the gripper and the drone battery box according to the angle data.
[0074] For example, in some embodiments of the present application, after the Z-axis fine-tuning is completed, the gripper is closed to the correction position, and the data collected by the side sensors EdgeRange1 and EdgeRange2 of the gripper are used to fine-tune the left and right rotation of the rotation axis, thereby adjusting the angle between the gripper and the drone battery box, so that the robotic arm can accurately pick up and place the batteries in the drone battery box.
[0075] In some embodiments of the present application, S530 may include: obtaining angle data collected by a sensor on one side of the gripper; comparing the angle data with side calibration data to determine the rotation angle; controlling the robotic arm to rotate according to the rotation angle to adjust the angle of the gripper.
[0076] For example, in some embodiments of the present application, the data EdgeRange1_Datai and EdgeRange2_Datai (as a specific example of the second orientation data) collected by the side sensors EdgeRange1 and EdgeRange2 are compared with the calibration data EdgeRange1_Data0 and EdgeRange2_Data0 to obtain the rotation axis fine-tuning data deviation value. TopRange , according to the obtained data deviation value, it is converted into a rotation angle (as a specific example of angle data) and rotated so that TopRange The best effect is achieved when the temperature is close to 0 degrees.
[0077] In some embodiments of the present application, S530 may include: controlling the gripper to grip the drone battery box at the second position, wherein the drone battery box contains a drone battery.
[0078] For example, in some embodiments of the present application, after adjusting the relative height and relative angle between the gripper and the drone battery box, the gripper can accurately grasp the drone battery box. Specifically, after the height and angle adjustment is completed, the gripper can be inserted into the gripping hole to grasp the battery box and complete the placement of the battery box.
[0079] It is understandable that in some embodiments, it is also possible to determine whether the gripper is holding the battery box tightly. Specifically, the data collected by sensors EdgeRange1 and EdgeRange2 are compared with the calibration data EdgeRange1_Data1 and EdgeRange2_Data1 obtained above to ensure that the gripper is holding the battery box tightly, thereby ensuring the safety of taking and placing the battery box.
[0080] In some embodiments of the present application, the method for replacing batteries in a drone hangar further includes: after grabbing the drone battery, controlling the robotic arm to place the drone battery in a built-in battery compartment in the hangar; wherein the charging module of the battery compartment is used to charge the placed drone battery.
[0081] For example, in some embodiments of the present application, after the gripper grabs the drone battery, it can place it into the battery compartment for charging by controlling the robotic arm to complete the charging of the drone battery.
[0082] In some embodiments of the present application, the method for replacing batteries in a drone hangar further includes: recording and storing the second position, grabbing a battery that meets preset conditions in the hangar; and controlling the robotic arm based on the second position to install the grabbed battery with preset conditions in the drone body.
[0083] For example, in some embodiments of the present application, the system can record the second position when grabbing the drone battery, and then select a battery with sufficient power from the hangar (as a specific example of a preset condition battery), grab it and install it into the corresponding position of the drone.
[0084] The following is combined with Figure 6 The specific process of replacing power in a drone hangar provided by some embodiments of the present application is exemplified.
[0085] Please see attached Figure 6 , Figure 6 A flow chart of a method for replacing power in a drone hangar is provided for some embodiments of the present application.
[0086] The above implementation process is described below by way of example.
[0087] S610, obtains the feature points of the drone battery box through the visual camera.
[0088] S620, convert the feature point into the current position coordinates to obtain the position of the drone battery box.
[0089] S630, comparing the current position coordinates with the calibration coordinates corresponding to the battery calibration position to obtain deviation data.
[0090] S640, converting the deviation data into position information in a global coordinate system, and generating a planning path corresponding to the position information.
[0091] S650, controls the robot arm to move according to the planned path so that the gripper reaches the battery grabbing position.
[0092] S660, compare the distance data collected by the sensor at the top of the gripper with the distance calibration data to determine the lifting data; control the robotic arm to move according to the lifting data and adjust the height of the gripper.
[0093] S670, compare the angle data collected by the sensor on one side of the gripper with the side calibration data to determine the rotation angle; control the robot arm to rotate according to the rotation angle to adjust the angle of the gripper.
[0094] S680, the gripper grasps the drone battery box and completes the pick-up and placement.
[0095] It should be noted that the specific implementation process of S610~S680 can refer to the method embodiment provided above, and in order to avoid repetition, the detailed description is appropriately omitted here.
[0096] Through some of the above-mentioned embodiments of the present application, it can be seen that in the drone hangar battery replacement method based on ranging sensor + vision, the application of the robotic arm in the battery replacement system uses ranging sensor + visual positioning, and the rotating gripper angle makes the grasping accuracy higher, which greatly reduces the battery replacement system's requirements for the mechanical structure's motion accuracy, improves the battery replacement success rate and flexibility, and reduces the battery damage rate.
[0097] Please refer to Figure 7 , Figure 7 The block diagram of the composition of the device for replacing the power in the hangar of a drone provided by some embodiments of the present application is shown. It should be understood that the device for replacing the power in the hangar of a drone corresponds to the above-mentioned method embodiment and can execute each step involved in the above-mentioned method embodiment. The specific functions of the device for replacing the power in the hangar of a drone can be found in the description above. To avoid repetition, the detailed description is appropriately omitted here.
[0098] Figure 7 The device for replacing batteries in a drone hangar includes at least one software function module that can be stored in a memory in the form of software or firmware or solidified in the device for replacing batteries in a drone hangar. The device for replacing batteries in a drone hangar includes: a first control module 710, which is used to adjust the relative position between a gripper connected to a robotic arm and a drone battery box based on first data collected by a first sensor, and control the robotic arm arranged in the hangar to reach a first position; a second control module 720, which is used to further adjust the relative posture between the gripper and the drone battery box based on the first position and second data collected by a second sensor, and control the robotic arm to reach a second position; a grasping module 730, which is used to control the gripper to grasp the drone battery box at the second position, and the drone battery box contains a drone battery.
[0099] In some embodiments of the present application, before the first control module 710, the device for replacing battery in the drone hangar also includes: a calibration module (not shown in the figure) used to: collect feature points of the drone battery box through the visual sensor; convert the feature points into coordinate information to obtain the calibration position of the battery box.
[0100] In some embodiments of the present application, a calibration module (not shown in the figure) is used to: based on the calibration position of the battery box, control the gripper to be located at a preset position of the drone battery box, and determine the calibration data of the gripper and the drone battery box, wherein the calibration data includes first calibration data and second calibration data.
[0101] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working process of the device described above can refer to the corresponding process in the aforementioned method, and will not be described in detail here.
[0102] Some embodiments of the present application further provide a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, can implement the operations of the method corresponding to any of the above methods provided in the above embodiments.
[0103] Some embodiments of the present application further provide a computer program product, which includes a computer program, wherein when the computer program is executed by a processor, it can implement the operations corresponding to any of the above methods provided in the above embodiments.
[0104] like Figure 8 As shown, some embodiments of the present application provide an electronic device 800, which includes: a memory 810, a processor 820, and a computer program stored in the memory 810 and executable on the processor 820, wherein the processor 820 can implement a method as described in any of the above embodiments when reading the program from the memory 810 through a bus 830 and executing the program.
[0105] Processor 820 can process digital signals and can include various computing structures, such as complex instruction set computer structure, reduced instruction set computer structure, or a structure that implements a combination of multiple instruction sets. In some examples, processor 820 can be a microprocessor.
[0106] The memory 810 may be used to store instructions executed by the processor 820 or data related to the execution of instructions. These instructions and / or data may include codes for implementing some or all functions of one or more modules described in the embodiments of the present application. The processor 820 of the disclosed embodiment may be used to execute instructions in the memory 810 to implement the method shown above. The memory 810 includes a dynamic random access memory, a static random access memory, a flash memory, an optical memory, or other memory known to those skilled in the art.
[0107] The above description is only an embodiment of the present application and is not intended to limit the scope of protection of the present application. For those skilled in the art, the present application may have various changes and variations. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present application should be included in the scope of protection of the present application. It should be noted that similar reference numerals 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 defined and explained in the subsequent drawings.
[0108] The above is only a specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any person skilled in the art who is familiar with the present technical field can easily think of changes or substitutions within the technical scope disclosed in the present application, which should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.
[0109] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the presence of other identical elements in the process, method, article or device including the elements.
Claims
1. A method for replacing power in a drone hangar, characterized in that: include: Based on the first data collected by the first sensor, the relative position between the gripper connected to the mechanical arm and the battery box of the drone is adjusted, and the mechanical arm disposed in the hangar is controlled to reach the first position; Based on the first position and the second data collected by the second sensor, further adjusting the relative position between the gripper and the drone battery box to control the robotic arm to reach the second position; The gripper is controlled to grip the drone battery box at the second position, wherein the drone battery box contains a drone battery.
2. The method according to claim 1, characterized in that The method further includes: after grabbing the drone battery, controlling the robotic arm to place the drone battery in a built-in battery compartment in the hangar; wherein a charging module in the battery compartment is used to charge the placed drone battery.
3. The method according to claim 2, characterized in that The method further comprises: Record and store the second position, and grab the battery that meets the preset conditions in the hangar; Based on the second position, the mechanical arm is controlled to install the grasped preset condition battery into the drone body.
4. The method according to any one of claims 1 to 3, characterized in that The first sensor is a visual sensor; the second sensor includes a plurality of distance measuring sensors, and the plurality of distance measuring sensors are arranged at different positions of the gripper.
5. The method according to claim 4, characterized in that Before adjusting the relative position between the gripper connected to the mechanical arm and the battery box of the drone based on the first data collected by the first sensor, the method further includes: Collecting feature points of the drone battery box by using the visual sensor; The characteristic points are converted into coordinate information to obtain the calibrated position of the battery box.
6. The method according to claim 5, characterized in that The method further comprises: Based on the calibrated position of the battery box, when the gripper is controlled to be located at a preset position of the drone battery box, calibration data of the gripper and the drone battery box are determined, wherein the calibration data includes first calibration data and second calibration data.
7. The method according to claim 5 or 6, characterized in that The method of adjusting the relative position between the gripper connected to the mechanical arm and the battery box of the drone based on the first data collected by the first sensor, and controlling the mechanical arm disposed in the hangar to reach the first position, comprises: Obtaining the current position of the drone battery box collected by the visual sensor; Generate a planned path based on the deviation data between the current position and the battery calibration position; Control the robotic arm to move according to the planned path to reach the first position.
8. The method according to claim 6, characterized in that The further adjusting the relative position between the gripper and the drone battery box based on the first position and the second data collected by the second sensor includes: Based on the first orientation data collected by the ranging sensor and the first calibration data, adjusting the relative height between the gripper and the drone battery box; Based on the second orientation data collected by the ranging sensor and the second calibration data, the relative angle between the gripper and the drone battery box is adjusted.
9. A device for replacing power in a drone hangar, characterized in that: include: A first control module is used to adjust the relative position between the gripper connected to the mechanical arm and the battery box of the drone based on the first data collected by the first sensor, and control the mechanical arm arranged in the hangar to reach the first position; A second control module, configured to further adjust the relative position between the gripper and the drone battery box based on the first position and second data collected by the second sensor, and control the robotic arm to reach a second position; The gripping module is used to control the gripper to grip the drone battery box at the second position, wherein the drone battery box contains a drone battery.
10. An electronic device, characterized in that: The method comprises a memory, a processor, and a computer program stored in the memory and running on the processor, wherein the computer program executes the method according to any one of claims 1 to 8 when being run by the processor.
Citation Information
Patent Citations
Method for gripping unmanned aerial vehicle batteries by using mechanical arm
CN107121988A
Battery module and automatic battery replacement system
CN114537206A
Unmanned aerial vehicle battery replacement automatic positioning method and device
CN114889482A
Unmanned aerial vehicle intelligent battery replacing device based on visual identification and laser ranging composite positioning
CN114954122A
Flying mechanical arm maneuvering grabbing system based on vision
CN115870973A
Cited By
Hangar balance control method and device, electronic equipment and storage medium
CN121879433A
A hangar balance control method and device, electronic equipment and storage medium
CN121879433B
