Control method and system for orderly fruit basketing of robot and robot
By determining the three-dimensional parameters and mesh division of the fruit basket, combined with the staggered arrangement method of mechanical claws, the tightness and uniformity of baskets in traditional technology are solved, and the fruits are uniformly entered and efficiently loaded into the basket.
Patent Information
- Application Number
- CN202411327826.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-23
- Publication Date
- 2024-12-06
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
In traditional technology, the process of filling the basket cannot reasonably control the tightness of the basket, resulting in low uniformity and space utilization of the fruits entering the basket, which can easily cause fruit damage and low efficiency.
By determining the three-dimensional parameters of the fruit basket, establishing a coordinate system, and using the staggered arrangement method of mesh division and mechanical claws, the row arrangement method of each layer of the fruit basket is calculated to achieve orderly installation of the fruits, ensuring uniformity and appropriateness. tightness of the basket.
The uniformity of fruits entering the basket and appropriate tightness of the basket are achieved, which avoids the problems of fruit damage and low space utilization, and improves the efficiency of basket installation.
Smart Images

Figure CN119079202A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robot control technology, and in particular to a robot-based fruit orderly basket loading control method, system and robot. Background Art
[0002] The packing of fruits is an indispensable part of fruit production. During the packing process, the fruits should be packed into the baskets in a single layer and placed as full as possible. The density should be appropriate to avoid squeezing and damaging the fruits. In traditional technology, the fruits are generally transported indoors after harvesting and then packed manually. However, manual packing cannot reasonably control the tightness of the baskets and is inefficient.
[0003] Chinese patent CN115299244B discloses a greenhouse picking robot capable of loading and unloading baskets in situ and a method of using the same, wherein the greenhouse picking robot capable of loading and unloading baskets in situ comprises a mobile chassis, and a lifting platform and a basket unloading device mounted on the mobile chassis; a picking basket conveying device and a working platform are mounted on the lifting platform, a picking mechanical arm is mounted on the working platform, a basket loading position adapted to the picking mechanical arm is formed at the front of the picking basket conveying device, and a basket loading device for placing the picking basket on the picking basket conveying device is provided at the rear of the basket loading position. The picking basket conveying device is used to deliver an empty picking basket to the basket loading position, so as to facilitate the collection of fruits picked by the mechanical arm, and to deliver a full picking basket to the basket unloading device; an empty picking box is placed on the picking basket conveying device by the basket loading device, and no manual lifting is required during the basket unloading and basket placing processes, which greatly reduces the labor intensity and improves the work efficiency.
[0004] The solution in the above patent realizes the mechanization of fruit basketing and improves the efficiency of basketing during fruit picking, but does not consider the problem of orderly basketing, and thus cannot ensure the uniformity of fruit loading and the appropriate tightness of basketing. Summary of the invention
[0005] In order to solve the above technical problems, this application proposes the following technical solutions:
[0006] In a first aspect, an embodiment of the present application provides a method for controlling the orderly loading of fruits into baskets by a robot, comprising:
[0007] Determine the three-dimensional parameters of the fruit basket and establish a coordinate system, and place the fruit basket into the coordinate system;
[0008] Based on the principle of avoiding collision with fruits and basket walls and ensuring uniform arrangement when the mechanical claws are working, the fruit basket is divided into grids while considering the gaps between rows and columns, and the columns and rows of each layer and the total number of layers are obtained;
[0009] The arrangement of the fruits is determined according to the number of layers when the fruits are placed and the grid body after the fruit basket is divided, so that the fruits can be put into the basket in an orderly manner.
[0010] In a possible implementation, determining the three-dimensional parameters of the fruit basket and establishing a coordinate system, and placing the fruit basket into the coordinate system includes:
[0011] Determine the length, width and height parameters of the fruit basket and generate a corresponding three-dimensional model;
[0012] The origin of the coordinate system is determined and a bottom corner of the three-dimensional model of the fruit basket is placed at the origin.
[0013] In a possible implementation, the mechanical claw is based on the principle of avoiding collision with the fruit and the wall of the fruit basket and ensuring uniform arrangement when working, and the fruit basket is divided into a grid while considering the gaps between rows and columns, and the columns and rows of each layer and the total number of layers are obtained, including:
[0014] Determine reserved gaps at both ends of the fruit basket in sequence, wherein the width of the reserved gaps is greater than the width of each claw of the mechanical claw;
[0015] Cubes are divided in the fruit basket for placing fruits, and the gaps between two adjacent cubes are guaranteed to overlap;
[0016] The number of columns and rows that can be arranged in each layer of the fruit basket is determined according to the length of the fruit basket, the width of a single claw finger and the length of the fruit.
[0017] In a possible implementation, determining the number of columns and rows that can be arranged in each layer of the fruit basket according to the length of the fruit basket, the width of a single claw finger, and the length of the fruit includes:
[0018] The difference between the length of the fruit basket and the width of a single claw finger is divided by the sum of the length of the fruit and vegetable and the width of a single claw finger to obtain the number of rows that can be arranged in each layer of the fruit basket;
[0019] The difference between the width of the fruit basket and the width of a single claw finger is divided by the sum of the width of the fruit and vegetable and the width of a single claw finger to obtain the number of rows that can be arranged in each layer of the fruit basket;
[0020] If the calculated number of rows and columns is a non-integer, the integer part is retained and the length of the non-integer row and column parts is evenly distributed to the grid body of each row and column to determine the final row and column gaps.
[0021] In a possible implementation, if the calculated number of rows and columns is a non-integer, retaining the integer part and evenly distributing the length of the non-integer row and column parts to the grid body of each row and column to determine the final row and column gaps includes:
[0022] The total size of the gap in the row arrangement direction is &1 = L-[m(l+b)+b];
[0023] The total size of the gap in the row arrangement direction is &2 = W-[n(w+b)+b];
[0024] The final single-edge gap of each mesh volume in each row is
[0025] The final single-edge gap of each grid volume in each column is Wherein: b is the width of the claw; L is the length of the fruit basket, W is the width of the fruit basket, l is the length for loading fruits, w is the width for loading fruits, n is the number of rows that can be arranged in each layer of the fruit basket, and m is the number of columns that can be arranged in each layer of the fruit basket.
[0026] In a possible implementation, the method of determining the arrangement of the fruits according to the number of layers when the fruits are placed and the grid bodies after the fruit baskets are divided to achieve orderly basket loading of the fruits includes:
[0027] Determine the number of fruits to be put into the basket by dividing the rows, columns and total number of layers of each layer, and determine the posture of the mechanical claw and the arrangement process;
[0028] When arranged in odd layers, obtain the coordinates of the geometric center point of the grid body, and make the center point of the fruit coincide with the center coordinate of the grid body; when arranged in even layers, obtain the midpoint coordinates of the line connecting the center points of adjacent grid bodies in each row, and make the center point of the fruits and vegetables coincide with the midpoint coordinates, and fill each layer in turn.
[0029] In a possible implementation, when arranged in odd layers, the arrangement order of the fruits is:
[0030] Start with the first row: rotate the gripper and adjust its posture to be parallel to the row arrangement direction. Leave the leftmost and rightmost grid bodies of the first row empty. Align the geometric centers of the grasped fruits and vegetables with the geometric centers of the remaining grid bodies of the first row. After the first row is arranged, keep the gripper posture unchanged and arrange the remaining rows in the order of the first row. Finally, leave the first and last columns empty.
[0031] Then place the remaining two columns: rotate the mechanical claw and adjust its posture to be parallel to the column arrangement direction to empty the top and bottom grid bodies of the first column, and make the geometric center of the grasped fruits and vegetables coincide with the geometric center of the remaining grid bodies of the first column in sequence. After the first column is arranged, keep the mechanical claw posture unchanged, and arrange the last column in the order of the first column, and finally empty the grid bodies at the four corners of this layer;
[0032] Finally, arrange the remaining four grid bodies: rotate the mechanical claw, adjust the posture to be parallel to the left diagonal of the fruit basket, and successively overlap the geometric center points of the fruits and vegetables with the geometric center points of the upper left and lower right grid bodies. Rotate the mechanical claw again, adjust the posture to be parallel to the right diagonal of the fruit basket, and successively overlap the geometric center points of the fruits and vegetables with the geometric center points of the lower left and upper right grid bodies to complete the odd-numbered layer arrangement.
[0033] In one possible implementation, when arranging in even layers, the arrangement order of the fruits is: ensure that the posture of the mechanical claw is always parallel to the row arrangement direction, obtain the midpoint coordinates of the line connecting the geometric center points of any adjacent grid bodies in the first row, and sequentially make the geometric center points of the fruits and vegetables coincide with these midpoint coordinates, so as to complete the arrangement of the first row and the remaining rows follow the arrangement order of the first row to complete the arrangement of the even layers.
[0034] In a second aspect, an embodiment of the present application provides a fruit orderly basket loading control system for a robot, comprising:
[0035] A determination module, used for determining the three-dimensional parameters of the fruit basket and establishing a coordinate system, and placing the fruit basket into the coordinate system;
[0036] The processing module is used to divide the fruit basket into grids based on the principle of avoiding collision between the mechanical claw and the fruit and the wall of the fruit basket and ensuring uniform arrangement while taking into account the gaps between rows and columns, and obtain the columns and rows of each layer and the total number of layers arranged;
[0037] The basket loading control module is used to determine the arrangement of the fruits according to the number of layers when the fruits are placed and the grid body after the fruit basket is divided to realize orderly basket loading of the fruits.
[0038] In a third aspect, an embodiment of the present application provides a robot, comprising:
[0039] processor;
[0040] Mechanical claws;
[0041] Memory;
[0042] And a computer program, wherein the computer program is stored in the memory, and the computer program includes instructions, which, when executed by the processor, enable the processor to control the mechanical claw to execute the method described in the single aspect or any possible implementation of the first aspect.
[0043] In the embodiment of the present application, the method of grid division and staggered arrangement is adopted to calculate the row and column arrangement of fruits in each layer of the fruit basket, thereby achieving uniformity of fruit entry into the basket and appropriate tightness of the basket, avoiding the problem of traditional fruit stacking that easily causes fruit damage and fails to fully utilize the space in the basket. BRIEF DESCRIPTION OF THE DRAWINGS
[0044] Figure 1 A schematic diagram of a flow chart of a method for controlling the orderly loading of fruits into baskets by a robot provided in an embodiment of the present application;
[0045] Figure 2 A schematic diagram of grid volume division provided in an embodiment of the present application;
[0046] Figure 3 A schematic diagram of an odd-numbered layer arrangement provided in an embodiment of the present application;
[0047] Figure 4 This is an overall schematic diagram of the basket after loading provided by the embodiment of the present application;
[0048] Figure 5 A cross-sectional view after basket loading provided in an embodiment of the present application;
[0049] Figure 6 A schematic diagram of a robot's orderly basket loading control system provided in an embodiment of the present application. DETAILED DESCRIPTION
[0050] The present solution is described below in conjunction with the accompanying drawings and specific implementation methods.
[0051] See also Figure 1 The present embodiment provides a method for controlling the orderly loading of fruits into baskets by a robot, comprising:
[0052] S101, determine the three-dimensional parameters of the fruit and the fruit basket and establish a coordinate system, and place the fruit basket into the coordinate system.
[0053] The fruits are generally graded before being basketed. In this embodiment, the fruits are first screened before being basketed to ensure that the sizes of the fruits packed into the same fruit basket are basically the same. Then the length, width, and height parameters of the fruits and the fruit basket are determined, and the geometric types of the fruits and the fruit basket are selected through the human-computer interaction device and the length, width, and height three-dimensional parameters of the two are input. A rectangular coordinate system is established, the basketing operation is simplified to coordinate calculation, the origin of the coordinate system is determined, and a bottom corner of the three-dimensional model of the fruit basket is placed at the origin.
[0054] S102, based on the principle of avoiding collision between the mechanical claw and the fruit and the wall of the fruit basket and ensuring uniform arrangement when the mechanical claw is working, the fruit basket is divided into a grid body while considering the gaps between rows and columns, and the columns and rows of each layer and the total number of layers arranged are obtained.
[0055] The specific operation of dividing the grid body in this embodiment is to divide the fruit basket into grid bodies based on the relationship between the parameters of fruits and vegetables and the fruit basket, with the principle of avoiding collision with the fruits and vegetables and the basket wall when the mechanical claw is working and ensuring uniform arrangement, while considering the row and column gaps.
[0056] In this embodiment, reserved gaps are determined in turn at both ends of the fruit basket, and the width of the reserved gaps is greater than the width of each finger of the mechanical claw; cubes are divided in the fruit basket for placing fruits, and the gaps between two adjacent cubes are guaranteed to overlap; the number of columns and rows that can be arranged in each layer of the fruit basket is determined according to the length of the fruit basket, the width of a single finger and the length of the fruit.
[0057] Specifically, the difference between the length of the fruit basket and the width of a single claw finger is divided by the sum of the length of the fruit and vegetable and the width of a single claw finger to obtain the number of columns that can be arranged in each layer of the fruit basket. The difference between the width of the fruit basket and the width of a single claw finger is divided by the sum of the width of the fruit and vegetable and the width of a single claw finger to obtain the number of rows that can be arranged in each layer of the fruit basket. If the calculated number of rows and columns is a non-integer, retain the integer part and evenly distribute the length of the non-integer row and column part to the grid body of each row and column to determine the final row and column gap. See Figure 2 , which is a schematic diagram of the mesh partitioning.
[0058] As an example, the width of the claw is b = 1.5 cm, the length of the fruit basket is L = 80 cm, and the width is W = 65 cm. The length of the fruit and vegetable is l = 6 cm, the width is w = 5 cm, the number of integer rows is n, the number of integer columns is m, the total size of the gap drawn in the row arrangement direction is &1; the total size of the gap drawn in the column arrangement direction is &2; the final single-side gap of each grid body in each row is a; the final single-side gap of each grid body in each column is c.
[0059] Take the integer of the calculation result to get m=10; n=9. When arranging the single-side gap: the principle is to avoid collision with fruits and vegetables and basket walls when the mechanical claw is working and to ensure uniform arrangement. The size of the remaining decimal part is distributed to the grid bodies in each row and column, so it is obtained that &1=L-[m(l+b)+b]=80-[10*(6+1.5)+1.5]=3.5cm; &2=W-[n(w+b)+b]=65-[9*(5+1.5)+1.5]=5cm; each grid body has two single-side gaps in the row and column directions. Evenly distribute &1 and &2 to the single-side gaps in the row and column directions to get That is to complete the division of the grid.
[0060] S103, determining the arrangement of the fruits according to the number of layers when the fruits are put in and the grid body after the fruit basket is divided, so as to put the fruits into the basket in an orderly manner.
[0061] In this embodiment, the number of fruits to be loaded into the basket is determined by the divided rows, columns and total number of layers of each layer, and the posture and arrangement process of the mechanical claw is determined;
[0062] When arranged in odd layers, obtain the coordinates of the geometric center point of the grid body, and make the center point of the fruit coincide with the center coordinate of the grid body; when arranged in even layers, obtain the midpoint coordinates of the line connecting the center points of adjacent grid bodies in each row, and make the center point of the fruits and vegetables coincide with the midpoint coordinates, and fill each layer in turn.
[0063] Specifically, when arranged in odd layers, the order of the fruits is:
[0064] Start from the first row: rotate the robotic claw and adjust its posture to be parallel to the row arrangement direction. Leave the leftmost and rightmost grid bodies of the first row empty. Make the geometric centers of the grasped fruits and vegetables coincide with the geometric centers of the remaining grid bodies in the first row. After the first row is arranged, keep the robotic claw posture unchanged, arrange the remaining rows in the order of the first row, and finally leave the first and last columns empty.
[0065] Then place the remaining two columns: rotate the robotic claw and adjust its posture to be parallel to the column arrangement direction to empty the top and bottom grid bodies of the first column, and make the geometric centers of the grasped fruits and vegetables coincide with the geometric centers of the remaining grid bodies of the first column in sequence. After the first column is arranged, keep the robotic claw posture unchanged, and arrange the last column in the order of the first column, and finally empty the grid bodies at the four corners of this layer.
[0066] Finally, arrange the remaining four grid bodies: rotate the mechanical claw and adjust the posture to be parallel to the left diagonal of the fruit basket. Align the geometric center points of the fruits and vegetables with the geometric center points of the upper left and lower right grid bodies. Rotate the mechanical claw again and adjust the posture to be parallel to the right diagonal of the fruit basket. Align the geometric center points of the fruits and vegetables with the geometric center points of the lower left and upper right grid bodies. Complete the odd-numbered layer arrangement, such as Figure 3 shown.
[0067] When arranging in even layers, the arrangement order of the fruits is: ensure that the posture of the mechanical claw is always parallel to the row arrangement direction, obtain the midpoint coordinates of the line connecting the geometric center points of any adjacent grid bodies in the first row, and sequentially coincide the geometric center points of the fruits and vegetables with these midpoint coordinates, so as to complete the arrangement of the first row and the remaining rows according to the arrangement order of the first row to complete the arrangement of the even layers.
[0068] like Figure 3 In the figure, for the arrangement of odd-numbered layers, the serial number is the order of arrangement. Start with serial number 1 and arrange in sequence until serial number 24. At the same time, the rotation of the mechanical claw is required to prevent the mechanical claw from colliding with the basket wall and fruits and vegetables when moving forward and backward. For the arrangement of even-numbered layers, since the arrangement of even-numbered layers does not need to consider the collision of the four corners and the column arrangement direction, the mechanical claw is always parallel to the row arrangement direction and arranged in sequence (the arrangement of even-numbered layers is more conventional, so it is not illustrated).
[0069] After the basket is loaded, the final basket loading status can be found in Figure 4 and Figure 5 It can be seen from the figure that the use of the present embodiment to control the robot to basket the fruits ensures the uniformity of the fruits entering the baskets and the appropriate tightness of the baskets, and improves the space utilization of the fruit baskets.
[0070] Corresponding to the method for controlling the orderly basketing of fruits by a robot provided in the above-mentioned embodiment, the present application also provides an embodiment of a control system for the orderly basketing of fruits by a robot.
[0071] See also Figure 6 , a fruit orderly basket loading control system 20 for robots, comprising:
[0072] A determination module 201 is used to determine the three-dimensional parameters of the fruit basket and establish a coordinate system, and place the fruit basket into the coordinate system;
[0073] The processing module 202 is used to divide the fruit basket into grids based on the principle of avoiding collision between the mechanical claw and the fruit and the wall of the fruit basket and ensuring uniform arrangement while taking into account the gaps between rows and columns, and obtain the columns and rows of each layer and the total number of layers arranged;
[0074] The basket loading control module 203 is used to determine the arrangement of the fruits according to the number of layers when the fruits are put in and the grid body after the fruit basket is divided to realize the orderly loading of the fruits.
[0075] The present application also provides a robot, including: a processor, a mechanical claw, a memory, and a computer program, wherein the computer program is stored in the memory, and the computer program includes instructions, and when the instructions are executed by the processor, the processor controls the mechanical claw to execute the method in the above embodiment. Determine the three-dimensional parameters of the fruit basket and establish a coordinate system, and place the fruit basket in the coordinate system; based on the principle of avoiding collision with the fruit and the wall of the fruit basket when the mechanical claw is working and satisfying uniform arrangement, divide the fruit basket into a grid while considering the gaps between rows and columns, and obtain the columns, rows and total number of layers arranged in each layer; determine the arrangement of the fruit according to the number of layers when the fruit is placed and the grid after the fruit basket is divided to achieve orderly basketing of the fruit.
[0076] In the embodiments of the present application, "at least one" refers to one or more, and "plurality" refers to two or more. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can represent the existence of A alone, the existence of A and B at the same time, and the existence of B alone. Among them, A and B can be singular or plural. The character " / " generally indicates that the previous and subsequent associated objects are in an "or" relationship. "At least one of the following" and similar expressions refer to any combination of these items, including any combination of single or plural items. For example, at least one of a, b and c can be represented by: a, b, c, ab, ac, bc, or abc, where a, b, c can be single or multiple.
[0077] The above is only a specific implementation of the present application. Any person skilled in the art 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. The protection scope of the present application should be based on the protection scope of the claims.
Claims
1. A method for controlling the orderly loading of fruits into baskets by a robot, characterized in that: include: Determine the three-dimensional parameters of the fruit and the fruit basket and establish a coordinate system, and place the fruit basket into the coordinate system; Based on the principle of avoiding collision with fruits and basket walls and ensuring uniform arrangement when the mechanical claws are working, the fruit basket is divided into grids while considering the gaps between rows and columns, and the columns and rows of each layer and the total number of layers are obtained; The arrangement of the fruits is determined according to the number of layers when the fruits are placed and the grid body after the fruit basket is divided, so that the fruits can be put into the basket in an orderly manner.
2. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 1, characterized in that: The method of determining the three-dimensional parameters of the fruit and the fruit basket and establishing a coordinate system, and placing the fruit basket into the coordinate system, comprises: Determine the length, width and height parameters of the fruit and the fruit basket and generate the corresponding three-dimensional model; The origin of the coordinate system is determined and a bottom corner of the three-dimensional model of the fruit basket is placed at the origin.
3. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 1, characterized in that: The principle of avoiding collision between the mechanical claw and the fruit and the wall of the fruit basket and ensuring uniform arrangement is taken as the principle, and the fruit basket is divided into a grid body while considering the gaps between rows and columns, and the columns and rows of each layer and the total number of layers are obtained, including: Determine reserved gaps at both ends of the fruit basket in sequence, wherein the width of the reserved gaps is greater than the width of each claw of the mechanical claw; Cubes are divided in the fruit basket for placing fruits, and the gaps between two adjacent cubes are guaranteed to overlap; The number of columns and rows that can be arranged in each layer of the fruit basket is determined according to the length of the fruit basket, the width of a single claw finger and the length of the fruit.
4. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 3, characterized in that: The method of determining the number of columns and rows that can be arranged in each layer of the fruit basket according to the length of the fruit basket, the width of a single claw finger and the length of the fruit comprises: The difference between the length of the fruit basket and the width of a single claw finger is divided by the sum of the length of the fruit and vegetable and the width of a single claw finger to obtain the number of rows that can be arranged in each layer of the fruit basket; The difference between the width of the fruit basket and the width of a single claw finger is divided by the sum of the width of the fruit and vegetable and the width of a single claw finger to obtain the number of rows that can be arranged in each layer of the fruit basket; If the calculated number of rows and columns is a non-integer, the integer part is retained and the length of the non-integer row and column parts is evenly distributed to the grid body of each row and column to determine the final row and column gaps.
5. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 4, characterized in that: If the calculated number of rows and columns is a non-integer, the integer part is retained and the length of the non-integer row and column parts is evenly distributed to the grid body of each row and column to determine the final row and column gaps, including: The total size of the gap in the row arrangement direction is &1 = L-[m(l+b)+b]; The total size of the gap in the row arrangement direction is &2 = W-[n(w+b)+b]; The final single-edge gap of each mesh volume in each row is The final single-edge gap of each grid volume in each column is Wherein: b is the width of the claw; L is the length of the fruit basket, W is the width of the fruit basket, l is the length for loading fruits, w is the width for loading fruits, n is the number of rows that can be arranged in each layer of the fruit basket, and m is the number of columns that can be arranged in each layer of the fruit basket.
6. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 1, characterized in that: The method of determining the arrangement of the fruits according to the number of layers when the fruits are placed and the grid bodies after the fruit baskets are divided to realize orderly basket loading of the fruits includes: Determine the number of fruits to be put into the basket by dividing the rows, columns and total number of layers of each layer, and determine the posture of the mechanical claw and the arrangement process; When arranged in odd layers, obtain the coordinates of the geometric center point of the grid body, and make the center point of the fruit coincide with the center coordinate of the grid body; when arranged in even layers, obtain the midpoint coordinates of the line connecting the center points of adjacent grid bodies in each row, and make the center point of the fruits and vegetables coincide with the midpoint coordinates, and fill each layer in turn.
7. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 6, characterized in that: When arranged in odd layers, the order of the fruits is: Start with the first row: rotate the gripper and adjust its posture to be parallel to the row arrangement direction. Leave the leftmost and rightmost grid bodies of the first row empty. Align the geometric centers of the grasped fruits and vegetables with the geometric centers of the remaining grid bodies of the first row. After the first row is arranged, keep the gripper posture unchanged and arrange the remaining rows in the order of the first row. Finally, leave the first and last columns empty. Then place the remaining two columns: rotate the mechanical claw and adjust its posture to be parallel to the column arrangement direction to empty the top and bottom grid bodies of the first column, and make the geometric center of the grasped fruits and vegetables coincide with the geometric center of the remaining grid bodies of the first column in sequence. After the first column is arranged, keep the mechanical claw posture unchanged, and arrange the last column in the order of the first column, and finally empty the grid bodies at the four corners of this layer; Finally, arrange the remaining four grid bodies: rotate the mechanical claw, adjust the posture to be parallel to the left diagonal of the fruit basket, and successively overlap the geometric center points of the fruits and vegetables with the geometric center points of the grid bodies in the upper left corner and the lower right corner; rotate the mechanical claw again, adjust the posture to be parallel to the right diagonal of the fruit basket, and successively overlap the geometric center points of the fruits and vegetables with the geometric center points of the grid bodies in the lower left corner and the upper right corner to complete the odd-numbered layer arrangement.
8. The method for controlling the orderly loading of fruits into baskets by a robot according to claim 7, characterized in that: When arranging in even layers, the arrangement order of the fruits is: ensure that the posture of the mechanical claw is always parallel to the row arrangement direction, obtain the midpoint coordinates of the line connecting the geometric center points of any adjacent grid bodies in the first row, and make the geometric center points of the fruits and vegetables coincide with these midpoint coordinates in turn, so as to complete the arrangement of the first row, and the remaining rows are arranged in the order of the first row to complete the arrangement of the even layers.
9. A fruit orderly basket loading control system for a robot, characterized in that: include: A determination module, used for determining the three-dimensional parameters of the fruit basket and establishing a coordinate system, and placing the fruit basket into the coordinate system; The processing module is used to divide the fruit basket into grids based on the principle of avoiding collision between the mechanical claw and the fruit and the wall of the fruit basket and ensuring uniform arrangement while taking into account the gaps between rows and columns, and obtain the columns and rows of each layer and the total number of layers arranged; The basket loading control module is used to determine the arrangement of the fruits according to the number of layers when the fruits are placed and the grid body after the fruit basket is divided to realize orderly basket loading of the fruits.
10. A robot, characterized in that: include: processor; Mechanical claws; Memory; And a computer program, wherein the computer program is stored in the memory, and the computer program includes instructions, when the instructions are executed by the processor, the processor controls the mechanical claw to execute the method according to any one of claims 1-8.
