A heavy-load robot operation protection device and control method thereof
By designing an emergency protection mechanism and an operation buffer mechanism in a heavy load robot, combined with a damage detection module, the problems of safety accidents and mechanical damage during heavy objects transportation are solved, the protection of heavy objects and operators is achieved, and the operation of the robot is improved security and reliability.
Patent Information
- Application Number
- CN202411017139.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-29
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2044-07-29
AI Technical Summary
Safety accidents and mechanical damage caused by the gravity and inertia of the object during transportation increase operational hazards and production risks.
A running protection device including an emergency protection mechanism, an operation buffer mechanism and a damage detection module is designed. It uses steel cables, electromagnetic devices, buffer bases, springs and sensors to reduce weight through emergency braking, buffering and damage detection. The free fall rate and inertia force of the object protect the operators and robots.
It effectively reduces the danger of heavy objects falling and inertial forces to robots and operators, improves the operating safety and service life of heavy-load robots, and reduces faults and maintenance costs.
Smart Images

Figure CN118544395B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of industrial robots, and in particular to an operation protection device for a heavy-load robot and a control method thereof. Background Art
[0002] Heavy-duty robots are robots used to carry heavy objects or perform difficult tasks. They usually have more powerful motors and robotic arms to handle larger loads. They are especially used in industrial production and need to carry heavier metal workpieces. They can help reduce human labor output and improve production efficiency and safety. However, since the objects transported by heavy-duty robots have a large gravity, various safety accidents may occur during operation. For example, when a heavy-duty robot is carrying an object, the operation stops due to a certain fault. At this time, the heavy object will fall freely. If there are operators nearby, there will be a risk of accidental injury. In addition, during the handling process, the heavy-duty robot will generate a certain inertial force due to the different weight of the object and the rotation speed of the robotic arm. When the inertial force is large, the heavy object will be out of the grasp of the heavy-duty robot, and then the operator will be accidentally injured. In addition, excessive inertial force will also cause damage to the operating joints of the heavy-duty robot, which greatly increases the operational risk factor of the heavy-duty robot, which is not conducive to the production and handling requirements of heavy objects. Therefore, it is necessary to develop a device that can reduce or avoid the operational risk of the heavy-duty robot to solve the above problems. Summary of the invention
[0003] The present invention overcomes the shortcomings of the prior art and provides an operation protection device for a heavy-load robot and a control method thereof.
[0004] To achieve the above object, the technical solution adopted by the present invention is:
[0005] The present invention provides an operation protection device for a heavy-load robot, the operation protection device comprising an emergency protection mechanism, an operation buffer mechanism and a damage detection module:
[0006] The emergency protection mechanism comprises a drum frame, a rotating shaft is installed on the drum frame, a cable drum is fixed on the rotating shaft, a steel cable is wound on the cable drum, a first electromagnetic device is fixed at the end of the steel cable, and the first electromagnetic device is connected to a backup power supply;
[0007] The running buffer mechanism includes a buffer base, a connecting hole is provided in the middle of the buffer base for fixing to the grabbing joint of the heavy-load robot, the buffer base is hollow inside, a plurality of latch barrels are arranged inside the buffer base, a plurality of circular latch holes are longitudinally provided on the side wall of each latch barrel, a plurality of buffer column through holes are provided on the top of the buffer base, and each buffer column through hole is correspondingly placed directly above each latch barrel;
[0008] The damage detection module comprises a circular ring, a transmission gear ring is arranged on the side of the circular ring, the transmission gear ring is meshed with a gear, the gear is fixed on the output shaft of a stepper motor, and the stepper motor is fixed on the bottom of a rectangular slide.
[0009] Furthermore, in a preferred embodiment of the present invention, a brake disc is installed on one end of the rotating shaft, a brake groove is provided on the brake disc, an H-shaped plate is provided on the side of the brake groove, and the H-shaped plate is horizontally placed in the brake groove, one end of a connecting rod is welded to the bottom end of the H-shaped plate, the other end of the connecting rod is welded to the side of a fixed pile, and the fixed pile is provided on the operation damage detection mechanism, and a speed sensor is installed on the H-shaped plate.
[0010] Furthermore, in a preferred embodiment of the present invention, a cylinder is fixed on the fixing pile, a top end of an output rod of the cylinder is connected to a slide workpiece, and the slide workpiece is sleeved on the connecting rod.
[0011] Furthermore, in a preferred embodiment of the present invention, the slide workpiece is hinged on both sides with one end of the same connecting rod, the other end of the connecting rod is hinged to the bottom of the brake block, the brake block is provided with the same sliding grooves on both sides, the two sliding grooves are respectively connected to the same sliding rails, and the two sliding rails are respectively arranged on both sides of the groove of the H-shaped plate.
[0012] Furthermore, in a preferred embodiment of the present invention, a buffer column is passed through each of the latch tubes, a rotating member is welded to the top of the buffer column, the rotating member is installed in a rectangular through hole through a column pin, and the rectangular through hole is opened on the buffer disk.
[0013] Furthermore, in a preferred embodiment of the present invention, a pin latch module is installed at the bottom of the buffer column, and the pin latch module includes a pin latch disk, and circular holes are opened on both sides of the pin latch disk, and the two circular holes are used to limit the installation of pin latches, a second electromagnetic device is installed between the two pin latches, and a first spring is arranged between each pin latch and the pin latch disk.
[0014] Furthermore, in a preferred embodiment of the present invention, a plurality of second springs are connected between the buffer base and the buffer disk, and each of the second springs is respectively sleeved on the outside of each buffer column, and a pressure sensor is installed on the buffer base.
[0015] Furthermore, in a preferred embodiment of the present invention, two sets of guide wheels are installed at the bottom of the rectangular skateboard at the same time, and the two sets of guide wheels are respectively arranged on both sides of the circular guide rail, the circular guide rail is fixed above the circular ring, and an ultrasonic flaw detector is arranged on the top of the rectangular skateboard.
[0016] A second aspect of the present invention provides a control method for a heavy-load robot operation protection device, which is applied to any one of the heavy-load robot operation protection devices described above, and specifically comprises the following steps:
[0017] Obtain the weight information of the heavy object grabbed by the heavy-load robot, as well as the model and specification information of the heavy-load robot, the load joint combination information, and the handling path required for the heavy object production;
[0018] Based on the model specification information and the load joint combination information, several related handling schemes of the heavy-load robot are obtained in the big data network, and the optimal handling path corresponding to each handling scheme is extracted, and the Hamming distance between each optimal handling path and the handling path required for the heavy object production is calculated to obtain multiple Hamming distances;
[0019] Determine the fit rate between each transport control programming instruction and the transport path required for the heavy object production according to a plurality of Hamming distances, extract the transport control programming instruction corresponding to the maximum fit rate, and control the heavy-load robot to transport the heavy object according to the transport path required for the heavy object based on the transport control programming instruction corresponding to the maximum fit rate;
[0020] After handling, the operating parameters of the heavy-load robot are output, and the hierarchical analysis algorithm is introduced to calculate the weight value of each load joint of the heavy-load robot. Only the load joint with the maximum weight value is marked, which is defined as the key operating load joint;
[0021] Obtaining a preset inertia force reference coefficient of a key operating load joint, obtaining an actual inertia force coefficient by measuring the inertia force borne by the key operating load joint when the heavy-load robot carries a heavy object under the operating condition parameters, calculating a deviation between the actual inertia force coefficient and the inertia force reference coefficient, and obtaining a deviation value;
[0022] If the deviation value is greater than the preset deviation threshold, the first electromagnetic device is controlled to start based on the deviation value, and the ball pin on the buffer column is moved to a suitable circular pin hole in combination with the data of the pressure sensor to enhance the buffering during the transportation of heavy objects.
[0023] Furthermore, in a preferred embodiment of the present invention, the following steps are also included:
[0024] Based on the big data network, all preset fault feature vectors that cause the heavy-load robot to stop operating under different preset operating environment conditions and different preset operating conditions are obtained and integrated to obtain a fault feature vector database;
[0025] Acquire an operation record of the heavy-load robot, acquire a plurality of fault records of the heavy-load robot within a preset time period based on the operation record, extract an actual fault feature vector corresponding to each fault record, import the actual fault feature vector corresponding to each fault record into the fault feature vector database for matching, and generate a matching result;
[0026] If the matching result shows that the actual fault feature vector matches at least one corresponding preset fault feature vector in the fault feature vector database, the speed sensor is controlled to start, and the speed of the brake groove is monitored in real time to obtain a real-time monitoring result of the speed sensor;
[0027] Based on the weight information of the heavy object, a search is performed in the big data network. After the search is completed, the instantaneous speed reference value when the heavy object falls is obtained. If the instantaneous speed reference value is generated in the real-time monitoring result of the speed sensor, the cylinder output rod is controlled to extend so that the brake block contacts the inner wall of the brake groove to reduce the falling rate of the heavy object.
[0028] The beneficial technical effects of the present invention are:
[0029] The first electromagnetic device is controlled to be adsorbed on the heavy metal object. If the heavy metal object escapes from the grasp of the heavy-load robot and falls, the heavy metal object quickly stretches the steel cable, so that the cable drum drives the brake disc to rotate quickly. The cylinder is controlled to push the slide workpiece according to the monitoring data of the speed sensor, which can drive the two connecting rods to fold in the direction of the H-shaped plate, so that the two brake blocks can be synchronously controlled to slide out quickly to both sides of the H-shaped plate under the action of the slide groove and the slide rail. At this time, the brake blocks will contact and rub with the inner wall of the brake groove, and perform emergency braking and deceleration on the accelerated rotating brake disc, thereby reducing the free fall rate of the heavy object, realizing the protection effect of the heavy-load robot on the transportation of heavy objects, and avoiding the phenomenon of heavy objects falling and being damaged or accidentally injuring operators due to fault factors; the second electromagnetic device is controlled to start The magnetic force is generated to attract the pin latch. At this time, the inertial force exerted by the weight on the buffer disk causes the buffer column to drive the pin latch disk to gradually descend toward the bottom of the latch tube under the action of the inertial force of the weight, until the buffer column drives the pin latch disk to descend in the latch tube to the circular latch hole corresponding to the height that matches the inertial force. The second electromagnetic device is controlled to be closed, and under the action of the first spring, the two pin latches are synchronously reset and extended out of the pin latch disk. The two synchronously reset and popped out pin latches are inserted into the circular latch holes currently in the latch tube, so that the pin latch module is fixed in the buffer base, so as to adjust the buffer coefficient of the buffer disk according to the size of the inertial force exerted by different weights, so as to meet the actual buffering protection needs of heavy-load robots carrying different weights. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, drawings of other embodiments can be obtained based on these drawings without paying creative work.
[0031] Figure 1 It is the overall structural diagram of the device;
[0032] Figure 2 It is a schematic diagram of the local structure of the device;
[0033] Figure 3 This is a schematic diagram of the overall structure of the emergency protection agency;
[0034] Figure 4 This is a schematic diagram of the AA structure of the emergency protection agency;
[0035] Figure 5 The schematic diagram of the installation structure of the brake block on the H-shaped plate;
[0036] Figure 6 It is a schematic diagram of the internal structure of the running buffer mechanism;
[0037] Figure 7 It is a schematic diagram of the internal structure of the pin plug module;
[0038] Figure 8 It is a schematic diagram of the overall structure of the damage detection mechanism.
[0039] The following are the descriptions of the reference numerals:
[0040] 101, drum frame; 102, rotating shaft; 103, cable drum; 104, steel cable; 105, first electromagnetic device; 106, brake disc; 107, brake groove; 108, H-shaped plate; 109, connecting rod; 201, fixed pile; 202, cylinder; 203, slide workpiece; 204, connecting rod; 205, brake block; 206, slide groove; 207, slide rail; 208, buffer base; 209, connecting hole; 301, pin barrel; 302, circular pin hole; 303, Buffer column through hole; 304; buffer column; 305, rotating part; 306, rectangular through hole; 307, buffer disk; 308, pin pin module; 309, pin pin disk; 401, pin pin; 402, second electromagnetic device; 403, first spring; 404, second spring; 405, circular ring; 406, transmission gear ring; 407, gear; 408, stepping motor; 409, rectangular slide; 501, guide wheel; 502, circular guide rail; 503, acoustic flaw detector. DETAILED DESCRIPTION
[0041] In order to more clearly understand the above-mentioned purposes, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific implementation methods. These drawings are all simplified schematic diagrams, which only illustrate the basic structure of the present invention in a schematic manner, and therefore only show the structures related to the present invention. It should be noted that the embodiments in this application and the features in the embodiments can be combined with each other without conflict.
[0042] In the description of the present application, it should be understood that the terms "center", "longitudinal", "lateral", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present application and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the scope of protection of the present application. In addition, the terms "first", "second", etc. are only used for descriptive purposes, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, features defined as "first", "second", etc. may explicitly or implicitly include one or more of the features. In the description of the invention, unless otherwise specified, "multiple" means two or more.
[0043] In the description of this application, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be directly connected or indirectly connected through an intermediate medium, and it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood by specific circumstances.
[0044] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. The preferred embodiments of the present invention are given in the drawings. However, the present invention can be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the disclosure of the present invention more thoroughly understood.
[0045] like Figure 1 As shown, a first aspect of the present invention provides an operation protection device for a heavy-load robot, wherein the operation protection device includes an emergency protection mechanism, an operation buffer mechanism, and a damage detection module.
[0046] like Figure 1 , 2As shown in Figures 3, 4 and 5, the emergency protection mechanism includes a drum frame 101, a rotating shaft 102 is installed on the drum frame 101, a cable drum 103 is fixed on the rotating shaft 102, a steel cable 104 is wound around the cable drum 103, a first electromagnetic device 105 is fixed to the end of the steel cable 104, and the first electromagnetic device 105 is connected to a backup power supply.
[0047] like Figure 1 , 2 As shown in Figures 3, 4 and 5, a brake disc 106 is installed on one end of the rotating shaft 102, and a brake groove 107 is provided on the brake disc 106. An H-shaped plate 108 is provided on the side of the brake groove 107, and the H-shaped plate 108 is horizontally placed in the brake groove 107. One end of a connecting rod 109 is welded to the bottom end of the H-shaped plate 108, and the other end of the connecting rod 109 is welded to the side of a fixed pile 201, and the fixed pile 201 is provided on the running damage detection mechanism, and a speed sensor is installed on the H-shaped plate 108.
[0048] like Figure 1 , 2 As shown in , 3, 4, and 5, a cylinder 202 is fixed on the fixing pile 201, and the top end of the output rod of the cylinder 202 is connected to the slide workpiece 203, and the slide workpiece 203 is sleeved on the connecting rod 109.
[0049] like Figure 4 , 5 As shown, the slide workpiece 203 is hinged on both sides with one end of the same connecting rod 204, and the other end of the connecting rod 204 is hinged to the bottom of the brake block 205. The brake block 205 is provided with the same sliding groove 206 on both sides, and the two sliding grooves 206 are respectively connected to the same sliding rail 207, and the two sliding rails 207 are respectively arranged on both sides of the groove of the H-shaped plate 108.
[0050] It should be noted that when the heavy-load robot grabs a heavy metal object, the backup power supply is energized to start the two first electromagnetic devices 105, so that the two first electromagnetic devices 105 are adsorbed on the heavy metal object. When the heavy-load robot fails and stops running urgently, the heavy metal object will detach from the heavy-load robot and fall freely. At this time, the heavy metal object that falls freely will pull the steel cable 104 that is continuously and rapidly stretched downward through the first electromagnetic device 105. The steel cable 104 stretched downward will cause the cable drum 103 to rotate, and under the action of the rotating shaft 102, the cable drum 103 will further drive the brake disc 106 to rotate faster. When the speed sensor detects that the speed of the brake disc 106 exceeds the preset speed threshold, it will control the output rod of the cylinder 202 to start extending, thereby pushing the slide workpiece 203. The pushed slide workpiece 203 will synchronously drive the two connecting rods 204 to fold in the direction of the H-shaped plate 108, so that the two brake blocks 205 can be synchronously controlled to slide out quickly to both sides of the H-shaped plate 108 under the action of the slide groove 206 and the slide rail 207 to form an expansion braking effect. The two expanded brake blocks 205 will contact and rub with the inner wall of the brake groove 107, and quickly brake and decelerate the accelerated rotating brake disc 106, thereby reducing or inhibiting the rapid downward extension rate of the steel cable 104, so that the free fall rate of the heavy object is reduced, and the heavy-load robot can protect the transported heavy objects, avoid damage to the heavy objects due to fault factors, improve the handling quality of the heavy-load robot, and at the same time reduce the accidental injury rate of the heavy-load robot to nearby operators when carrying heavy metal objects, greatly improve the operating safety factor of the heavy-load robot, and have high reliability.
[0051] It should be noted that when the heavy-load robot grabs heavy metal objects, the two first electromagnetic devices 105 will be energized and adsorbed on the industrial-grade heavy objects to fix them, thereby further improving the stability of the heavy-load robot when grabbing heavy objects, avoiding shaking, falling, etc. when the heavy-load robot carries industrial-grade metal heavy objects, and achieving the effect of firm grasping and protection.
[0052] like Figure 1 , 2 As shown in Figure 6, the running buffer mechanism includes a buffer base 208, a connecting hole 209 is opened in the middle of the buffer base 208, which is used to be fixed to the grasping joint of the heavy-load robot, and the interior of the buffer base 208 is hollow. A plurality of latch tubes 301 are arranged inside the buffer base 208, and a plurality of circular latch holes 302 are longitudinally opened on the side wall of each of the latch tubes 301. A plurality of buffer column through holes 303 are opened on the top of the buffer base 208, and each buffer column through hole 303 is correspondingly placed directly above each latch tube 301.
[0053] like Figure 1 , 6As shown, a buffer column 304 runs through each of the latch tubes 301 , a rotating member 305 is welded to the top of the buffer column 304 , and the rotating member 305 is installed in a rectangular through hole 306 through a column pin, and the rectangular through hole 306 is opened on the buffer disk 307 .
[0054] like Figure 1 , 6 As shown in Figure 7, a pin latch module 308 is installed at the bottom of the buffer column 304, and the pin latch module 308 includes a pin latch disk 309. Round holes are opened on both sides of the pin latch disk 309, and the two round holes are used to limit the installation of pin latches 401. A second electromagnetic device 402 is installed between the two pin latches 401, and a first spring 403 is arranged between each pin latch 401 and the pin latch disk 309.
[0055] like Figure 1 , 6 As shown in FIG. 7 , a plurality of second springs 404 are connected between the buffer base 208 and the buffer disk 307 , and each of the second springs 404 is respectively sleeved on the outside of each buffer column 304 , and a pressure sensor is installed on the buffer base 208 .
[0056] It should be noted that the operator installs the buffer base on the heavy-object grabbing joint of the heavy-load robot. When the heavy-load robot grabs a metal heavy object and transports it, the heavy object will generate inertia force. At this time, the inertia force will cause the heavy object to contact the buffer tray 307, and under the action of the inertia force, pressure is applied downward to the buffer tray 307. The buffer tray 307 under pressure is compressed downward, and the buffer tray 307 is simultaneously subjected to an upward resetting buffer force applied by the second spring 404, thereby offsetting the inertia force of the heavy object on the buffer tray 307, thereby achieving a buffering effect of the heavy-load robot on the heavy object, and greatly reducing the pressure on each joint of the heavy-load robot during the transportation of heavy objects. The inertial force received can avoid the shutdown, damage and malfunction of the heavy-load robot due to the long-term inertial force on each joint, thereby increasing the service life of the heavy-load robot and making the design more practical; at the same time, the running buffer mechanism can also prevent the heavy objects from escaping from the grasp of the heavy-load robot due to excessive inertial force, reduce the probability of accidental injury to operators by heavy objects, and improve the operating safety of the heavy-load robot; and the setting of the rotating part 305 can make the buffer plate tilt at multiple angles, thereby realizing buffering of the tilt angle, so that the running buffer mechanism can fully offset the inertial force applied by the heavy objects at different angles, ensuring all-round protection performance for the heavy-load robot.
[0057] It should be noted that the initial position of the pin latch module 308 is to be locked in the circular pin hole 302 at the top of the pin barrel 301. In this state, the second spring 404 will be compressed to form a larger buffer coefficient, which is suitable for buffering the inertial force generated by heavy objects of greater weight; if the buffer plate 307 is compressed by the inertial force of other different heavy objects, the pressure sensor will detect the corresponding pressure value, thereby controlling the second electromagnetic device 402 to start, and at this time the second electromagnetic device 402 will generate magnetic force to simultaneously adsorb The pin latches 401 on both sides cause the two pin latches 401 to shrink synchronously into the pin latch plate 309, thereby realizing the unlocking action of the pin latch module 308 from the restriction of the latch tube 301; at this time, the inertial force exerted by the weight on the buffer plate 307 causes the buffer column to drive the pin latch plate 309 to gradually descend toward the bottom of the latch tube 301 under the action of the inertial force of the weight, until the buffer column 304 drives the pin latch plate 309 to descend in the latch tube 301 to the round pin corresponding to the height corresponding to the inertial force. The second electromagnetic device 402 is controlled to be closed according to the detection result of the pressure sensor to cancel the magnetic attraction force on the pin latches 401 on both sides, and under the action of the first spring 403, the two pin latches 401 are synchronously reset and extended out of the pin latch disk 309, and the two synchronously reset and popped-out pin latches 401 are inserted into the circular pin holes 302 currently in the pin tube 301, so that the pin latch module 308 is fixed in the buffer base 208, and the height of the buffer disk 208 is adaptively adjusted according to the inertial force applied by different weights, so as to adaptively adjust the buffer coefficient to meet the actual buffer protection needs of the heavy-load robot for carrying different weights, thereby improving the intelligence and automation of the operation buffer protection, replacing the cumbersome steps of the traditional manual adjustment of the buffer coefficient, saving time and effort, reducing the risk factor during manual adjustment, and ensuring the operation safety of the heavy-load robot for heavy objects and operators.
[0058] like Figure 1 , 8 As shown, the damage detection module includes a circular ring 405, a transmission gear ring 406 is arranged on the side of the circular ring 405, the transmission gear ring 406 is meshed with a gear 407, the gear 407 is fixed on the output shaft of a stepper motor 408, and the stepper motor 408 is fixed on the bottom of a rectangular slide 409.
[0059] like Figure 1 , 8 As shown, two sets of guide wheels 501 are installed at the bottom of the rectangular skateboard 409, and the two sets of guide wheels 501 are respectively arranged on both sides of the circular guide rail 502. The circular guide rail 502 is fixed above the circular ring 405, and an ultrasonic flaw detector 503 is arranged on the top of the rectangular skateboard 409.
[0060] It should be noted that, during the transportation of heavy objects by the heavy-load robot, some bumps, collisions, and frictions that may damage the production quality of the heavy objects may occur, resulting in different degrees of damage or defects to the heavy objects, thereby reducing the transportation quality of the heavy-load robot. When the heavy-load robot grabs the heavy objects, the stepper motor 408 is controlled to start, and the stepper motor 408 rotates the gear 407. Since the transmission gear ring 406 is in a relatively fixed state, the gear 407 can revolve in a circular mesh around the transmission gear ring 406, thereby driving the rectangular slide 409 to revolve in a synchronous circular manner along the circular guide rail 502, and starting the sonic flaw detector 503. The circularly running rectangular slide 409 can drive the sonic flaw detector 503 to perform annular circumferential detection on the heavy objects, thereby achieving a comprehensive damage detection effect on the heavy objects. The heavy-load robot is regulated according to the damage detection results, thereby avoiding collisions, bumps, or frictions on the heavy objects during the transportation of the heavy-load robot, ensuring the integrity of the heavy objects, greatly improving the transportation quality and efficiency of the heavy-load robot, reducing the scrap rate of heavy object transportation, and having high reliability.
[0061] A second aspect of the present invention provides a control method for a heavy-load robot operation protection device, which is applied to any one of the heavy-load robot operation protection devices described above, and specifically comprises the following steps:
[0062] Obtain the weight information of the heavy object grabbed by the heavy-load robot, as well as the model and specification information of the heavy-load robot, the load joint combination information, and the handling path required for the heavy object production;
[0063] Based on the model specification information and the load joint combination information, several related handling schemes of the heavy-load robot are obtained in the big data network, and the optimal handling path corresponding to each handling scheme is extracted, and the Hamming distance between each optimal handling path and the handling path required for the heavy object production is calculated to obtain multiple Hamming distances;
[0064] Determine the fit rate between each transport control programming instruction and the transport path required for the heavy object production according to a plurality of Hamming distances, extract the transport control programming instruction corresponding to the maximum fit rate, and control the heavy-load robot to transport the heavy object according to the transport path required for the heavy object based on the transport control programming instruction corresponding to the maximum fit rate;
[0065] After handling, the operating parameters of the heavy-load robot are output, and the hierarchical analysis algorithm is introduced to calculate the weight value of each load joint of the heavy-load robot. Only the load joint with the maximum weight value is marked, which is defined as the key operating load joint;
[0066] Obtaining a preset inertia force reference coefficient of a key operating load joint, obtaining an actual inertia force coefficient by measuring the inertia force borne by the key operating load joint when the heavy-load robot carries a heavy object under the operating condition parameters, calculating a deviation between the actual inertia force coefficient and the inertia force reference coefficient, and obtaining a deviation value;
[0067] If the deviation value is greater than the preset deviation threshold, the first electromagnetic device is controlled to start based on the deviation value, and the ball pin on the buffer column is moved to a suitable circular pin hole in combination with the data of the pressure sensor to enhance the buffering during the transportation of heavy objects.
[0068] It should be noted that traditional heavy-load robots are usually equipped with multiple load joints. When the heavy-load robot transports heavy objects, it will inevitably generate a large inertial force. This long-term exposure to a large inertial force will cause one or more load joints to be damaged during transportation, resulting in emergency shutdown, failure or scrapping of the heavy-load robot, which greatly increases maintenance costs and time and reduces the service life of the heavy-load robot. Since there are differences between heavy-load robots with different models, specifications and joint settings, the requirements for heavy-load production and transportation paths are also different. Therefore, first of all, the optimal path preset by the transportation plan with the highest matching rate is set according to the model specifications and load joint settings of the heavy-load robot to accurately and efficiently transport heavy objects, and the operating conditions output when transporting heavy objects are based on the execution of the programming instruction plan with the highest matching rate. There are also differences in the inertial force applied to each load joint, and the protection of key load joints is crucial. Therefore, it is possible to judge whether the actual inertial force coefficient borne by the key operating load joints when the heavy-load robot carries heavy objects under the operating parameters is greater than the inertial force reference coefficient preset for the key load joints. If it is greater, it means that the inertial force generated by the heavy-load robot when carrying the current heavy object is large, which will cause a certain degree of damage to the key load joints. Therefore, it is necessary to further control the first electromagnetic device to start and combine the data of the pressure sensor to make the buffer plate rise, so as to increase the buffer coefficient of the buffer plate for the current heavy object transportation, avoid damage to the key load joints of the heavy-load robot when transporting the current heavy object, improve the service life and safety of the heavy-load robot, reduce a lot of maintenance costs and time output, and have high economic benefits.
[0069] Furthermore, in a preferred embodiment of the present invention, the following steps are also included:
[0070] Based on the big data network, all preset fault feature vectors that cause the heavy-load robot to stop operating under different preset operating environment conditions and different preset operating conditions are obtained and integrated to obtain a fault feature vector database;
[0071] Acquire an operation record of the heavy-load robot, acquire a plurality of fault records of the heavy-load robot within a preset time period based on the operation record, extract an actual fault feature vector corresponding to each fault record, import the actual fault feature vector corresponding to each fault record into the fault feature vector database for matching, and generate a matching result;
[0072] If the matching result shows that the actual fault feature vector matches at least one corresponding preset fault feature vector in the fault feature vector database, the speed sensor is controlled to start, and the speed of the brake groove is monitored in real time to obtain a real-time monitoring result of the speed sensor;
[0073] Based on the weight information of the heavy object, a search is performed in the big data network. After the search is completed, the instantaneous speed reference value when the heavy object falls is obtained. If the instantaneous speed reference value is generated in the real-time monitoring result of the speed sensor, the cylinder output rod is controlled to extend so that the brake block contacts the inner wall of the brake groove to reduce the falling rate of the heavy object.
[0074] It should be noted that the operating state of the heavy-load robot is affected by environmental factors and operating conditions. The fault characteristics generated by certain specific environmental factors and operating conditions will cause the heavy-load robot to shut down urgently. The fault characteristics include parts wear, aging, power failure and parameter errors. At this time, the heavy objects grasped by the heavy-load robot will fall, causing damage to the heavy objects or accidental injury to nearby operators, greatly increasing the operational risk. The method can firstly construct a fault feature vector database based on all preset fault feature vectors of the heavy-load robot shutting down under different preset operating environment conditions and different preset operating condition conditions, and import the actual fault feature vector into the fault feature vector database for identification and matching. If the matching result is If the actual fault feature vector matches at least one corresponding preset fault feature vector in the fault feature vector database, it means that there are one or more fault features that cause emergency shutdown when the heavy-load robot transports heavy objects within the preset time period. At this time, the speed sensor can be controlled to monitor the speed of the brake groove in real time. If the monitored brake groove speed is greater than the preset threshold, it means that the heavy object is in a free fall state, and the cylinder output rod needs to be controlled to extend so that the brake block contacts the inner wall of the brake groove to reduce the falling rate of the heavy object, thereby realizing the emergency braking protection effect of the heavy-load robot for the transportation of heavy objects, preventing damage to the heavy objects caused by high-speed falling, and further improving the operation protection safety of the heavy-load robot. The braking rate is fast, ensuring the accuracy and efficiency of emergency braking.
[0075] In addition, the control method of the operation protection device of the heavy-load robot further includes the following steps:
[0076] Obtain damage detection results of an acoustic flaw detector, extract one or more damage features of the current heavy object according to the damage detection results, obtain point cloud data of the current heavy object through a laser scanner, and obtain a model diagram of the current heavy object based on voxel fitting of the point cloud data in a three-dimensional plane space;
[0077] A grid interpolation algorithm is introduced, in which one or more damage features existing in the current heavy object are plotted as hot spot distribution in the current heavy object model map to obtain a current heavy object damage hot spot distribution map;
[0078] Obtain multiple historical damage detection results of the heavy-load robot transporting the current heavy object within a preset time period to construct multiple historical heavy object damage hotspot distribution maps, introduce the quasi-Newton method to calculate the Hessian matrix between the current heavy object damage hotspot distribution map and each historical heavy object damage hotspot distribution map, and perform registration based on the Hessian matrix;
[0079] After the registration is completed, the damage characteristic hot spot frequencies between the current heavy object damage hot spot distribution map and multiple historical heavy object damage hot spot distribution maps are analyzed to obtain several damage hot spot density values of the heavy object;
[0080] Determine whether each damage hotspot density value is greater than a preset damage hotspot density value. If so, mark the damage hotspot density value greater than the preset damage hotspot density value, and obtain the heavy object damage position corresponding to the damage hotspot density value greater than the preset damage hotspot density value based on the current heavy object model diagram, and define it as a vulnerable position;
[0081] Obtaining a preset transportation route for the current heavy object, extracting a sub-transportation route corresponding to each of the vulnerable locations according to the preset transportation route, marking the sub-route segments as deviated sub-route segments, and obtaining a standard route segment corresponding to each of the sub-deviated route segments;
[0082] The Bezier curve method is introduced to fit the Bezier curves of each sub-deviated route segment and the corresponding standard route segment, and the slope of each Bezier curve is obtained. The deviation amplitude between each sub-deviated route segment and the corresponding standard route segment is determined according to the slope, and the preset transportation route of the current heavy object is corrected based on the deviation amplitude to avoid damage to the heavy object during transportation by the heavy-load robot.
[0083] It should be noted that if the heavy-load robot is in a narrow space for transportation or the transportation route is not calibrated for a long time, it will cause different degrees of damage to the heavy objects due to bumps, collisions or friction during the transportation of the heavy-load robot, which will cause the heavy objects to be unusable and scrapped, greatly increasing the cost output of heavy object transportation and production, and reducing the transportation quality of the heavy-load robot; this method first draws the hot spot distribution in the model map according to one or more damage features detected by the acoustic flaw detector for the current heavy object, and obtains the current heavy object damage hot spot distribution map, and at the same time constructs multiple historical heavy object damage hot spot distribution maps within a preset time period, and aligns the current heavy object damage hot spot distribution map with multiple historical heavy object damage hot spot distribution maps in the quasi-Newton method, which is convenient for further analysis of the subsequent damage feature distribution and improves the speed of data calculation. rate, reducing the calculation error rate; then the registered hot spot distribution map is analyzed to know the frequency of damage to heavy objects at each position, so as to obtain several damage hot spot density values of the heavy objects. If the damage hot spot density value is greater than the preset damage hot spot density value, it means that the position where the damage hot spot density value is greater than the preset damage hot spot density value is actually a position that is prone to damage during transportation by the heavy-load robot, and it is marked; finally, the deviation amplitude between the sub-deviated route segment and the standard route segment that causes the vulnerable position in the current preset transportation route is calculated to correct the transportation route of the heavy-load robot, thereby preventing the heavy-load robot from continuing to bump, collide or rub when transporting heavy objects, reducing the damage rate and scrap rate of heavy objects, and greatly improving the transportation quality and transportation stability of the heavy-load robot.
[0084] The above is based on the ideal embodiment of the present invention, and its description is relatively specific and detailed, but it cannot be understood as limiting the scope of the invention patent. It should be pointed out that for ordinary technicians in this field, several modifications and improvements can be made without departing from the concept of the present invention, which all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be based on the attached claims.
Claims
1. A control method for a running protection device of a heavy-load robot, characterized in that: The operation protection device includes an emergency protection mechanism, an operation buffer mechanism and a damage detection module: The emergency protection mechanism comprises a drum frame, a rotating shaft is installed on the drum frame, a cable drum is fixed on the rotating shaft, a steel cable is wound on the cable drum, a first electromagnetic device is fixed at the end of the steel cable, and the first electromagnetic device is connected to a backup power supply; The running buffer mechanism includes a buffer base, a connecting hole is provided in the middle of the buffer base for fixing to the grabbing joint of the heavy-load robot, the buffer base is hollow inside, a plurality of latch barrels are arranged inside the buffer base, a plurality of circular latch holes are longitudinally provided on the side wall of each latch barrel, a plurality of buffer column through holes are provided on the top of the buffer base, and each buffer column through hole is correspondingly placed directly above each latch barrel; The damage detection module includes a circular ring, a transmission gear ring is arranged on the side of the circular ring, the transmission gear ring is meshed with a gear, the gear is fixed on the output shaft of a stepper motor, and the stepper motor is fixed on the bottom of a rectangular slide; A pin pin module is installed at the bottom of the buffer column, and the pin pin module includes a pin pin disk, and circular holes are opened on both sides of the pin pin disk. The two circular holes are used to limit the installation of pin pins, and a second electromagnetic device is installed between the two pin pins, and a first spring is arranged between each pin pin and the pin pin disk; A plurality of second springs are connected between the buffer base and the buffer disk, and each of the second springs is respectively sleeved on the outside of each buffer column, and a pressure sensor is installed on the buffer base; The control method comprises the following steps: Obtain the weight information of the heavy object grabbed by the heavy-load robot, as well as the model and specification information of the heavy-load robot, the load joint combination information, and the handling path required for the heavy object production; Based on the model specification information and the load joint combination information, several related handling schemes of the heavy-load robot are obtained in the big data network, and the optimal handling path corresponding to each handling scheme is extracted, and the Hamming distance between each optimal handling path and the handling path required for the heavy object production is calculated to obtain multiple Hamming distances; Determine the fit rate between each transport control programming instruction and the transport path required for the heavy object production according to a plurality of Hamming distances, extract the transport control programming instruction corresponding to the maximum fit rate, and control the heavy-load robot to transport the heavy object according to the transport path required for the heavy object based on the transport control programming instruction corresponding to the maximum fit rate; After handling, the operating parameters of the heavy-load robot are output, and the hierarchical analysis algorithm is introduced to calculate the weight value of each load joint of the heavy-load robot. Only the load joint with the maximum weight value is marked, which is defined as the key operating load joint; Obtaining a preset inertia force reference coefficient of a key operating load joint, obtaining an actual inertia force coefficient by measuring the inertia force borne by the key operating load joint when the heavy-load robot carries a heavy object under the operating condition parameters, calculating a deviation between the actual inertia force coefficient and the inertia force reference coefficient, and obtaining a deviation value; If the deviation value is greater than the preset deviation threshold, the first electromagnetic device is controlled to start based on the deviation value, and the ball pin on the buffer column is moved to a suitable circular pin hole in combination with the data of the pressure sensor to enhance the buffering during the transportation of heavy objects.
2. The control method of the operation protection device of a heavy-load robot according to claim 1, characterized in that: A brake disc is installed on one end of the rotating shaft, and a brake groove is provided on the brake disc. An H-shaped plate is provided on the side of the brake groove, and the H-shaped plate is horizontally placed in the brake groove. One end of a connecting rod is welded to the bottom end of the H-shaped plate, and the other end of the connecting rod is welded to the side of a fixed pile, and the fixed pile is provided on the damage detection mechanism, and a speed sensor is installed on the H-shaped plate.
3. The control method of the operation protection device of a heavy-load robot according to claim 2, characterized in that: A cylinder is fixed on the fixing pile, the top end of the output rod of the cylinder is connected to the slide workpiece, and the slide workpiece is sleeved on the connecting rod.
4. The control method of the operation protection device of a heavy-load robot according to claim 3 is characterized in that: The slide workpiece is hinged on both sides with one end of the same connecting rod, the other end of the connecting rod is hinged to the bottom of the brake block, the brake block is provided with the same sliding groove on both sides, the two sliding grooves are respectively connected to the same sliding rails, and the two sliding rails are respectively arranged on both sides of the groove of the H-shaped plate.
5. The control method of the operation protection device of a heavy-load robot according to claim 1, characterized in that: A buffer column is passed through each of the latch cylinders, a rotating member is welded to the top of the buffer column, and the rotating member is installed in a rectangular through hole through a column pin, and the rectangular through hole is opened on the buffer disk.
6. The control method of the operation protection device of a heavy-load robot according to claim 1, characterized in that: Two groups of guide wheels are installed at the bottom of the rectangular slide at the same time. The two groups of guide wheels are respectively arranged on both sides of the circular guide rail. The circular guide rail is fixed above the circular ring. An acoustic flaw detector is arranged on the top of the rectangular slide.
7. The control method of the operation protection device of a heavy-load robot according to claim 1, characterized in that: The following steps are also included: Based on the big data network, all preset fault feature vectors that cause the heavy-load robot to stop operating under different preset operating environment conditions and different preset operating conditions are obtained and integrated to obtain a fault feature vector database; Acquire an operation record of the heavy-load robot, acquire a plurality of fault records of the heavy-load robot within a preset time period based on the operation record, extract an actual fault feature vector corresponding to each fault record, import the actual fault feature vector corresponding to each fault record into the fault feature vector database for matching, and generate a matching result; If the matching result shows that the actual fault feature vector matches at least one corresponding preset fault feature vector in the fault feature vector database, the speed sensor is controlled to start, and the speed of the brake groove is monitored in real time to obtain a real-time monitoring result of the speed sensor; Based on the weight information of the heavy object, a search is performed in the big data network. After the search is completed, the instantaneous speed reference value when the heavy object falls is obtained. If the instantaneous speed reference value is generated in the real-time monitoring result of the speed sensor, the cylinder output rod is controlled to extend so that the brake block contacts the inner wall of the brake groove to reduce the falling rate of the heavy object.
