Full-track planning method and system for mechanical arm
By acquiring and optimizing the movement trajectory of the robot arm, the complex trajectory planning problem caused by the uncertainty of the work space in the palletizing task is solved, and the obstacle avoidance efficiency and operation safety of the robot arm are improved.
Patent Information
- Application Number
- CN202411242458.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-05
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2044-09-05
AI Technical Summary
In the palletization task, the existing robotic arms have complex trajectory planning, which affects the operation efficiency, and the collision detection time is long, which affects safety.
By obtaining the spatial information of the palletizing area and the robotic arm, a mathematical model is established using the D-H model, generating and optimizing the motion trajectory, collecting static and dynamic obstacle information, optimizing the trajectory to avoid collisions, and improving the obstacle avoidance efficiency of the robotic arm.
It simplifies the collection and processing of obstacle information, improves the collision detection efficiency of the robotic arm, and improves the safety and efficiency of the robotic arm palletization operation.
Smart Images

Figure CN118990490A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of robotic arms, and more specifically to a full trajectory planning method and system for a robotic arm. Background Art
[0002] As the speed of logistics continues to accelerate, in the process of packing and transporting items, it is inevitable to stack the packing boxes to facilitate the forklift to transfer them to the transportation tool. Due to the continuous development of automatic control technology, the task of stacking goods has become a very common and important task in the warehousing and logistics industries.
[0003] At present, most of the automation solutions for palletizing tasks in the industry consider the feasibility of implementation based on specific application scenarios. However, due to the uncertainty of the workspace, when the robot grabs the items and places them in the palletizing area, it is necessary to consider avoiding collisions with all obstacles in the workspace to ensure the safety of the operation. When the robot performs collision detection, the operation steps and algorithms are often more complicated, so the trajectory planning takes a long time, which in turn affects the operation efficiency of the robot. Summary of the invention
[0004] Therefore, this application is proposed to address the problems and needs existing in the above-mentioned prior art.
[0005] The purpose of this application is to provide a full trajectory planning method and system for a robotic arm, which, relative to the defects of the prior art, can effectively perform obstacle avoidance for the robotic arm and improve the efficiency of collision detection for the robotic arm, thereby improving the safety and efficiency of the robotic arm's operation.
[0006] The purpose of this application is achieved through the following technical solutions:
[0007] In a first aspect, an embodiment of the present application provides a full trajectory planning method for a robotic arm, the method comprising:
[0008] Acquire spatial dimension information and position information of the stacking area, information of the object boxes to be stacked, and information of the conveyor belt, classify the object boxes to be stacked according to the classification standard, and determine the stacking arrangement according to the classified object boxes and the spatial dimension information of the stacking area;
[0009] Acquire parameter information of the robotic arm, establish a mathematical model of the robotic arm using the DH model according to the parameter information of the robotic arm, and determine the initial position information of the robotic arm;
[0010] Generate a first motion trajectory according to the mathematical model of the robot and the conveyor belt information, obtain obstacle information of the robot workspace, and optimize the first motion trajectory according to the obstacle information of the robot workspace; the obstacle information of the robot workspace includes static obstacle information and dynamic obstacle information, and the obstacle information of the robot workspace is acquired according to the obstacle information acquisition strategy;
[0011] Obtain target item box information and distance information, where the distance information is the distance between the target item box and the next item box on the conveyor belt, generate a second motion trajectory according to the mathematical model of the robot arm, the conveyor belt information, the target item box information and the distance information, generate a third motion trajectory according to the mathematical model of the robot arm, the spatial size information and position information of the stacking area, and the static obstacle information of the robot arm workspace, and optimize the third motion trajectory based on the dynamic obstacle information of the robot arm workspace.
[0012] In a second aspect, an embodiment of the present application provides a full trajectory planning system for a robotic arm, the system comprising:
[0013] The first determination module is used to classify and determine the stacking arrangement according to the acquired spatial size information and position information of the stacking area, the information of the to-be-stacked object boxes and the conveyor belt information, and includes the following units:
[0014] A first acquisition unit is used to acquire spatial dimension information and position information of the palletizing area, information of the to-be-palletized object boxes, and information of the conveyor belt;
[0015] A first sorting unit is used to sort the palletized object boxes based on size and pattern;
[0016] A first calculation unit, used to determine the stacking arrangement through calculation according to the spatial dimension information of the stacking area and the dimension information of the object boxes to be stacked;
[0017] A first acquisition module, used to acquire parameter information of the robotic arm;
[0018] The first building module is used to establish a mathematical model of the robotic arm using the DH model according to the parameter information of the robotic arm to determine the position information of the robotic arm;
[0019] The second acquisition module is used to obtain obstacle information in the robot workspace and construct the collision area, including:
[0020] A second acquisition unit, used to acquire static obstacle information of the robot arm workspace according to a static obstacle acquisition strategy;
[0021] A third acquisition unit, used to acquire dynamic obstacle information of the robot arm workspace according to a dynamic obstacle acquisition strategy;
[0022] A first construction unit is used to construct an obstacle collision area according to obstacle information and a safety distance threshold;
[0023] The third acquisition module is used to obtain target item box information and distance information;
[0024] A first trajectory planning module, used to generate a first motion trajectory according to a mathematical model of the robot arm and conveyor belt information, and optimize the first motion trajectory based on obstacle information in a workspace of the robot arm;
[0025] A second trajectory planning module, used for generating a second motion trajectory according to a mathematical model of the robot arm, conveyor belt information, target object box information and distance information;
[0026] A third trajectory planning module is used to generate a third motion trajectory according to a mathematical model of the robot arm, spatial size information and position information of the stacking area, and static obstacle information of the robot arm workspace, and optimize the third motion trajectory based on the dynamic obstacle information of the robot arm workspace;
[0027] The storage module is used to store various basic parameter information, classification and calculation result information, trajectory planning information and stacking space change information.
[0028] In a third aspect, an embodiment of the present application provides a computer-readable storage medium, which stores instructions executable by the full trajectory planning system of the above-mentioned robotic arm, and the instructions are used to implement the full trajectory planning method of the robotic arm as described above when executed by a processor included in the full trajectory planning system of the above-mentioned robotic arm.
[0029] Compared with the prior art, the beneficial effects of the present invention are at least as follows:
[0030] Through the full trajectory planning method and system of the robotic arm of the present application, the obstacle information collection and processing steps can be simplified through the obstacle information collection strategy, the calculation efficiency can be improved when performing robotic arm collision detection, and the obstacle avoidance operation of the robotic arm can be effectively performed, thereby improving the safety and efficiency of the robotic arm palletizing operation. BRIEF DESCRIPTION OF THE DRAWINGS
[0031] Figure 1 A method flow chart of a full trajectory planning method for a robotic arm provided in accordance with an embodiment of the present application is illustrated;
[0032] Figure 2 A schematic diagram of an obstacle collision area provided according to an embodiment of the present application is illustrated;
[0033] Figure 3 The figure shows a schematic diagram of a full trajectory planning system for a robotic arm provided according to an embodiment of the present application. DETAILED DESCRIPTION
[0034] Below, the exemplary embodiments according to the present application will be described in detail with reference to the accompanying drawings. It should be understood that the specific embodiments described here are only part of the embodiments of the present application, and the present application is not limited to the exemplary embodiments described here.
[0035] It should be noted that if there are descriptions such as "first" and "second" in the embodiments of the present application, the descriptions such as "first" and "second" are only used for descriptive purposes and cannot be understood as indicating or implying their relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features.
[0036] Figure 1 The figure illustrates a method flow chart of a full trajectory planning method for a robotic arm provided in accordance with an embodiment of the present application.
[0037] like Figure 1 As shown, the full trajectory planning method of the robotic arm according to the embodiment of the present application may include step S100, step S200, step S300 and step S400.
[0038] In step S100, S101 obtains the spatial dimension information and position information of the stacking area, the information of the object boxes to be stacked and the conveyor belt information; S102 classifies the object boxes to be stacked according to the classification standard; S103 determines the stacking arrangement according to the classified object boxes and the spatial dimension information of the stacking area.
[0039] Specifically, the palletizing area is composed of multiple palletizing substrates, and the sizes of the palletizing substrates are generally the same. In the working space of the robot arm, the palletizing substrates are arranged in a linear or square shape, and a certain gap is left between the palletizing substrates to facilitate the palletizing operation of the robot arm or the operation of the forklift. In order to ensure the stability of the base pile after palletizing, it is necessary to specify the maximum height of the base pile; the length, width and initial height information of each palletizing substrate can be obtained by manual measurement, and the palletizing substrates can be numbered, and the distance between adjacent substrates can be measured manually; the conveyor belt of the transport line is fixed in the working space, and the length, width and height of the conveyor belt can be measured The speed information of the conveyor belt can be obtained through the conveyor belt control system; a Cartesian space coordinate system can be established based on the position of the conveyor belt, and the center point of the conveyor belt can be optionally taken as the origin of the coordinate system, the direction of movement of the conveyor belt as the X-axis, and the vertical direction as the Z-axis to determine the position of the conveyor belt in the space coordinate system, thereby determining the position information of each stacking substrate in the coordinate system; the basic information of the length, width and height of the box to be stacked can be obtained in advance by measurement, and the picture information of the box can be obtained and saved in advance by shooting with a camera, and the obtained data can be stored in the storage module as the original data for trajectory planning.
[0040] Then, the boxes to be stacked need to be preliminarily classified according to different sizes. Boxes of the same size are further classified into different boxes according to different box patterns. The types of the classified boxes and the size and pattern information of each classified box are recorded and saved.
[0041] Finally, the best arrangement is calculated based on the size-classified item box type data and the size of the stacking substrate, and the classified item boxes and their corresponding stacking arrangement are recorded and stored as initial data.
[0042] In step S200, parameter information of the robot arm is obtained, and a mathematical model of the robot arm is established using a DH model according to the parameter information of the robot arm to determine initial position information of the robot arm.
[0043] It should be understood that the robot arm described in the present application is a robot arm with multiple joints, which is used to grab the item boxes on the transport line and place them on the palletizing base pile. The base of the robot arm is a movable base, which expands the scope of operation. Therefore, the parameter information of the robot arm includes but is not limited to the angle between adjacent connecting rods of the robot arm, the distance between adjacent connecting rods, the connecting rod torsion angle, the connecting rod length, the position of the end of the robot arm and the rotation speed information of each joint. The DH model is a modeling method that is widely used in robot arm modeling. The DH model has four parameters, among which θ j and d j It is used to describe the relationship between adjacent links, which are the angle between adjacent links and the distance between adjacent links, α j and a j Used to describe the connecting rod, namely the connecting rod torsion angle and the connecting rod length, a mathematical model of the multi-coordinate system of each joint is established based on the DH model and the parameter information of the robotic arm, and then the position and posture information of the end coordinate system relative to the robot reference coordinate system is obtained through coordinate system transformation and forward kinematics analysis. The robot reference coordinate system can select the above-mentioned Cartesian space coordinate system based on the conveyor belt.
[0044] In step S300, S301 generates a first motion trajectory according to the mathematical model of the robot arm and the conveyor belt information; S302 obtains obstacle information of the robot arm workspace; S303 optimizes the first motion trajectory according to the obstacle information of the robot arm workspace; wherein, the obstacle information of the robot arm workspace includes static obstacle information and dynamic obstacle information, and the obstacle information of the robot arm workspace is acquired according to an obstacle information acquisition strategy.
[0045] Specifically, the movement of the robot arm includes the movement before grasping and the movement of grasping the item box and moving it to the corresponding stacking base pile to perform the stacking task. It can be understood that the movement trajectory of the robot arm before grasping the item box is the first movement trajectory, and the movement of the robot arm before grasping may include moving from the original position to the front of the conveyor belt and the clamping part of the robot arm to a safe position above the conveyor belt. The movement capacity of each joint of the robot arm is the greatest before the robot arm grasps the item. Based on the working environment, an enclosing sphere can be optionally used when selecting the bounding box of the robot arm. According to the mathematical model of the robot arm and the conveyor belt position information, a path planning search algorithm is used to plan the path for the robot arm to move to the front of the conveyor belt. Optionally, the embodiment of the present application uses a neural network algorithm to plan the path for the robot arm to move forward to the front of the conveyor belt without grasping the item.
[0046] It is understandable that the working space of the robot arm is not an idealized scene. There may be other objects that affect the operation of the robot arm. The position of the obstacle in the working space of the robot arm may be fixed, or it may be an object with a changing position, which is the static and dynamic obstacles mentioned above. The shape of the obstacle may also be a regular object or an irregular object. For irregular objects, it is necessary to construct a suitable bounding box when avoiding obstacles to ensure that all parts of the irregular object are included and the calculation is relatively simple when collision detection is required, thereby reducing the complexity of collision detection. Therefore, according to the above-mentioned obstacle characteristics, static and dynamic obstacle information is collected according to different collection strategies.
[0047] For the static obstacles in the robot workspace, they can be divided into three obstacle models: regular cylinders or square bodies and irregular objects. In the case where the obstacle is an irregular object, the polar points of the irregular object can be collected. For example, the polar points of the irregular object in four directions on the XY section can be collected. If the number of polar points is 3, the irregular object can be fitted into a cylinder. If the number of polar points is 4, the irregular object can be fitted into a square body, and the highest point of the irregular object in the Z axis, that is, the vertical direction, is taken as the height point; when the regular object or the regular object after fitting is a cylinder, any three points on the circumference of the cylinder cross section are taken as auxiliary points, and the center of the circle is determined according to the three auxiliary points, that is, the position of the target point, and any point on the highest plane of the cylinder in the Z axis direction is taken as the height auxiliary point. The position and occupied space information of the cylindrical obstacle are determined according to the three auxiliary points, the center of the circle and the height auxiliary point at this time. At this time, the space occupied by the cylinder is the obstacle collision area; when the regular object or the regular object after fitting is a square body, you can refer to Figure 2 way to handle it.
[0048] Figure 2 A schematic diagram of an obstacle collision area provided according to an embodiment of the present application is illustrated.
[0049] like Figure 2 As shown in the figure, when the regular object or the regular object after fitting is a square body, the four vertices of the square body are taken as auxiliary points, the center of the circle, that is, the target point, is determined according to the intersection of the diagonals, 1 / 2 of the diagonal length is taken as the radius r, and a point on the highest plane of the Z axis of the square body is taken as the height auxiliary point to collect the height h. The obstacle collision area at this time is determined according to the target point, radius r, height h and safety distance threshold; the safety distance threshold can be adjusted according to the degree of encirclement of the irregular object by the regular object after fitting.
[0050] For dynamic obstacles in the working space of the robot arm, a laser radar can be optionally used to scan the working space to obtain them. In the embodiment of the present application, a 3D laser radar is selected as a scanning device to scan objects on the operating path of the robot arm. Optionally, the 3D laser radar can be installed on the clamping part of the robot arm or the movable base at the bottom. It is determined whether it is a dynamic obstacle based on the obstacle contour information and position information obtained by the scan. If it is a dynamic obstacle, multiple polar points are obtained as auxiliary points based on the contour. The minimum enclosing cylinder of the dynamic obstacle is determined as the dynamic obstacle collision area based on the multiple auxiliary points and the safety distance threshold. The position information of the dynamic obstacle is continuously collected, and the speed and movement direction of the dynamic obstacle are calculated.
[0051] Return to reference Figure 1 For step S303, the path of the first motion trajectory moving to the front of the conveyor belt can be optimized according to the static obstacle information of the robot arm workspace, and the optimal path without collision with the static obstacle is selected. During the movement of the robot arm, the trajectory intersection where the two may collide is calculated by obtaining the speed and movement direction of the dynamic obstacle and the collision area of the dynamic obstacle, and the robot arm is accelerated or decelerated in advance to avoid the dynamic obstacle. Finally, the path for the robot arm gripping part to move to a safe position above the conveyor belt is planned according to the information such as the height of the conveyor belt, the size information of the item box, the orientation information, etc., and the time optimal path can be calculated by using the 3-5-3 polynomial interpolation function and the cuckoo search algorithm.
[0052] In step S400, S401 obtains target item box information and distance information, wherein the distance information is the distance between the target item box and the next item box on the conveyor belt. S402 generates a second motion trajectory according to the mathematical model of the robot arm, the conveyor belt information, the target item box information and the distance information. S403 generates a third motion trajectory according to the mathematical model of the robot arm, the spatial dimension information and position information of the stacking area, and the static obstacle information of the robot arm workspace. The third motion trajectory is optimized based on the dynamic obstacle information of the robot arm workspace.
[0053] It is understandable that the clamping part of the robot arm is equipped with a camera, which can be used for image analysis and recognition. The clamping part can also be equipped with the above-mentioned laser radar for dynamic obstacle detection. The radar scans the item boxes on the assembly line, that is, the item boxes closest to the clamping part of the robot arm, to obtain the size information of the item boxes. When the size information of the item box is not unique, the specific classification of the item box is determined by image recognition taken by the camera; the distance between the next item box and the item box is obtained by radar, and the time threshold for the robot arm to grasp the item box can be calculated based on the speed of the conveyor belt and the distance between the two item boxes. The time of the robot arm's grasping action must be less than the time threshold, and the lifting height after grasping must be greater than the height of the next item box or the clamping part of the robot arm leaves the conveyor belt area. At the same time, the movement ability of the robot arm and the load-bearing capacity of each joint must be considered. Based on the above constraints, according to the mathematical model of the robot arm, the 3-5-3 polynomial interpolation function and the cuckoo search algorithm are used to plan the path of the robot arm when grasping, that is, the second motion trajectory, with time optimization as the prerequisite.
[0054] Then the palletizing operation is divided into the following situations:
[0055] (1) When the grasped classified item box is being palletized for the first time, since there is no corresponding palletizing substrate in the record, the nearest palletizing substrate can be found based on the idle palletizing substrate and the position of the robot arm at this time. The palletizing substrate selected at this time is the target position;
[0056] (2) When the grasped classified item box is not the first palletizing operation, the corresponding palletizing substrate can be searched in the record. If the height of the palletizing substrate has not reached the maximum value or the height has reached the maximum but there is an empty position on the top layer, that is, it has not been marked as completed, the substrate is still selected as the target palletizing position; if the palletizing substrate is marked as completed, the palletizing substrate that is empty and closest to the robot arm is selected.
[0057] At this time, the target stacking substrate is used as the end point of the path planning. The minimum envelope of the robot arm is determined according to the mathematical model of the robot arm. The neural network algorithm is used to plan the path of the robot arm to move to the target stacking substrate to avoid static obstacles. According to the dynamic obstacle information obtained and the constructed collision area, the possibility of collision and the intersection of the collision trajectory are detected, and the trajectory of the robot arm moving to the target stacking substrate is optimized to avoid dynamic obstacles. When the robot arm stacks the box, the movement of the robot arm is planned according to the arrangement rules calculated in advance and the placement status at this time. At this time, the third motion trajectory planning is completed. Record the size change information of the substrate. When the height of the substrate reaches the set maximum value and there is no gap in the top layer, mark this substrate as completed.
[0058] Below, reference Figure 3 To describe the full trajectory planning system of the robotic arm according to an embodiment of the present application.
[0059] Figure 3 The figure shows a schematic diagram of a full trajectory planning system for a robotic arm provided according to an embodiment of the present application.
[0060] like Figure 3 As shown, the full trajectory planning system of the robotic arm according to an embodiment of the present application may include:
[0061] The first determination module is used to classify and determine the stacking arrangement according to the acquired spatial size information and position information of the stacking area, the information of the to-be-stacked object boxes and the conveyor belt information, and includes the following units:
[0062] A first acquisition unit is used to acquire spatial dimension information and position information of the stacking area, information of the object boxes to be stacked, and information of the conveyor belt. For pattern information of the object boxes, patterns on multiple surfaces can be acquired to ensure that specific classification information of the object boxes on the conveyor belt can be accurately identified;
[0063] The first classification unit is used to classify the palletized boxes based on size and pattern. The initial classification is performed based on the size of the boxes. When the length, width and height of the boxes are consistent, the secondary classification is performed based on the pattern information of the boxes.
[0064] A first calculation unit is used to determine the stacking arrangement by calculation according to the spatial dimension information of the stacking area and the dimension information of the object boxes to be stacked, and to calculate the number of layers that can be placed according to the maximum allowable height of the stacking base plate and the height of the object boxes, and to record and save the stacking arrangement and the number of layers that can be placed for each classification of object boxes;
[0065] A first acquisition module, used to acquire parameter information of the robotic arm;
[0066] The first building module is used to establish a mathematical model of the robotic arm using the DH model according to the parameter information of the robotic arm, and determine the posture information of the robotic arm, where the posture information of the robotic arm includes position and posture information;
[0067] The second acquisition module is used to obtain obstacle information in the robot workspace and construct the collision area, including:
[0068] A second acquisition unit is used to acquire static obstacle information of the robot arm workspace according to a static obstacle acquisition strategy, including fitting irregular objects into regular objects;
[0069] A third acquisition unit is used to acquire dynamic obstacle information in the workspace of the manipulator according to a dynamic obstacle acquisition strategy, including acquiring the speed and movement direction of the dynamic obstacle;
[0070] The first construction unit is used to construct an obstacle collision area according to obstacle information and a safety distance threshold. For a regular cylinder or a fitted regular cylinder, the safety distance threshold can be determined according to the degree of encirclement of the cylinder to the obstacle. For a case where the pole point is far from the periphery of the regular object, the minimum safety distance threshold can be taken. For a case where the pole point is close to the periphery of the regular object, the maximum safety distance threshold can be taken to construct the obstacle collision area. The safety distance threshold of a regular square body or a fitted regular square body can be operated in the same manner as above.
[0071] The third acquisition module is used to acquire target object box information and distance information, including a camera unit, a sensor acquisition unit, and a recognition and calculation unit, to acquire the size and pattern information of the target object box and the distance information to the next object box, to acquire the corresponding classification and stacking arrangement from the stored object box classification according to the size and pattern information of the target object box, to acquire the corresponding stacking substrate or to allocate the nearest idle stacking substrate, and to calculate the maximum time threshold of the robot arm grasping action;
[0072] A first trajectory planning module, used to generate a first motion trajectory according to a mathematical model of the robot arm and conveyor belt information, and optimize the first motion trajectory based on obstacle information in a workspace of the robot arm;
[0073] A second trajectory planning module, used for generating a second motion trajectory according to a mathematical model of the robot arm, conveyor belt information, target object box information and distance information;
[0074] A third trajectory planning module is used to generate a third motion trajectory according to a mathematical model of the robot arm, spatial size information and position information of the stacking area, and static obstacle information of the robot arm workspace, and optimize the third motion trajectory based on the dynamic obstacle information of the robot arm workspace;
[0075] The storage module may include a RAM (Random-Access Memory) memory and a non-volatile memory, which are used to store various basic parameter information, classification and calculation result information, trajectory planning information, and stacking space change information.
[0076] The specific functions and operations of each module and each unit in the module in the full trajectory planning system of the above-mentioned robotic arm have been introduced in detail in the full trajectory planning method of the robotic arm described above, so their repeated description will be omitted here.
[0077] In addition, an embodiment of the present application may also be a computer-readable storage medium, on which instructions executable by the full trajectory planning system of the robotic arm described above in this specification are stored, and when the instructions are executed by a processor included in the full trajectory planning system of the robotic arm described above in this specification, the instructions are used to implement the full trajectory planning method of the robotic arm as described in the embodiment of the present specification.
[0078] The basic principles of the present application are described above in conjunction with specific embodiments. It should be understood that the specific details disclosed above are only for illustration and ease of understanding, and are not restrictive, and are not used to limit the scope of protection of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of protection of the present invention.
Claims
1. A full trajectory planning method for a robotic arm, which is applied to the stacking and placement of items on a transport line, characterized in that: The method comprises: Acquire spatial dimension information and position information of the stacking area, information of the object boxes to be stacked, and information of the conveyor belt, classify the object boxes to be stacked according to the classification standard, and determine the stacking arrangement according to the classified object boxes and the spatial dimension information of the stacking area; Acquire parameter information of the robotic arm, establish a mathematical model of the robotic arm using the DH model according to the parameter information of the robotic arm, and determine the initial position information of the robotic arm; Generate a first motion trajectory according to the mathematical model of the robot and the conveyor belt information, obtain obstacle information of the robot workspace, and optimize the first motion trajectory according to the obstacle information of the robot workspace; the obstacle information of the robot workspace includes static obstacle information and dynamic obstacle information, and the obstacle information of the robot workspace is acquired according to the obstacle information acquisition strategy; Obtain target item box information and distance information, where the distance information is the distance between the target item box and the next item box on the conveyor belt, generate a second motion trajectory according to the mathematical model of the robot arm, the conveyor belt information, the target item box information and the distance information, generate a third motion trajectory according to the mathematical model of the robot arm, the spatial size information and position information of the stacking area, and the static obstacle information of the robot arm workspace, and optimize the third motion trajectory based on the dynamic obstacle information of the robot arm workspace.
2. The full trajectory planning method of a robotic arm as claimed in claim 1, characterized in that: The spatial dimension information of the stacking area includes the length and width of the stacking substrate, the initial height of the substrate and the maximum placement height of the substrate; the position information of the stacking area includes the position coordinates of the stacking substrate and the distance between the substrates; the information of the item box to be stacked includes the length, width, height and pattern information of the item box; the conveyor belt information includes the length, width, height, position and speed information of the conveyor belt; the classification standard is to classify according to the size information and pattern of the item box.
3. The full trajectory planning method of a robotic arm according to claim 1, characterized in that: The parameter information of the robot arm includes the angle between adjacent connecting rods, the distance between adjacent connecting rods, the connecting rod torsion angle, the connecting rod length, the end position of the robot arm and the rotation speed of each joint.
4. The full trajectory planning method of a robotic arm as claimed in claim 1, characterized in that: The obstacle information collection strategy includes static obstacle information collection strategy and dynamic obstacle information collection strategy.
5. The full trajectory planning method of a robot arm as claimed in claim 4, characterized in that: The static obstacle collection strategy is to determine multiple auxiliary points according to the obstacle model, determine the target point according to the multiple auxiliary points, and collect the obstacle position and spatial information according to the multiple auxiliary points and the target point; Determining the plurality of auxiliary points according to the obstacle model includes: when the obstacle model is an irregular object, fitting the irregular object into a cylinder or a square; Any three points on the circumference of the cross section of the cylinder or the four vertices of the square body are determined as auxiliary points, and any point on the highest plane of the cylinder or square body is used as a height auxiliary point.
6. The full trajectory planning method of a robot arm as claimed in claim 4, characterized in that: The dynamic obstacle collection strategy is to collect multiple auxiliary points of dynamic obstacles, build a dynamic obstacle collision area according to the multiple auxiliary points and a safety distance threshold, and collect the speed and motion trajectory information of the dynamic obstacles.
7. The full trajectory planning method of a robot arm as claimed in claim 1, characterized in that: When the stacking area changes, the item box information and space size change information of each stacking substrate are recorded respectively, and when the height of a certain stacking substrate reaches the maximum placement height and there is no gap in the top layer, the stacking substrate is marked as completed; when the item box to be stacked and the item box placed on the completed stacking substrate are the same category item boxes, a new stacking substrate is selected.
8. A full trajectory planning system for a robotic arm, characterized in that: The system comprises: The first determination module is used to classify and determine the stacking arrangement according to the acquired spatial size information and position information of the stacking area, the information of the to-be-stacked object boxes and the conveyor belt information, and includes the following units: A first acquisition unit is used to acquire spatial dimension information and position information of the palletizing area, information of the to-be-palletized object boxes, and information of the conveyor belt; A first sorting unit is used to sort the palletized object boxes based on size and pattern; A first calculation unit, used to determine the stacking arrangement through calculation according to the spatial dimension information of the stacking area and the dimension information of the object boxes to be stacked; A first acquisition module, used to acquire parameter information of the robotic arm; The first building module is used to establish a mathematical model of the robotic arm using the DH model according to the parameter information of the robotic arm to determine the position information of the robotic arm; The second acquisition module is used to obtain obstacle information in the robot workspace and construct the collision area, including: A second acquisition unit, used to acquire static obstacle information of the robot arm workspace according to a static obstacle acquisition strategy; A third acquisition unit, used to acquire dynamic obstacle information of the robot arm workspace according to a dynamic obstacle acquisition strategy; A first construction unit is used to construct an obstacle collision area according to obstacle information and a safety distance threshold; The third acquisition module is used to obtain target item box information and distance information; A first trajectory planning module, used to generate a first motion trajectory according to a mathematical model of the robot arm and conveyor belt information, and optimize the first motion trajectory based on obstacle information in a workspace of the robot arm; A second trajectory planning module, used for generating a second motion trajectory according to a mathematical model of the robot arm, conveyor belt information, target object box information and distance information; A third trajectory planning module is used to generate a third motion trajectory according to a mathematical model of the robot arm, spatial size information and position information of the stacking area, and static obstacle information of the robot arm workspace, and optimize the third motion trajectory based on the dynamic obstacle information of the robot arm workspace; The storage module is used to store various basic parameter information, classification and calculation result information, trajectory planning information and stacking space change information.
9. A computer-readable storage medium storing instructions executable by the system of claim 8, characterized in that: When the instructions are executed by the processor included in the system described in claim 8, they are used to implement the full trajectory planning method for the robotic arm described in any one of claims 1-7.
Citation Information
Patent Citations
Mechanical arm trajectory planning method and device, electronic equipment and storage medium
CN112828890A
Mechanical arm stacking optimal space trajectory planning method
CN115488897A
Mechanical arm obstacle avoidance path planning method and system
CN116197915A
Mechanical arm obstacle avoidance path planning method in multi-obstacle environment
CN116834005A
Track planning method, device and equipment for mechanical arm, storage medium and product
CN117506906A
Cited By
Product detection method and device
CN121185348A
PCB placement collaborative planning method and system for multi-suction-head equipment
CN122602389A
Series mechanical arm obstacle avoidance trajectory planning method, series mechanical arm system and equipment
CN122723692A
