Carrying control system and method of carrying robot
By designing a handling control system in a wood factory, the problem of automatic handling robots not being able to identify the wood pile and avoid pollutants is solved, and intelligent identification and stable grabbing of wood is realized, improving the intelligence, safety and accuracy of handling is achieved. .
Patent Information
- Application Number
- CN202411275691.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-12
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2044-09-12
AI Technical Summary
Existing automatic handling robots cannot effectively identify the wood pile in the wood factory, resulting in unsafe handling and inability to avoid pollutants. It is easy to cause damage and processing errors when grabbing and placing wood.
A handling control system was designed, including waste treatment module, handling preparation module, wood grabbing module, route planning module, handling warning module, pollution monitoring module and wood placement module. By identifying the wood material and appearance, analyzing the stacking structure, Generate crawling methods and routes, detect personnel and pollutants, and adjust storage postures to improve the intelligence and safety of handling.
It realizes intelligent identification and stable pick-up of wood, ensures the safety and accuracy of the transport route, reduces the risk of pollution, and improves the storage stability of wood.
Smart Images

Figure CN119059262A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robot handling, and in particular to a handling control system and method of a handling robot. Background Art
[0002] With the continuous advancement of science and technology, robots have been widely used in industrial production and service fields. Whether it is automobile production, logistics warehousing or agricultural production, robots have become an important production tool.
[0003] In the prior art, in lumber mills, the transportation of wood is generally done manually or using related equipment. Compared with manual labor, the efficiency of using equipment to transport raw wood is greatly improved, but the equipment transportation still needs to be operated by human workers, which consumes a lot of manpower. On the one hand, the existing automatic handling robots are based on the set handling program to perform mechanical repetitive operations, and cannot identify the wood pile, which may cause the collapse of the wood pile and cause safety hazards. On the other hand, during the transportation process, they cannot issue clear safety warnings to the surrounding workers, and cannot avoid pollutants such as sewage during the transportation process, which will cause danger to the workers and pollution to the wood. When placing the wood, the mechanical grasping and placement will not only damage the wood, but also may cause errors in wood processing due to slight differences in the placement position. Summary of the invention
[0004] The object of the present invention is to provide a handling control system and method for a handling robot to solve the problems just mentioned in the above background technology.
[0005] In a first aspect, the present application provides a handling control system of a handling robot, the system comprising:
[0006] Waste treatment module: used to establish a treatment area, identify wood, obtain wood material data, and analyze whether the wood has deteriorated based on the wood material data. If the wood is found to be deteriorated, the wood is marked as waste wood and the waste wood is transported to the treatment area. If the wood is judged not to be deteriorated, the wood is marked as target wood;
[0007] Handling preparation module: used to obtain the wood information of the target wood to be processed, obtain the wood shape data based on the wood information, and select the target gripper according to the wood shape data and automatically replace it;
[0008] Wood grabbing module: used to obtain the stacking structure of the wood pile and the target position of the target wood in the wood pile, analyze the stacking structure, generate a grabbing method for the target wood, and grab the target wood based on the grabbing method;
[0009] Route planning module: used to obtain map information of the timber mill, obtain the stacking location of the timber and the processing location of the target timber based on the map information, and generate a timber transportation route by combining the map information, the stacking location and the processing location;
[0010] Handling warning module: used to obtain the horizontal and vertical lengths of the target wood and the handling robot during the handling process based on the grasping method and the wood shape data; project the occupied area and the travel route in front of the handling robot based on the horizontal and vertical lengths, detect whether there are people around, and issue an alarm if people are detected around;
[0011] Pollution monitoring module: used to monitor the route in real time and analyze whether there are pollutants. If pollutants are found, the pollution impact value of the pollutants on the target wood is obtained; it is determined whether the value of the pollution impact value is greater than a preset pollution impact threshold. If it is determined that the value of the pollution impact value is greater than the threshold, the pollutants are avoided;
[0012] Wood placement module: used to obtain the wood storage method at the processing position, identify the surface of the target wood, obtain the surface characteristics of the target wood, and adjust the storage posture of the target wood based on the surface characteristics and the wood storage method.
[0013] By adopting the above technical solution, the target information of the target wood is obtained, the shape data of the wood is obtained, and according to the shape data of the wood, the handling robot automatically selects a gripper that matches it for automatic replacement, identifies the target wood when grabbing the wood, analyzes whether the target wood is deteriorated, places the deteriorated wood in the processing area, obtains the stacking structure of the wood pile, and generates a grabbing method for the target wood according to the stacking structure, obtains the map information of the wood factory, the stacking position of the wood pile and the processing position of the target wood, and generates a handling route for the target according to the above content. During the handling process, according to the shadow area swept by the handling robot and the wood during the movement, the laser in front of the handling robot projects the occupied area and the travel route, detects whether there are people around, and issues a sound alarm, identifies pollutants on the route during the movement, and judges the pollution impact value of the pollutants on the target wood. If the pollution impact value is too large, avoid the pollutants, and when arriving at the processing position, identify the surface of the wood, obtain the surface characteristics, and adjust the placement of the target wood according to the surface characteristics. The intelligence, safety and accuracy of the handling robot when handling wood have been improved.
[0014] Preferably, the waste treatment module comprises a wood identification unit and a waste treatment unit;
[0015] The wood identification unit is used to identify the wood, obtain the wood material data of the wood, and analyze and process the wood material data to obtain the current state of the wood;
[0016] Based on the current state, analyzing whether the wood has deteriorated, if the analysis shows that the wood has deteriorated, marking the wood as waste wood, if the analysis shows that the wood has not deteriorated, marking the wood as target wood;
[0017] The waste treatment unit is used to establish a treatment area and transport the waste wood to the waste area for centralized treatment.
[0018] By adopting the above technical solution, the target wood is identified, the material data of the target wood is obtained, and the target wood is analyzed based on the material data to see whether it has deteriorated, and the deteriorated waste wood is transported to a pre-set processing area, thereby improving the reliability of wood transportation and processing.
[0019] Preferably, the handling preparation module includes a shape analysis unit and a gripper replacement unit;
[0020] The shape analysis unit is used to obtain wood information of the target wood to be processed, and obtain wood shape data based on the wood information;
[0021] Analyze the wood shape data to obtain shape features of the target wood, obtain stability features of the target wood based on the shape features, and obtain a target gripper for grasping the target wood according to the stability features;
[0022] The gripper replacement unit also includes a gripper storage component and an automatic replacement component;
[0023] The gripper storage assembly is used to store grippers of different types;
[0024] The automatic replacement component is used to select a target gripper and automatically connect the target gripper to the handling robot.
[0025] By adopting the above technical solution, the wood information of the target wood is obtained, and the wood shape data is obtained according to the wood information, and the shape characteristics of the wood are further obtained. The stability characteristics of the target are obtained according to the shape characteristics of the wood, and the grasping method of the wood is generated according to the stability characteristics. Based on the grasping method of the wood, the handling robot is called to automatically replace the gripper component. This improves the meticulousness and pertinence of the preparatory work before handling wood.
[0026] Preferably, the wood grabbing module includes a structure analysis unit and a grabbing mode generation unit;
[0027] The structural analysis unit is used to obtain the stacking structure of the wood pile, analyze the stacking structure, and obtain the wood force diagram of the wood pile;
[0028] Based on the wood force diagram, analyzing the key support points of the wood pile, and obtaining the grabbing order of the wood according to the key support points;
[0029] The grasping mode generating unit is used to sequentially obtain the center of gravity position and stacking posture of the target wood according to the grasping sequence;
[0030] Based on the center of gravity position and the stacking posture, a grasping angle and a grasping position of the target wood are determined, and a grasping method is generated based on the grasping angle and the grasping position, and the target wood is grasped based on the grasping method
[0031] By adopting the above technical solution, the stacking structure of the wood pile is obtained, and the wood force diagram of the wood pile is obtained. The key support points of the wood pile are obtained according to the wood force diagram. The wood grabbing order is obtained according to the position of the key support points. The center of gravity position and stacking posture of each target wood are determined according to the grabbing order. The grabbing angle and grabbing position are determined according to the center of gravity position and stacking posture, and the grabbing method is generated. The stability of the wood pile and each grabbed wood is improved in the process of grabbing the target wood.
[0032] Preferably, the route planning module includes a map information processing unit and a route generating unit;
[0033] The map information processing unit is used to obtain map information of the timber factory and obtain a route map for passage based on the map information;
[0034] The route generation unit is used to obtain the stacking position of the wood and the processing position of the target wood, and obtain multiple initial transportation routes by combining the stacking position, the processing position and the route map;
[0035] The multiple initial transport routes are analyzed to obtain the road complexity and route length of each initial transport route respectively, and the multiple initial transport routes are screened based on the road complexity and route length to obtain the wood transport route.
[0036] By adopting the above technical solution, the map information of the lumber mill is obtained, the route map for passing through the lumber mill is obtained, and then the stacking position of the wood pile and the processing position of the target wood are obtained. Multiple initial transportation routes are obtained in combination with the route map, and the road complexity and route length of each initial transportation route are obtained. The initial transportation route with low road complexity and short route is selected as the wood transportation route. The comprehensiveness and meticulousness of route planning when transporting wood are improved.
[0037] Preferably, the handling warning module includes a detection unit and a warning unit;
[0038] When the detection unit is used to transport the target wood, the target wood and the transport robot are regarded as a transport whole, and the horizontal length and the vertical length of the transport whole and the travel route of the transport whole are detected and obtained;
[0039] With the entire transport as the center, the system detects the surrounding area to analyze whether there are people. If the system finds that there are people, it outputs a personnel signal.
[0040] The warning unit includes a light warning component and a sound warning component;
[0041] The light warning component is used to obtain the shadow swept by the transport unit on the ground within the next three seconds according to the horizontal length and the vertical length of the transport unit;
[0042] Obtaining the shape and size of the shadow, and based on the shape and size, projecting a laser on the ground ahead of the moving route of the transport as a whole to generate a warning area;
[0043] The sound warning component is used to send a sound warning to other personnel according to the acquired personnel information.
[0044] By adopting the above technical solution, when transporting wood, the wood and the transport robot are regarded as a transport unit, the horizontal length and vertical length of the transport unit are obtained, and the shadow swept by the transport unit in the next three seconds during the transport process is obtained based on the horizontal length and vertical length. The shadow is projected on the ground in front of the moving route of the transport unit using laser, and at the same time, it is detected whether there are people around the transport unit. If there are people, an audible alarm is issued. The safety and warning of the transport robot in the process of transporting wood are improved.
[0045] Preferably, the pollution monitoring module includes a pollution identification unit and a judgment control unit;
[0046] The pollution identification unit is used to monitor the travel route in real time, obtain monitoring data, and analyze the monitoring data to determine whether there are pollutants. If pollutants are found to be present, the pollution type of the pollutants is obtained.
[0047] The judgment control unit is used to simulate the simulated pollution degree of the target wood after being polluted according to the pollutant, and obtain the pollution impact value of the pollutant on the target wood based on the simulated pollution degree and the pollution type;
[0048] Determining whether the pollution impact value is greater than a preset pollution impact threshold;
[0049] If it is determined that the pollution impact value is greater than the threshold, the pollution position of the pollutant is obtained;
[0050] Based on the contamination location, the affected transport route segment is obtained, and the transport route segment is adjusted to avoid the contaminant.
[0051] By adopting the above technical solution, when the handling robot is carrying wood, the robot's route is monitored in real time, the pollutants that may exist on the handling route are obtained, the pollution introspection of the pollutants is obtained, and the degree of pollution of the wood after being polluted by the pollutants is simulated. The pollution impact value is obtained by combining the pollution degree and pollution type. If the pollution impact value exceeds the preset threshold, the pollution location is obtained, and the handling route section is adjusted to avoid the pollutants. The probability of wood being contaminated during the handling process is reduced.
[0052] Preferably, the wood placement module includes a surface recognition unit and a placement unit;
[0053] The surface recognition unit is used to obtain surface data of the target wood, analyze the surface data, and obtain surface features of the target wood;
[0054] The placement unit is used to obtain the wood storage method at the processing position and analyze the stability value of the target wood when it is stored according to the surface characteristics;
[0055] Determining whether the value of the stability value is lower than a preset stability threshold;
[0056] If it is determined that the value of the stable value is less than the Stablize threshold, the placement posture of the target wood is obtained according to the surface feature analysis of the target wood, and the posture of the target wood is adjusted based on the placement posture.
[0057] By adopting the above technical solution, the surface data of the target wood is obtained, and then the surface characteristics are obtained, the storage method of the wood at the processing position is obtained, and the stability value of the wood when stored is obtained according to the surface characteristics. If the stability value is too low, the placement of the target wood is adjusted according to the surface characteristics of the target wood. The stability of the target wood stored at the processing position is improved.
[0058] In a second aspect, the present application provides a handling control method of a handling robot, the method comprising the following steps:
[0059] Establishing a processing area, identifying the wood, obtaining wood material data, and analyzing whether the wood has deteriorated based on the wood material data; if the analysis shows that the wood has deteriorated, marking the wood as waste wood and transporting the waste wood to the processing area; if the analysis shows that the wood has not deteriorated, marking the wood as target wood;
[0060] Acquire wood information of the target wood to be processed, obtain wood shape data based on the wood information, and select a target gripper according to the wood shape data and automatically replace it;
[0061] Acquire a stacking structure of a wood pile and a target position of a target wood in the wood pile, analyze the stacking structure, generate a grabbing method for the target wood, and grab the target wood based on the grabbing method;
[0062] Obtaining map information of the lumber mill, obtaining the stacking location of the lumber and the processing location of the target lumber based on the map information, and generating a lumber transportation route by combining the map information, the stacking location, and the processing location;
[0063] Based on the grasping method and the shape data of the wood, the horizontal length and the vertical length of the target wood and the handling robot during the handling process are obtained; based on the horizontal length and the vertical length, the occupied area and the travel route are projected in front of the handling robot to detect whether there are people around, and if it is detected that there are people around, an alarm is issued;
[0064] Real-time monitoring of the travel route is performed to analyze whether there are pollutants. If the pollutants are found to be present, the pollution impact value of the pollutants on the target wood is obtained; it is determined whether the value of the pollution impact value is greater than a preset pollution impact threshold value. If it is determined that the value of the pollution impact value is greater than the threshold value, the pollutants are avoided;
[0065] The wood storage method at the processing position is obtained, the surface of the target wood is identified, the surface characteristics of the target wood are obtained, and the storage posture of the target wood is adjusted in combination with the surface characteristics and the wood storage method.
[0066] In summary, the present application includes at least one of the following beneficial technical effects:
[0067] 1. Obtain the target information of the target wood, obtain the shape data of the wood, and according to the shape data of the wood, the handling robot automatically selects the gripper that matches it for automatic replacement, identifies the target wood when grabbing the wood, analyzes whether the target wood is deteriorated, places the deteriorated wood in the processing area, obtains the stacking structure of the wood pile, and generates the grabbing method of the target wood according to the stacking structure, obtains the map information of the wood factory, the stacking position of the wood pile and the processing position of the target wood, and generates the handling route of the target according to the above content. During the handling process, according to the shadow area swept by the handling robot and the wood during the movement, the laser in front of the handling robot projects the occupied area and the travel route, detects whether there are people around, and issues a sound alarm. During the movement, the pollutants on the route are identified, and the pollution impact value of the pollutants on the target wood is judged. If the pollution impact value is too large, the pollutants are avoided. When arriving at the processing position, the surface of the wood is identified, the surface characteristics are obtained, and the placement of the target wood is adjusted according to the surface characteristics. The intelligence, safety and accuracy of the handling robot when handling wood have been improved.
[0068] 2. Obtain the stacking structure of the wood pile and obtain the wood force diagram of the wood pile. According to the wood force diagram, obtain the key support points of the wood pile. According to the position of the key support points, obtain the wood grabbing order. According to the grabbing order, determine the center of gravity position and stacking posture of each target wood. According to the center of gravity position and stacking posture, determine the grabbing angle and grabbing position, and generate the grabbing method. Improve the stability of the wood pile and each grabbed wood in the process of grabbing the target wood.
[0069] 3. When transporting wood, the wood and the transport robot are regarded as a transport unit, and the horizontal and vertical lengths of the transport unit are obtained. Based on the horizontal and vertical lengths, the shadow swept by the transport unit in the next three seconds during the transport process is obtained, and the shadow is projected on the ground in front of the route of the transport unit using lasers. At the same time, it is detected whether there are people around the transport unit. If there are people, an audible alarm is issued. This improves the safety and warning of the transport robot in the process of transporting wood. BRIEF DESCRIPTION OF THE DRAWINGS
[0070] Figure 1 It is a module block diagram of a handling control system of a handling robot provided in an embodiment of the present application;
[0071] Figure 2 It is a step flow chart of a handling control method of a handling robot provided in an embodiment of the present application.
[0072] Explanation of the accompanying drawings: 1. Waste disposal module; 2. Transportation preparation module; 3. Wood grabbing module; 4. Route planning module; 5. Transportation warning module; 6. Pollution monitoring module; 7. Wood placement module. DETAILED DESCRIPTION
[0073] The following is combined with Figure 1-2 The present application is further described in detail, but the embodiments of the present invention are not limited thereto.
[0074] The embodiments of the present application disclose a handling control system and method for a handling robot.
[0075] In this embodiment, refer to Figure 1 , a handling control system of a handling robot, the system comprising:
[0076] Waste treatment module 1: used to establish a treatment area, identify wood, obtain wood material data, and analyze whether the wood has deteriorated based on the wood material data. If the wood is found to be deteriorated, the wood is marked as waste wood and transported to the treatment area. If the wood is judged not to be deteriorated, the wood is marked as target wood;
[0077] Handling preparation module 2: used to obtain the wood information of the target wood to be processed, obtain the wood shape data based on the wood information, and select the target gripper according to the wood shape data and automatically replace it;
[0078] Wood grabbing module 3: used to obtain the stacking structure of the wood pile and the target position of the target wood in the wood pile, analyze the stacking structure, generate a grabbing method for the target wood, and grab the target wood based on the grabbing method;
[0079] Route planning module 4: used to obtain map information of the timber mill, obtain the stacking location of the timber and the processing location of the target timber based on the map information, and generate a timber transportation route by combining the map information, the stacking location and the processing location;
[0080] Transport warning module 5: used to obtain the horizontal and vertical lengths of the target wood and the transport robot during the transport process based on the grasping method and the wood shape data; project the occupied area and the travel route in front of the transport robot based on the horizontal and vertical lengths, detect whether there are people around, and issue an alarm if people are detected around;
[0081] Pollution monitoring module 6: used to monitor the travel route in real time, analyze whether there are pollutants, and if it is analyzed that there are pollutants, obtain the pollution impact value of the pollutants on the target wood; judge whether the pollution impact value is greater than a preset pollution impact threshold, and if it is judged that the pollution impact value is greater than the threshold, avoid the pollutants;
[0082] Wood placement module 7: used to obtain the wood storage method of the processing position, identify the surface of the target wood, obtain the surface characteristics of the target wood, and adjust the storage posture of the target wood based on the surface characteristics and the wood storage method.
[0083] It should be pointed out that the above modules are only basic modules of this embodiment. In the specific implementation process, some modules can be appropriately added, reduced or modified without affecting the overall implementation effect.
[0084] Reference Figure 1 , the waste treatment module 1 includes a wood identification unit and a waste treatment unit;
[0085] The wood identification unit is used to identify the wood, obtain the wood material data of the wood, and analyze and process the wood material data to obtain the current state of the wood;
[0086] Based on the current state, analyze whether the wood has deteriorated. If the analysis shows that the wood has deteriorated, the wood is marked as waste wood. If the analysis shows that the wood has not deteriorated, the wood is marked as target wood.
[0087] The waste treatment unit is used to establish a treatment area and transport the waste wood to the waste area for centralized treatment.
[0088] In use, if a timber factory needs to transport a batch of logs from a stacking point to a processing point, before grabbing the logs, the material data of the logs is obtained. If it is found that the current state of the logs is deteriorated and cannot be processed, they will be marked as waste wood and transported to a waste area for centralized waste treatment.
[0089] Reference Figure 1 , the handling preparation module 2 includes a shape analysis unit and a gripper replacement unit;
[0090] The shape analysis unit is used to obtain wood information of the target wood to be processed, and obtain wood shape data based on the wood information;
[0091] Analyze the shape data of the wood to obtain the shape characteristics of the target wood, obtain the stability characteristics of the target wood based on the shape characteristics, and obtain the target gripper for grasping the target wood based on the stability characteristics;
[0092] The gripper replacement unit also includes a gripper storage assembly and an automatic replacement assembly;
[0093] The gripper storage assembly is used to store different types of grippers;
[0094] The automatic change component is used to select the target gripper and automatically connect the target gripper to the handling robot.
[0095] In use, if a timber factory needs to transport a batch of logs from a stacking point to a processing point, the timber information of the batch of logs is obtained, and the timber information is analyzed to obtain that the batch of timber is cylindrical, 2 meters long, and 40 centimeters in diameter. The stability characteristics of the timber are obtained based on the appearance characteristics of the batch of timber, and the timber grasping method is generated as a single-root grasping, and the timber is grasped from the center of gravity. The handling robot obtains the grasping method and determines that the current grasping component is inappropriate, and automatically replaces the grasping component with a special gripper for grasping cylindrical timber.
[0096] Reference Figure 1 , the wood grabbing module 3 includes a structure analysis unit and a grabbing mode generation unit;
[0097] The structural analysis unit is used to obtain the stacking structure of the wood pile, analyze the stacking structure, and obtain the wood force diagram of the wood pile;
[0098] Based on the wood force diagram, analyze the key support points of the wood pile and get the grabbing order of the wood according to the key support points;
[0099] The grasping mode generating unit is used to sequentially obtain the center of gravity position and stacking posture of the target wood according to the grasping sequence;
[0100] Based on the center of gravity position and stacking posture, the grabbing angle and grabbing position of the target wood are determined, and the grabbing method is generated based on the grabbing angle and grabbing position, and the target wood is grabbed based on the grabbing method
[0101] In use, if a lumber mill needs to move a batch of logs from a stacking point to a processing point, before grabbing the logs, the stacking structure of the batch of logs is obtained. It is found that the stacking structure of the batch of logs is scattered, and random grabbing may cause collapse. The wood force diagram of the log pile is obtained, and one of the logs is determined as the key support point based on the wood force diagram. The log above the log needs to be removed before it can be grabbed. The grabbing order of the logs is obtained, and the center of gravity position and stacking posture of each log are obtained according to the grabbing order. It is found that the center of gravity position is located in the middle section of the log, while the stacking postures of the logs are different. According to the center of gravity position and the stacking posture, the grabbing position is the middle section of the log, and the grabbing angle is adjusted according to the stacking posture.
[0102] Reference Figure 1 , the route planning module 4 includes a map information processing unit and a route generating unit;
[0103] The map information processing unit is used to obtain map information of the timber factory and obtain a route map for passage based on the map information;
[0104] The route generation unit is used to obtain the stacking position of the wood and the processing position of the target wood, and obtain multiple initial transportation routes by combining the stacking position, the processing position and the route map;
[0105] The multiple initial transport routes are analyzed to obtain the road complexity and route length of each initial transport route, and the multiple initial transport routes are screened based on the road complexity and route length to obtain the wood transport route.
[0106] In use, for example, if a lumber mill needs to transport a batch of logs from a stacking point to a processing point, and the map information of the lumber mill is obtained, it is found that the wood in the lumber mill is stacked in a rather scattered manner. Then, a route map for passage is obtained based on the map information, and then the stacking location and processing location of the logs are obtained, and multiple initial transportation routes are generated. After analyzing the multiple initial transportation routes, it is found that most routes have potholes or are slippery, and the routes are long. Then, the route with the best road conditions and the shortest route is selected as the wood transportation route.
[0107] Reference Figure 1 , the handling warning module 5 includes a detection unit and a warning unit;
[0108] When the detection unit is used to transport the target wood, the target wood and the transport robot are regarded as a transport whole, and the horizontal length and the vertical length of the transport whole and the travel route of the transport whole are detected and obtained;
[0109] With the entire transport as the center, the system detects the surrounding area to analyze whether there are people. If the system finds that there are people, it outputs a personnel signal.
[0110] The warning unit includes a light warning component and a sound warning component;
[0111] The light warning component is used to obtain the shadow swept by the transport unit on the ground in the next three seconds according to the horizontal length and vertical length of the transport unit;
[0112] Obtain the shape and size of the shadow, and based on the shape and size, project a laser on the ground in front of the moving route of the transport as a whole to generate a warning area;
[0113] The sound warning component is used to send a sound warning to other personnel based on the obtained personnel information.
[0114] In application, for example, a timber factory needs to transport a batch of logs from a stacking point to a processing point. During the transportation process, the transport robot and the logs are regarded as a transport entity. The length and width of the transport entity are obtained, and the shadow swept on the ground within three seconds is determined. According to the shape and size of the shadow, it is projected on the forward route of the transport entity to warn the surrounding personnel that the transport entity will pass through the projection area, and analyze whether there are people around. If there are people, a sound alarm will be issued to them to further enhance the warning intensity.
[0115] Reference Figure 1 , the pollution monitoring module 6 includes a pollution identification unit and a judgment control unit;
[0116] The pollution identification unit is used to monitor the travel route in real time, obtain monitoring data, and analyze the monitoring data to determine whether there are pollutants. If pollutants are found to be present, the pollution type of the pollutants is obtained.
[0117] The judgment control unit is used to simulate the degree of contamination of the target wood after the target wood is contaminated according to the contaminant, and obtain the contamination impact value of the contaminant on the target wood based on the simulated degree of contamination and the type of contamination;
[0118] Determine whether the pollution impact value is greater than a preset pollution impact threshold;
[0119] If it is determined that the pollution impact value is greater than the threshold, the pollution location of the pollutant is obtained;
[0120] Based on the pollution location, the affected transport route segment is obtained, and the transport route segment is adjusted to avoid the pollutants.
[0121] In use, for example, a timber factory needs to transport a batch of logs from a stacking point to a processing point. When the transport robot transports the logs, it monitors the route and finds a sewage point. If it passes through the sewage point, the sewage will be splashed onto the logs. After analysis, it is found that the amount of sewage splashed onto the logs by the sewage point is small, and the pollution impact value on the log processing is 15, which is lower than the preset pollution impact threshold of 10. The affected transport route section is determined according to the location of the pollutant, and the transport route section is adjusted to avoid the pollution location of the pollutant.
[0122] Reference Figure 1 , the wood placing module 7 includes a surface recognition unit and a placing unit;
[0123] The surface recognition unit is used to obtain the surface data of the target wood, analyze the surface data, and obtain the surface characteristics of the target wood;
[0124] The placement unit is used to obtain the wood storage method at the processing location and analyze the stability value of the target wood when it is stored according to the surface characteristics;
[0125] Determine whether the stability value is lower than a preset stability threshold;
[0126] If it is determined that the stability value is less than the stability threshold, the placement posture of the target wood is obtained according to the surface feature analysis of the target wood, and the posture of the target wood is adjusted based on the placement posture.
[0127] In application, for example, a lumber mill needs to move a batch of logs from a stacking point to a processing point. After the logs are moved to the processing position, there is a log placement space at the processing position. The logs need to be placed horizontally and stably in the space. However, after analyzing the surface of the log, it is found that there is a bulge on one side of the log, which makes the placement unstable. The stability value of the log when stored is 5, which is lower than the preset stability threshold of 10. In this case, the placement posture of the log is adjusted, with the bulged side facing up and the side without the bulge facing down, which can improve the stability of the log when placed.
[0128] Reference Figure 2 The embodiment of the present invention provides a handling control method of a handling robot, using any one of the handling control systems of the handling robot described above, the method comprising the following steps:
[0129] S100: Establishing a processing area, identifying the wood, obtaining the wood material data, and analyzing whether the wood has deteriorated based on the wood material data. If the analysis shows that the wood has deteriorated, the wood is marked as waste wood and the waste wood is transported to the processing area. If the analysis shows that the wood has not deteriorated, the wood is marked as target wood.
[0130] S200: Acquire wood information of the target wood to be processed, obtain wood shape data based on the wood information, select a target gripper according to the wood shape data and automatically replace it;
[0131] S300: acquiring a stacking structure of the wood pile and a target position of the target wood in the wood pile, analyzing the stacking structure, generating a grasping method for the target wood, and grasping the target wood based on the grasping method;
[0132] S400: Obtaining map information of the lumber mill, obtaining the stacking location of the lumber and the processing location of the target lumber based on the map information, and generating a lumber transportation route by combining the map information, the stacking location, and the processing location;
[0133] S500: Based on the grasping method and the wood shape data, the horizontal length and the vertical length of the target wood and the handling robot during the handling process are obtained; based on the horizontal length and the vertical length, the occupied area and the travel route are projected in front of the handling robot, and whether there are people around is detected. If the existence of people is detected around, an alarm is issued;
[0134] S600: Real-time monitoring of the travel route to analyze whether there are pollutants. If there are pollutants, the pollution impact value of the pollutants on the target wood is obtained. If the pollution impact value exceeds a preset threshold, the pollutants are avoided;
[0135] S700: Acquire the wood storage method at the processing position, identify the surface of the target wood, obtain the surface characteristics of the target wood, and adjust the storage posture of the target wood based on the surface characteristics and the wood storage method.
[0136] The above are all preferred embodiments of the present application, and the protection scope of the present application is not limited thereto. Therefore, any equivalent changes made according to the structure, shape, and principle of the present application should be included in the protection scope of the present application.
Claims
1. A handling control system for a handling robot, characterized in that: The system comprises: Waste treatment module (1): used to establish a treatment area, identify wood, obtain wood material data, and analyze whether the wood has deteriorated based on the wood material data. If the wood is found to be deteriorated, the wood is marked as waste wood and the waste wood is transported to the treatment area. If the wood is found to be not deteriorated, the wood is marked as target wood. Handling preparation module (2): used to obtain wood information of the target wood to be processed, obtain wood shape data based on the wood information, and select a target gripper according to the wood shape data and automatically replace it; A wood grabbing module (3): used for acquiring the stacking structure of the wood pile and the target position of the target wood in the wood pile, analyzing the stacking structure, generating a grabbing method for the target wood, and grabbing the target wood based on the grabbing method; Route planning module (4): used to obtain map information of the timber mill, obtain the stacking location of the timber and the processing location of the target timber based on the map information, and generate a timber transportation route by combining the map information, the stacking location and the processing location; A handling warning module (5) is used to obtain the horizontal length and the vertical length of the target wood and the handling robot during the handling process based on the grasping method and the wood shape data; project the occupied area and the travel route in front of the handling robot based on the horizontal length and the vertical length, detect whether there are people around, and issue an alarm if it is detected that there are people around; A pollution monitoring module (6) is used to monitor the travel route in real time and analyze whether there are pollutants. If the analysis shows that there are pollutants, the pollution impact value of the pollutants on the target wood is obtained; it is determined whether the pollution impact value is greater than a preset pollution impact threshold value. If it is determined that the pollution impact value is greater than the threshold value, the pollutants are avoided; Wood placement module (7): used to obtain the wood storage method at the processing position, identify the surface of the target wood, obtain the surface characteristics of the target wood, and adjust the storage posture of the target wood in combination with the surface characteristics and the wood storage method.
2. A handling control system for a handling robot according to claim 1, characterized in that: The waste treatment module (1) comprises a wood identification unit and a waste treatment unit; The wood identification unit is used to identify the wood, obtain the wood material data of the wood, and analyze and process the wood material data to obtain the current state of the wood; based on the current state, analyze whether the wood has deteriorated, if the analysis shows that the wood has deteriorated, the wood is marked as waste wood, if the analysis shows that the wood has not deteriorated, the wood is marked as target wood; The waste treatment unit is used to establish a treatment area and transport the waste wood to the waste area for centralized treatment.
3. The handling control system of a handling robot according to claim 1, characterized in that: The handling preparation module (2) comprises a shape analysis unit and a gripper replacement unit; The shape analysis unit is used to obtain wood information of the target wood to be processed, and obtain wood shape data based on the wood information; Analyze the wood shape data to obtain shape features of the target wood, obtain stability features of the target wood based on the shape features, and obtain a target gripper for grasping the target wood according to the stability features; The gripper replacement unit also includes a gripper storage component and an automatic replacement component; The gripper storage assembly is used to store grippers of different types; The automatic replacement component is used to select a target gripper and automatically connect the target gripper to the handling robot.
4. The handling control system of a handling robot according to claim 1, characterized in that: The wood grabbing module (3) comprises a structure analysis unit and a grabbing method generation unit; The structural analysis unit is used to obtain the stacking structure of the wood pile, analyze the stacking structure, and obtain the wood force diagram of the wood pile; Based on the wood force diagram, analyzing the key support points of the wood pile, and obtaining the grabbing order of the wood according to the key support points; The grasping mode generating unit is used to sequentially obtain the center of gravity position and stacking posture of the target wood according to the grasping sequence; Based on the center of gravity position and the stacking posture, a grasping angle and a grasping position of the target wood are determined, and a grasping method is generated based on the grasping angle and the grasping position, and the target wood is grasped based on the grasping method.
5. The handling control system of a handling robot according to claim 1, characterized in that: The route planning module (4) comprises a map information processing unit and a route generating unit; The map information processing unit is used to obtain map information of the timber factory and obtain a route map for passage based on the map information; The route generation unit is used to obtain the stacking position of the wood and the processing position of the target wood, and obtain multiple initial transportation routes by combining the stacking position, the processing position and the route map; The multiple initial transport routes are analyzed to obtain the road complexity and route length of each initial transport route respectively, and the multiple initial transport routes are screened based on the road complexity and route length to obtain the wood transport route.
6. The handling control system of a handling robot according to claim 1, characterized in that: The handling warning module (5) comprises a detection unit and a warning unit; When the detection unit is used to transport the target wood, the target wood and the transport robot are regarded as a transport whole, and the horizontal length and the vertical length of the transport whole and the travel route of the transport whole are detected and obtained; With the entire transport as the center, the system detects the surrounding area to analyze whether there are people. If the system finds that there are people, it outputs a personnel signal. The warning unit includes a light warning component and a sound warning component; The light warning component is used to obtain the shadow swept by the transport unit on the ground within the next three seconds according to the horizontal length and the vertical length of the transport unit; Obtaining the shape and size of the shadow, and based on the shape and size, projecting a laser on the ground ahead of the moving route of the transport as a whole to generate a warning area; The sound warning component is used to send a sound warning to other personnel according to the acquired personnel information.
7. The handling control system of a handling robot according to claim 1, characterized in that: The pollution monitoring module (6) comprises a pollution identification unit and a judgment control unit; The pollution identification unit is used to monitor the travel route in real time, obtain monitoring data, and analyze the monitoring data to determine whether there are pollutants. If pollutants are found to be present, the pollution type of the pollutants is obtained. The judgment control unit is used to simulate the simulated pollution degree of the target wood after being polluted according to the pollutant, and obtain the pollution impact value of the pollutant on the target wood based on the simulated pollution degree and the pollution type; Determining whether the pollution impact value is greater than a preset pollution impact threshold; If it is determined that the pollution impact value is greater than the threshold, the pollution position of the pollutant is obtained; Based on the contamination location, the affected transport route segment is obtained, and the transport route segment is adjusted to avoid the contaminant.
8. The handling control system of a handling robot according to claim 1, characterized in that: The wood placement module (7) comprises a surface recognition unit and a placement unit; The surface recognition unit is used to obtain surface data of the target wood, analyze the surface data, and obtain surface features of the target wood; The placement unit is used to obtain the wood storage method at the processing position and analyze the stability value of the target wood when it is stored according to the surface characteristics; Determining whether the stability value is less than a preset stability threshold; If it is determined that the stability value is less than the stability threshold, the placement posture of the target wood is obtained according to the surface feature analysis of the target wood, and the posture of the target wood is adjusted based on the placement posture.
9. A method for controlling a handling robot, the method being implemented based on a handling control system of a handling robot as claimed in any one of claims 1 to 8, characterized in that: The method comprises the following steps: Establishing a processing area, identifying the wood, obtaining wood material data, and analyzing whether the wood has deteriorated based on the wood material data; if the analysis shows that the wood has deteriorated, marking the wood as waste wood and transporting the waste wood to the processing area; if the analysis shows that the wood has not deteriorated, marking the wood as target wood; Acquire wood information of the target wood to be processed, obtain wood shape data based on the wood information, and select a target gripper according to the wood shape data and automatically replace it; Acquire a stacking structure of a wood pile and a target position of a target wood in the wood pile, analyze the stacking structure, generate a grabbing method for the target wood, and grab the target wood based on the grabbing method; Obtaining map information of the lumber mill, obtaining the stacking location of the lumber and the processing location of the target lumber based on the map information, and generating a lumber transportation route by combining the map information, the stacking location, and the processing location; Based on the grasping method and the shape data of the wood, the horizontal length and the vertical length of the target wood and the handling robot during the handling process are obtained; based on the horizontal length and the vertical length, the occupied area and the travel route are projected in front of the handling robot to detect whether there are people around, and if it is detected that there are people around, an alarm is issued; Real-time monitoring of the travel route is performed to analyze whether there are pollutants. If the pollutants are found to be present, the pollution impact value of the pollutants on the target wood is obtained; it is determined whether the value of the pollution impact value is greater than a preset pollution impact threshold value. If it is determined that the value of the pollution impact value is greater than the threshold value, the pollutants are avoided; The wood storage method at the processing position is obtained, the surface of the target wood is identified, the surface characteristics of the target wood are obtained, and the storage posture of the target wood is adjusted in combination with the surface characteristics and the wood storage method.
Citation Information
Patent Citations
Timber carrying robot and timber carrying operation method
CN113735023A
Waste material discrimination system and waste material discrimination method
CN115004011A
Building material transportation operation loading and unloading intelligent monitoring system based on vehicle synchronous cooperation
CN115215113A
AGV robot intelligent carrying control analysis system based on intelligent logistics warehouse management
CN115375130A
Crop straw grabbing and carrying robot path position control system
CN117841035A
