A multi-dimensional rigid-flexible coupling intelligent robot and its control method

Through a series-parallel composite structure and a multi-dimensional rigid-flexible coupled intelligent robot driven by flexible cable, the existing robots have solved the shortcomings of accuracy and stability in the spraying processing of complex parts, and achieved spraying efficiency with large work space and high response speed. for spraying and processing of complex parts.

CN115741735BActive Publication Date: 2024-11-26HEFEI UNIV OF TECH
View PDF 9 Cites 0 Cited by

Patent Information

Application Number
CN202211476932.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-11-23
Publication Date
2024-11-26
Estimated Expiration
2042-11-23

AI Technical Summary

Technical Problem

When existing robots deal with spraying and processing complex parts, it is difficult to take into account high precision, stability and large work space. Traditional soft cable-driven robots have shortcomings in the spraying and vibration problems of curved surfaces with large curvature changes.

Method used

A multi-dimensional rigid-flexible coupled intelligent robot is designed, adopting a series-parallel composite structure, dynamically adjusting the robot mode through the bottom rail, combining flexible cable drive and end linkage mechanism to achieve greater work space and high response speed, and through hydraulics The cylinder and screw nut mechanism optimizes the cable point position and flexible cable length of the boom to improve the adaptability and accuracy of the robot.

Benefits of technology

Achieve greater work space and higher response speed, improves spray efficiency and accuracy, is suitable for spraying and processing of complex parts, and has a simple structure and no complex control. It is suitable for spraying, assembly, handling of objects in automated factories, etc. Function.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115741735B_ABST
    Figure CN115741735B_ABST
Patent Text Reader

Abstract

The present invention provides a multi-dimensional rigid-flexible coupling intelligent robot and a control method thereof. The present invention is composed of 2-4 serial modules, an end effector and a bottom guide rail. The robot is dynamically adjusted to a double-column, three-column and four-column mode through the bottom guide rail to cope with different working scenes, and can be convenient for the later maintenance of the robot and the saving of space when not working. The end effector is connected by a flexible cable, and the length and width angle of the fixed platform is changed by changing the position of the cable outlet point in each serial module, thereby improving the performance of the robot. According to different working situations, the most suitable angle is selected to achieve better movement and working performance. The up and down movement of the hydraulic cylinder in the serial module can realize the vertical movement of the robot, help the robot to work in the best working performance, and at the same time, the end connecting rod mechanism improves the working quality of the robot to a greater extent.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robots, and mainly to a multi-dimensional rigid-flexible coupling intelligent robot and a control method thereof. Background Art

[0002] With the advancement of science and technology, robots have been greatly developed. Existing robots can be roughly divided into two types, serial robots and parallel robots. Although serial robots can process the outer and inner surfaces of relatively complex parts, they have a small range of motion and are prone to dynamic error accumulation. While parallel robots have a compact and stable structure and high precision, they can only process the outer surfaces of simple parts. Therefore, it is necessary to design a variable workspace rigid-flexible coupling hybrid robot that combines the advantages of serial and parallel.

[0003] Chinese document patent number "CN2020102435751" proposes a flexible cable-driven hybrid spray robot mechanism and its operation method, but this robot is not suitable for large parts. At the same time, the three-degree-of-freedom translation of its end effector can only be achieved by eight ropes, resulting in low position accuracy of the end effector and inability to avoid the reaction force generated during the process.

[0004] Chinese patent document number "CN2018217605109" proposes a large-surface spraying soft-rope robot, but the forward and backward displacement of the end effector of this robot depends on the length of the frame. The longer the frame, the worse the stiffness of the system. Therefore, this robot is difficult to apply to curved surface spraying with large curvature changes, and does not consider the vibration problem during rope traction.

[0005] Chinese document patent number "CN104057442A" proposes a five-degree-of-freedom hybrid robot. Although the robot's degrees of freedom are increased to 5 degrees of freedom by a series-parallel hybrid method, its parallel mechanism has a complex structure, cumbersome kinematic solution, and difficult installation and debugging. The series mechanism can only achieve one rotation and one swing degree of freedom, which cannot meet the spraying processing of complex parts. Summary of the invention

[0006] Therefore, a robot that combines the advantages of series and parallel connection and has stable operation, strong adaptability, large working space and high quality is needed. The present invention designs a variable working space rigid-flexible coupling hybrid robot. By using a series-parallel composite structure to change the length-width ratio of the static platform, the robot's working space is changed. The platform is driven by a flexible cable to make the robot have a higher response speed and improve its efficiency. The end end is given an extra degree of freedom by the designed end link mechanism, so that the end effector can not only move by the flexible cable, but also achieve extension and retraction by its own structure.

[0007] The purpose of the present invention is to make up for the defects of the existing technology and provide a multi-dimensional rigid-flexible coupling intelligent robot and its control method. The present invention is composed of 2-4 series modules, an end effector and a bottom guide rail. The robot is dynamically adjusted to 2-column, 3-column and 4-column modes through the bottom guide rail to cope with different working scenes, and it is convenient for the later maintenance of the robot and the saving of space when not working. The end effector is connected by a flexible cable. By changing the position of the cable outlet point in each series module, the change of the length and width angle of the fixed platform is achieved, thereby improving the performance of the robot. For different working situations, the most suitable angle is selected to achieve better working performance. The up and down movement of the hydraulic cylinder in the series module can realize the vertical movement of the robot, helping the robot to work in the best working performance. At the same time, the end link mechanism improves the working quality of the robot to a greater extent. The control method of the robot effectively ensures the efficient and accurate operation of the robot. This robot can realize the functions of spraying, assembling, handling, and lifting objects in an automated factory.

[0008] The objective of the present invention is achieved through the following technical solutions:

[0009] A multi-dimensional rigid-flexible coupling intelligent robot comprises a boom, a flexible cable, a hydraulic cylinder, a support, an end link mechanism, a working part, a flexible cable driving mechanism and a bottom guide rail. The boom is connected to the support through a servo motor, a motor support, a hydraulic cylinder and a support. The rotation of the boom is realized by the servo motor, and the vertical movement of the robot is realized by the hydraulic cylinder. The screw nut is installed inside the boom to change the position of the cable outlet point. The end link mechanism is connected to the working part. The working part can be a nozzle or a multi-dimensional manipulator and other intelligent working parts, and an additional degree of freedom of up and down movement is given by the end link mechanism. The flexible cable is connected to the top four corners of the end link mechanism and crosses two pulleys on the boom to connect to the flexible cable driving mechanism. The length of the flexible cable is controlled by the flexible cable driving mechanism. The bottom guide rail is used to move the support. When in use, it moves to the desired position. The optimal position is achieved by adjusting the cable outlet point position of the boom and the length of the flexible cable. When not in use, the support can be gathered together for easy storage and maintenance.

[0010] The boom is composed of a hanger, a screw nut, a screw motor, a pulley, a counterweight, a counterweight guide, a pulley hanger, a slider, a slider guide and other structures. The hanger is connected to the rotating shaft of the servo motor, and the hanger is placed on four annular sliders. The servo motor rotates to drive the boom to rotate. This function is achieved by the annular slider moving on the annular guide. The screw nut is placed on the right side inside the hanger and is connected to the screw motor through a coupling and a bearing. The rotation of the screw motor drives the screw to rotate to achieve the movement of the nut on the screw. The pulley hanger is coaxially connected to the screw with the nut, and the pulley hanger is fixed to the moving slider with bolts and placed on the moving guide. The moving guide is fixed to the hanger by bolts. The rigid support body is fixed to the hanger in a right triangle by bolts, and the motor cover is fixed to the hanger by bolts to prevent the motor from being exposed to the outside. Two cylindrical counterweight guides are placed in the groove at the left end of the hanger, and holes are punched under the counterweight to pass through the two guides. The balance of the boom is ensured by moving the position of the counterweight. The hydraulic cylinder is fixed to the pillar by hexagonal bolts and nuts at the four corners. By controlling the extension and retraction of its piston rod, the motor support above is pushed, thereby realizing the rising and lowering of the boom.

[0011] The flexible cable is driven by a flexible cable drive motor, and its main function is to realize the up, down, left, and right movement of the terminal link mechanism. 2-4 flexible cables effectively ensure that there is enough force and strength to lift the terminal link mechanism, and the dispersed arrangement enables the terminal link mechanism to effectively resist the interference of forces in all directions. The flexible cable can adjust the workspace by crossing the movable pulley on the boom, greatly improving the adaptability of the robot.

[0012] The terminal linkage mechanism is composed of a rope connector, a linkage mechanism base, a power transmission member, a connecting frame, a cylindrical gear, a connecting rod, an internally threaded shoulder pin, a retaining ring shoulder pin, a working component, a small-capacity servo motor, and a bevel gear. The rope connector is installed at the four corners of the linkage mechanism base through a bearing seat and a bearing seat rotating shaft, and is used to connect the terminal linkage mechanism to the flexible rope. The small-capacity servo motor is fixed below the linkage mechanism base, and the output of the small-capacity servo motor is transmitted to the power transmission member through the bevel gear, thereby driving the cylindrical gear to rotate, thereby realizing the extension and retraction of the terminal linkage mechanism. The connecting frame is connected to the connecting rod through the internally threaded shoulder pin, and the connecting rods are connected to each other through the retaining ring shoulder pin.

[0013] The connecting rod part is composed of six two-hole connecting rods, nine three-hole connecting rods, four connecting frames and pins. The cylindrical gear and the two-hole connecting rod are placed in the first hole position on the base of the connecting rod mechanism and connected together through a pin, and the other hole of the two-hole connecting rod is connected to the hole at one end of the three-hole connecting rod. The middle hole position of the three-hole connecting rod is connected to the connecting frame by a pin, and then two three-hole connecting rods and the connecting frame are connected in sequence, and the remaining holes are connected to another two-hole connecting rod, and the remaining holes of the two-hole connecting rod are connected to the last connecting frame installed with the working part. There are three groups of connecting rod parts in total. The present invention uses this new type of connecting rod mechanism designed to realize the telescopic function of the end effector, which is not only simple in structure but also stable in operation.

[0014] The characteristic of the power transmission component in the terminal linkage mechanism lies in the design of its groove, which is designed to be spiral. As the small-capacity servo motor drives the bevel gear to rotate, the power transmission component also rotates, and the teeth of the cylindrical gear move in the spiral groove, thereby driving the connecting rod part to extend and retract, thereby realizing the up and down movement of the end actuator.

[0015] The soft rope driving mechanism is composed of a motor, a helical gear reduction motor, a winding drum, and a winding machine base. The function of the soft rope driving mechanism is to drive the recovery and release of the soft rope. In the present invention, there are four soft rope driving mechanisms. The soft rope driving mechanism is a motor connected to a reducer to drive the motor to drive the soft rope reel through a coupling to realize the driving function.

[0016] The control part of the present invention includes the control of the arm rotation, the hydraulic cylinder, the screw nut mechanism, the terminal link mechanism and the flexible cable drive mechanism. The writing of work instructions and programs is realized through the host computer, and the driver of each mechanism driving motor is controlled by the PLC motion controller, so that each mechanism executes the required motion instructions. The robot's sensor system is used for feedback and correction of the motion process, and information collection is realized through the information acquisition card, and transmitted to the motion controller for motion feedback.

[0017] The motion control method of the present invention is carried out according to the following steps:

[0018] Step 1: Initialize the control system and reset the drive motor and sensor.

[0019] Step 2: Confirm the work task of the robot, analyze and plan the execution process and trajectory according to the required task through the host PC, and write the corresponding execution program.

[0020] Step 3: The motion program input is transmitted to the PLC motion controller, and the PLC motion controller sends instructions to the boom rotation servo motor, hydraulic cylinder motor, screw nut mechanism motor, end link mechanism small-capacity servo motor, and flexible cable drive motor driver respectively.

[0021] Step 4: The driving motors of each execution part perform corresponding operations according to the instructions of the driver. The robot controls the rotation of the boom and uses the flexible cable to move to the desired position, and then fine-tunes the final position through the end link mechanism 4 to achieve the precise position of the target.

[0022] Step 5: If the robot performs repeated tasks at the same station, continue with step 4, otherwise proceed to step 6.

[0023] Step 6: The robot returns to its initial position. If entering the next task, return to step 2.

[0024] The advantages and positive effects of the present invention are:

[0025] 1. The present invention has a larger working space than the traditional robot by combining the serial and parallel connection mode, and the existence of the bottom guide rail enables the robot to have a variety of combination modes, which is suitable for large working space operations, and has a simple structure and uncomplicated control. The variable cable outlet point position at the boom gives the cable outlet point three degrees of freedom, thereby improving the adaptability of the robot.

[0026] 2. The posture of the end effector of the present invention is achieved through flexible cable drive, so that the robot end effector has a higher response speed when adjusting the working parts, thereby improving the efficiency of spraying.

[0027] 3. The present invention improves the degree of freedom of the end effector by optimizing the design of the end effector, and achieves rapid approach to the spraying target by the up and down movement of the boom and the flexible cable drive, and then fine-tunes the position of the working part by the end linkage mechanism of the end effector to achieve accurate, stable and efficient spraying.

[0028] 4. The present invention has made a new design for the boom part, which enables it to move up and down and rotate 360 ​​degrees. And through the design of movable counterweight block, it is realized that only the position of the counterweight block is moved and the balance and stability of the boom can be ensured by using the lever principle. BRIEF DESCRIPTION OF THE DRAWINGS

[0029] Figure 1 It is a schematic diagram of the overall structure of the present invention.

[0030] Figure 2 It is a schematic diagram of the structure of the present invention when it is working in a double-column state.

[0031] Figure 3 It is a schematic diagram of the structure of the present invention when it is working in a three-column state.

[0032] Figure 4 It is a schematic diagram of the explosion of the boom in the present invention.

[0033] Figure 5 It is a schematic diagram of the overall structure of the boom in the present invention.

[0034] Figure 6 It is a structural schematic diagram of the screw rod and nut transmission part in the present invention.

[0035] Figure 7 It is a schematic structural diagram of the terminal link mechanism in the present invention.

[0036] Figure 8 It is a schematic diagram of the transmission part of the terminal link mechanism in the present invention.

[0037] Fig. 9 It is a schematic diagram of the power transmission component structure of the terminal connecting rod mechanism in the present invention.

[0038] Fig.10 It is a connection diagram of the support, hydraulic cylinder and boom motor support in the present invention.

[0039] Fig.11 It is a structural schematic diagram of the flexible cable driving mechanism in the present invention.

[0040] Fig.12 It is a schematic diagram of the structural arrangement of the flexible cable in the present invention.

[0041] Fig.13 It is a schematic block diagram of the control system in the present invention.

[0042] Fig.14 is a flow chart of the motion control method in the present invention.

[0043] Fig.15 This is a schematic diagram of the overall structure of the present invention with an additional bottom guide rail 8. DETAILED DESCRIPTION

[0044] In order to make the above-mentioned objectives, technical solutions and advantages of the present invention more obvious and easy to understand, specific examples of the present invention are described in detail below with reference to the accompanying drawings.

[0045] like Figure 1 , 2 , 3 and 15, a multi-dimensional rigid-flexible coupling intelligent robot includes a boom 1, a hydraulic cylinder 2, a support 3, an end link mechanism 4, a flexible cable driving mechanism 5, and a flexible cable 7.

[0046] The boom 1 is movably connected to the support column 3. The boom 1 rotates relative to the support column 3 and moves along the vertical direction of the support column 3.

[0047] The cable drive mechanism 5 is arranged near the support 3. One end of the cable 7 is connected to the end link mechanism 4. The other end of the cable 7 is connected to the cable drive mechanism 5 across the boom 1. The length of the cable 7 is controlled by the cable drive mechanism 5. The robot includes two combinations: fixed or movable. The fixed combination includes two columns ( Figure 2 )、3 columns( Figure 3 ) and 4-post method ( Figure 4 ), at this time, the column position is fixed and cannot be changed. The movable combination mode is also provided with a bottom guide rail 8 ( Fig.15 ), the pillars 3 can be moved and locked on the bottom rails 8. According to the actual application scenario, by moving the required number of pillars on the bottom rails 8 to reach a suitable position, a robot suitable for the current application scenario is formed. When the robot is not working, the pillars 3 can slide together along the bottom rails 8, which is convenient for storage and maintenance and reduces the occupied space.

[0048] This robot has four degrees of freedom, namely, the translational freedom of the movable pulley part in the screw-nut mechanism 1 along the guide direction, the rotational freedom of the boom 1 around the vertical axis of the support, the vertical up and down movement freedom of the piston rod in the hydraulic cylinder 2, and the vertical up and down movement freedom of the terminal link mechanism 4. In addition, the terminal link mechanism 4 can also achieve rising and falling in the vertical direction through its own extension and retraction. The translation of the nut in the boom 1 on the screw guide is controlled by the screw motor, the rotation function of the boom 1 is controlled by the servo motor installed in the motor support above the hydraulic cylinder, the up and down movement of the boom 1 is controlled by the extension and retraction of the piston rod in the hydraulic cylinder, and the up and down movement of the terminal link mechanism 4 as a whole is controlled by the flexible cable 7 through the flexible cable driving mechanism 4, the extension and retraction of the terminal link mechanism 4 itself is driven by the motor to drive the bevel gear, and then through the spiral groove design of the power transmission part, it is realized by the extension and retraction of the connecting rod part. Two pulleys are installed at the lower end of the boom 1 of this robot, the one close to the pillar is a fixed pulley, and the other is a movable pulley. The movable pulley serves as the cable outlet point and connects the four corners of the terminal link mechanism 4.

[0049] like Figure 2 As shown, the robot is provided with two pillars 3. A hydraulic cylinder 2 is provided on each pillar 3. The top of the pillar 3 is movably connected to a boom 1 through the hydraulic cylinder 2. Adjacent booms 1, pillars 3, flexible cable drive mechanisms 5, hydraulic cylinders 2, and flexible cables 7 form a group. In the same group, the pillars 3 and flexible cable drive mechanisms 5 are connected together through the flexible cables 7.

[0050] When in use, the working part 6 is installed on the end link mechanism 4. The working part 6 is a spraying, welding, measuring, clamping, carrying or / and cutting device. And operate according to the following steps:

[0051] Step 1: Initialize the control system and reset the drive motor and sensor.

[0052] Step 2: After determining the task of the working part 6 connected to the terminal link mechanism 4, the host PC analyzes the required work tasks, plans the motion trajectory of the terminal link mechanism 4 and the motion trajectory of the working part 6, and writes the corresponding motion execution program.

[0053] Step 3: The motion execution program is transmitted to each drive motor of the intelligent robot through the PLC motion controller. The drive motors include: boom rotation servo motor, hydraulic cylinder motor, screw nut mechanism motor, end link mechanism small capacity servo motor, and flexible cable drive motor driver.

[0054] Step 4: Each drive motor performs corresponding operations according to the instructions of the PLC motion controller: the hydraulic cylinder 2 controls the boom 1 to move up and down in the vertical direction, the boom 1 and the hydraulic cylinder 2 rotate, and the servo motor controls the rotation of the boom 1. The spraying robot controls the up and down movement and rotation of the boom and uses the flexible rope to move to the desired position, and then fine-tunes the position through the end linkage mechanism 4 to achieve the target operation.

[0055] Step 5: If the robot performs repeated tasks at the same station, continue with step 4, otherwise proceed to step 6.

[0056] Step 6: The robot returns to its initial position. If it needs to proceed to the next task, it returns to step 2. Otherwise, it continues to wait for instructions.

[0057] like Figure 3 As shown, the adjacent booms 1, pillars 3, flexible cable drive mechanisms 5, and flexible cables 7 form a group. In the same group, the pillars 3 and flexible cable drive mechanisms 5 are connected together by the flexible cables 7.

[0058] There are three pillars 3. The pillars 3 are arranged in a herringbone shape. A boom 1 is provided on each pillar 3.

[0059] When in use, the working part 6 is installed on the end link mechanism 4. The working part 6 is a spraying, welding, measuring, clamping, carrying or / and cutting device. And operate according to the following steps:

[0060] Step 1: Initialize the control system and reset the drive motor and sensor.

[0061] Step 2: Determine the task of the working part 6 connected to the terminal link mechanism 4, analyze it through the host PC according to the required work task, plan the motion trajectory of the terminal link mechanism 4, and write the corresponding motion execution program.

[0062] Step 3: The motion execution program is transmitted to each drive motor of the intelligent robot through the PLC motion controller. The drive motors include: boom rotation servo motor, hydraulic cylinder motor, screw nut mechanism motor, end link mechanism small capacity servo motor, and flexible cable drive motor driver.

[0063] Step 4: The driving motors of each execution part perform corresponding operations according to the instructions of the PLC motion controller / driver. The robot controls the up and down movement, rotation and use of the flexible rope of the boom: first it moves horizontally on a plane to reach the top of the specified position, then moves up and down to the required position, and finally fine-tunes the position through the end link mechanism 4, thereby ensuring that the working part 6 achieves the target operation at the specified position.

[0064] Step 5: If the robot performs repeated tasks at the same station, continue with step 4, otherwise proceed to step 6.

[0065] Step 6: The robot returns to its initial position. If it is about to enter the next spraying task, it returns to step 2. Otherwise, it continues to wait for instructions.

[0066] like Figure 1 As shown, there are 4 pillars 3. A boom 1 is arranged on each pillar 3. A flexible cable driving mechanism 5 is arranged near each pillar 3. Each flexible cable driving mechanism 5 is connected to a flexible cable 7.

[0067] Adjacent booms 1, pillars 3, flexible cable drive mechanisms 5, and flexible cables 7 form a group. In the same group, the pillars 3 and flexible cable drive mechanisms 5 are connected together by the flexible cables 7.

[0068] like Figure 1 , 2 As shown in , 3 and 15, a working component 6 is provided at the bottom of the end link mechanism 4. The working component 6 is a spraying, welding, measuring, clamping, carrying or / and cutting device.

[0069] like Figure 4 and Figure 5The boom 1 includes a boom counterweight 201, a counterweight guide 202, a screw motor cover 203, a rigid support part 204, a movable slider guide 205, a movable slider 206, a screw 207, a screw nut 208, a pulley hanger 209, a pulley 210, a servo motor cover 211, a servo motor 212, an annular slider 213, a screw motor 214, a hanger 215, a plum blossom-shaped elastic coupling 216 and an angular contact ball bearing 217. The hanger 215 is connected with the screw motor cover 203, the rigid support part 204, and the movable slider guide 205 by hexagonal bolts. The cover 203 prevents the motor, the coupling and the bearing from being exposed. The movable slider guide 205 is located in the middle of the right side of the hanger 215 to realize the linear movement of the slider. The hanger 215 is provided with a boom counterweight 201 and a counterweight guide 202 at the tail. The hanger 215 places a cylindrical guide in the middle of each of the two grooves. The counterweight 201 is placed at the bottom and two through holes with the same diameter as the cylindrical guide are drilled. The counterweight 201 is placed between the two grooves. On the cylindrical guide, the lever principle is used to ensure that a counterweight can be adjusted on the guide to ensure the balance of the boom. There is no need to frequently replace the counterweight, which significantly optimizes the versatility. The mobile slider 205 is placed on the mobile slider guide, the pulley hanger 209 is fixed to the mobile slider 206 by a hexagonal bolt, a pulley 210 is fixed to the hanger 215 by an equal-length stud, and the other pulley 210 is connected to the pulley hanger 209 by an equal-length stud. The position of the cable outlet point is changed by the movement of the pulley hanger on the screw rod, thereby adjusting the working space. The base of the hanger 215 is circular, square or rectangular. The circular base of the hanger 215 is fixedly connected to the annular slider 213 and placed on the annular guide on the servo motor cover 211. The entire boom is driven to rotate by controlling the rotation of the servo motor 212. The screw motor 214 is placed inside the hanger and covered with the screw motor cover 203. The screw motor 214 realizes the movement of the pulley hanger 209 along the direction of the screw 207.

[0070] The movement and structure of the screw rod and the pulley hanger are further described in detail. Figure 6 The transmission part is composed of a screw motor 214, a plum blossom-shaped elastic coupling 216, and an angular contact ball bearing 217. The screw motor is connected to the active end of the plum blossom-shaped elastic coupling 216, and the passive end of the plum blossom-shaped elastic coupling 216 drives the screw 207 to rotate via two angular contact ball bearings 217. The pulley hanger 209 is connected to the screw by being fixed on the screw nut 208. As the screw 207 rotates, the screw nut 208 moves on the screw 207, thereby driving the pulley hanger 209 to move on the screw 207, thereby realizing the position change of the pulley 210, changing the position of the cable outlet point, and increasing the adaptability of the spray robot. Figure 7 , 89, the end link mechanism 4 includes a rope connector 301, a link mechanism base 302, a power transmission member 303, a connecting frame 304, a cylindrical gear 305, a two-hole link 306, a three-hole link 307, an internal threaded shoulder pin 308, a retaining ring shoulder pin 309, a working component 310, a small capacity servo motor 311, a small bevel gear 312, a large bevel gear 313, a bearing seat 314 and a bearing seat rotating shaft 315. The bearing seat 314 is fixed at the four corners above the link mechanism base 302 by four hexagonal bolts, the rope connector 301 is connected to the bearing seat rotating shaft 315 by a pin and a cotter pin, and the bearing seat rotating shaft 315 is connected to the bearing seat 314 by a bearing seat assembly. The rope connector part assembled by this connection method is flexible enough to ensure that when the flexible rope 7 lifts the end actuator, the flexible rope 7 will not be affected by other forces, thereby ensuring stability during lifting. A small-capacity servo motor 311 is fixed below the connecting rod mechanism base 302, and a small bevel gear 312 is fixedly connected to the motor shaft. The small bevel gear 312 and the large bevel gear 313 form a gear set to convert the torque direction. There is a through hole between the large bevel gear 313 and the power transmission member 303. The large bevel gear 313 and the power transmission member 303 are fixedly connected through the through hole, so that the motor drives the power transmission member 303 to rotate, and the spiral groove below the power transmission member 303 cooperates with the cylindrical gear to realize the extension and retraction of the connecting rod part as the power transmission member 303 rotates.

[0071] A total of three groups of connecting rod parts are designed under the connecting rod mechanism base 302 to ensure the stability of the telescopic movement. The connecting rod mechanism base 302 is used to place the cylindrical gear 305 and the two-hole connecting rod 306 in the first hole position connected to the connecting rod, and the cylindrical gear 305 and the two-hole connecting rod 306 are connected together through the internal threaded shoulder pin 308. The other hole of the two-hole connecting rod 306 is connected to the hole at the end of the three-hole connecting rod 307 through the retaining ring shoulder pin 309. The middle hole of the three-hole connecting rod 307 is connected to the connecting frame 304 with the retaining ring shoulder pin 309, and then two three-hole connecting rods 307 and the connecting frame 304 are connected in turn. The remaining holes of the three-hole connecting rod 307 are connected to a two-hole connecting rod 306. Furthermore, the remaining holes of the two-hole connecting rod 306 are connected to the connecting frame 304. It is necessary to pay attention to the connection method of the connecting rod part. When the connecting rods are connected, Figure 5 Figure 6 The first connecting rod is folded and connected as shown in the figure, the first connecting rod is deflected inwards and the next one is deflected outwards, and so on to the last connecting rod, the first connecting rod protrusion is downwards, the second one is upwards, and so on to the last one. Through such a design, the end connecting rod mechanism itself can be retracted and has good stability and rigidity. The working part 310 is fixed to the bottom of the entire end connecting rod mechanism 4 by a hexagonal head bolt and a hexagonal flange locking nut.

[0072] like Fig.10 The part supporting the boom 1 is composed of a motor support 401, a hydraulic cylinder piston rod 402, a hydraulic cylinder 403, a hexagonal bolt 404, a hexagonal nut 405 and a support 406. The motor support 401 plays the role of supporting the motor 212 that controls the rotation of the boom. The motor support 401 is fixed to the servo motor cover 211 by a hexagonal stud. The bottom of the motor support 401 is connected to the hydraulic piston rod 402. The hydraulic piston rod 402 is used in conjunction with the hydraulic cylinder 403. The four thin columns of the motor support 401 pass through the four through holes of the support 406, thereby ensuring that the motor support can be stably raised and lowered. The hydraulic cylinder 403 is fixed to the support 406 by a hexagonal bolt 404 and a hexagonal nut 405. The hydraulic cylinder piston rod extends up and down, driving the entire boom 1 to move up and down.

[0073] like Fig.11 The structure of the flexible cable driving mechanism 5 includes a motor 501, a helical gear reduction motor 502, a winding machine rolling body 503, a deep groove ball bearing 504, a winding drum 505 and a winding machine base 506. The robot has a total of four flexible cable driving mechanisms 4, and the structural arrangement is located on one side of the pillar. The flexible cable 7 is wound on the winding drum 505, and the end connecting rod mechanism 4 is driven by the motor 501. The winding machine rolling body 503 is placed above the winding machine base 506 through a deep groove ball bearing 504. The flexible cable passes through the gap between the two winding machine rolling bodies 503 and then crosses the pulley 210 to connect with the rope connector 301 on the end connecting rod mechanism 4. The design of the winding machine rolling body 503 can improve the stability of the flexible cable when driving and reduce vibration.

[0074] like Fig.12 Each flexible cable 7 is driven by its own flexible cable driving mechanism 5 to realize the up and down and left and right movement of the end effector, and the position of the cable outlet point is changed through the movable pulley, so that the size of the working space can be changed as needed, thereby increasing the adaptability of the robot. The flexible cable 7 can effectively drive the end effector by hanging the rope connectors 301 at the four symmetrical corners of the end effector, and exert a balancing force in the horizontal direction to improve the stability of the end effector, thereby improving the spraying quality.

[0075] Furthermore, the control system of the present invention is as follows Fig.13 As shown, the present invention processes various tasks through the host PC, writes the execution program, and uses the PLC motion controller to control the driver of each mechanism driving the motor, so that each mechanism executes the required motion instructions. The actuator of the control system includes the arm rotation, hydraulic cylinder, screw nut mechanism, end connecting rod mechanism and flexible cable drive mechanism. The sensor system of the robot is used for feedback and correction of the motion process. Information collection is realized through the information acquisition card, and transmitted to the host computer or PLC motion controller for motion feedback.

[0076] The preferred solution is: more than two bottom rails 8 are provided. A slider is provided on the bottom rail 8. The bottom of the support 3 is fixedly connected to the slider. A locking device is provided on the slider, and the slider is fixed to the bottom rail 8 by the locking device.

[0077] By using the bottom rail 8, the slider and the locking device in coordination, the pillars 3 can be folded together when the robot is in a standby state or when carrying large objects to be processed, saving space and facilitating the transportation of the objects to be processed. Before use, the pillars 3 with the slider installed are moved to the corresponding position, and the slider is fixed relative to the bottom rail 8 by the locking device.

[0078] like Fig.15 As shown, three bottom rails 8 are provided. Slide blocks are provided on the bottom rails 8. The bottom of the pillar 3 is fixedly connected to the slide block. The slide block is provided with a locking device, and the slide block is fixed to the bottom rail 8 by the locking device. That is, in this case, one pillar is directly fixed to the foundation. The remaining three are movably connected to the bottom rail 8 through the slide block in a lockable manner. In addition, the cable drive mechanism 5 is installed on the slide block.

[0079] By using the bottom rail 8, the slider and the locking device in coordination, the three movable pillars 3 are all folded near the pillars 3 fixedly connected to the foundation when the robot is in a standby state or when carrying large objects to be processed, saving space and facilitating the transportation of objects to be processed. Before use, the pillars 3 with the slider installed are moved to the corresponding position along the bottom rail 8, and the slider is fixed relative to the bottom rail 8 by the locking device.

[0080] See also Fig.14 The motion control method of a variable workspace rigid-flexible coupling hybrid spraying robot described in the present invention is carried out according to the following steps:

[0081] Step 1: Initialize the control system and reset the drive motor and sensor.

[0082] Determine whether a bottom guide rail 8 is provided:

[0083] If the robot includes a bottom rail 8, the position information of the support 3 with a slider is obtained by manual or automatic control. At this time, if the position information of the support 3 with a slider meets the setting requirements, the process proceeds to step 2. Otherwise, the support 3 with a slider is moved to a preset position along the bottom rail 8 by manual or automatic control, and then locked by a locking device, and then the process proceeds to step 2. The locking device is a mechanical component composed of a socket, a latch, a matching support seat and a cylinder.

[0084] If the robot does not include the bottom guide rail 8, proceed directly to step 2.

[0085] Step 2: Determine the spraying task, analyze and plan the spraying execution process and trajectory according to the required task through the host PC, and write the corresponding execution program.

[0086] Step 3: The motion execution program is transmitted to each drive motor of the intelligent robot through the PLC motion controller. The drive motors include: boom rotation servo motor, hydraulic cylinder motor, screw nut mechanism motor, end link mechanism small capacity servo motor and / or flexible cable drive motor driver.

[0087] Step 4:

[0088] The driving motors of each execution part perform corresponding operations according to the instructions of the PLC motion controller / driver. The robot controls the rotation of the boom and uses the flexible cable to move to the required position, and then fine-tunes the final position through the end link mechanism 4 to achieve the target operation.

[0089] Step 5: If the robot performs repeated tasks at the same station, continue with step 4, otherwise proceed to step 6.

[0090] Step 6: The robot returns to its initial position. If it is about to enter the next spraying task, it returns to step 2. Otherwise, it continues to wait for instructions.

[0091] The above description is only a preferred embodiment of the invention and is not intended to limit the invention. Any modifications, equivalent substitutions and improvements made within the spirit and principle of the invention should be included in the scope of protection of the invention.

Claims

1. A multi-dimensional rigid-flexible coupling intelligent robot, characterized in that: It comprises a boom (1), a hydraulic cylinder (2), a support (3), an end connecting rod mechanism (4), a flexible cable driving mechanism (5), and a flexible cable (7); wherein: The boom (1) and the support (3) are movably connected; the boom (1) rotates relative to the support (3) and moves in the vertical direction of the support (3); The flexible cable driving mechanism (5) is arranged near the support (3); one end of the flexible cable (7) is connected to the end connecting rod mechanism (4); the other end of the flexible cable (7) spans the boom (1) and is connected to the flexible cable driving mechanism (5); the length of the flexible cable (7) is controlled by the flexible cable driving mechanism (5); The boom (1) comprises a boom counterweight (201), a counterweight guide (202), a screw motor cover (203), a rigid support portion (204), a movable slider guide (205), a movable slider (206), a screw (207), a screw nut (208), a pulley hanger (209), a pulley (210), a servo motor cover (211), a servo motor (212), an annular slider (213), a screw motor (214) and a hanger (215); wherein: The hanger (215) is connected to the screw motor cover (203), the rigid support portion (204), and the movable slider guide (205) through hexagonal bolts; The movable slider guide (205) is located in the middle of the right side of the hanger (215) to realize the linear movement of the slider; the hanger (215) is provided with a boom counterweight (201) and a counterweight guide (202) at the tail, and the hanger (215) places a cylindrical guide in the middle of each of the two grooves, and the boom counterweight (201) is provided with two through holes with the same diameter as the cylindrical guide at the bottom, and the counterweight 201 is sleeved on the two cylindrical guides; the movable slider (206) is placed on the movable slider guide (205), and the pulley hanger (209) is fixed to the movable slider (206) by a hexagonal bolt; A pulley (210) is provided on the hanger (215), and the pulley (210) and the hanger (215) are fixed via studs of equal length; another pulley (210) is provided on the pulley hanger (209) via studs of equal length, and the pulley (210) and the pulley hanger (209) are fixed via another stud of equal length; the position of the cable outlet point is changed by the movement of the pulley hanger (209) on the screw rod (207), thereby adjusting the working space; the screw rod (207) and the screw rod nut (208) are matched; The base of the hanger (215) is circular, square or rectangular; the hanger (215) is fixedly connected to the annular slider (213) and is placed on an annular guide path on the servo motor cover (211); the entire hanging arm is driven to rotate by controlling the rotation of the servo motor (212); the screw motor (214) is placed inside the hanger and covered by the screw motor cover (203); the screw motor (214) realizes the movement of the pulley hanger (209) along the direction of the screw (207); Adjacent booms (1), pillars (3), flexible cable drive mechanisms (5), and flexible cables (7) form a group; within the same group, the pillars (3) and flexible cable drive mechanisms (5) are connected together via the flexible cables (7); Three pillars (3) are provided; the pillars (3) are arranged in a herringbone shape; and a suspension arm (1) is provided on each pillar (3).

2. The multi-dimensional rigid-flexible coupling intelligent robot according to claim 1, characterized in that: Four pillars (3) are provided; each pillar (3) is provided with a suspension arm (1); a flexible cable driving mechanism (5) is provided near each pillar (3); each flexible cable driving mechanism (5) is connected to a flexible cable (7); adjacent suspension arms (1), pillars (3), flexible cable driving mechanisms (5), and flexible cables (7) form a group; within the same group, the pillars (3) and flexible cable driving mechanisms (5) are connected together via the flexible cables (7).

3. The multi-dimensional rigid-flexible coupling intelligent robot according to claim 1, characterized in that: A working component (6) is provided at the bottom of the end link mechanism (4); the working component (6) is a spraying, welding, measuring, clamping, carrying and / or cutting device.

4. The multi-dimensional rigid-flexible coupling intelligent robot according to claim 1, characterized in that: The robot has four degrees of freedom, namely: the degree of freedom of translation of the movable pulley part in the screw-nut mechanism along the guide path, the degree of freedom of rotation of the boom (1) around the vertical axis of the support, the degree of freedom of the piston rod in the hydraulic cylinder (2) to move up and down in the vertical direction, and the degree of freedom of the end link mechanism (4) to move up and down in the vertical direction; in addition, the end link mechanism (4) can also realize the vertical rise and fall of the working part (6) by its own extension and retraction.

5. The multi-dimensional rigid-flexible coupling intelligent robot according to claim 1, characterized in that: The terminal link mechanism (4) comprises a rope connecting member (301), a link mechanism base (302), a power transmission member (303), a connecting frame (304), a cylindrical gear (305), a two-hole connecting rod (306), a three-hole connecting rod (307), an internal thread type shoulder pin (308), a retaining ring type shoulder pin (309), a nozzle (310), a small capacity servo motor (311), a small bevel gear (312), a large bevel gear (313), a bearing seat (314) and a bearing seat rotating shaft (315); The bearing seat (314) is fixed on the top of the connecting rod mechanism base (302) by bolts, the rope connecting member (301) is connected to the bearing seat rotating shaft (315), and the bearing seat rotating shaft (315) is connected to the bearing seat (314) together; the small-capacity servo motor (311) is fixed below the connecting rod mechanism base (302), and a small bevel gear (312) is fixedly connected to the motor rotating shaft, and the small bevel gear (312) and the large bevel gear (313) form a gear set to convert the torque direction, and a through hole is provided between the large bevel gear (313) and the power transmission member (303), and the large bevel gear (313) and the power transmission member (303) are fixedly connected through the through hole, so that the motor drives the power transmission member (303) to rotate, and the spiral groove below the power transmission member (303) cooperates with the cylindrical gear, so that the connecting rod part is driven to extend and retract as the power transmission member (303) rotates; The connecting rod mechanism base (302) is used to place a cylindrical gear (305) and a two-hole connecting rod (306) in the first hole position connected to the connecting rod, and connect the cylindrical gear (305) and the two-hole connecting rod (306) together through an internal thread type shoulder pin (308); the other hole of the two-hole connecting rod (306) is connected to the hole at the end of the three-hole connecting rod (307) through a retaining ring type shoulder pin (309); the middle hole position of the three-hole connecting rod (307) is connected to the connecting frame (304) through the retaining ring type shoulder pin (309), and then two three-hole connecting rods (307) and the connecting frame (304) are connected in sequence; the remaining hole positions of the three-hole connecting rod (307) are connected to a two-hole connecting rod (306).

6. The multi-dimensional rigid-flexible coupling intelligent robot according to claim 4, characterized in that: There are two or more bottom guide rails (8); a slider is provided on the bottom guide rail (8); the bottom of the support (3) is fixedly connected to the slider; a locking device is provided on the slider, and the slider and the bottom guide rail (8) are fixed together by the locking device; By using the bottom guide rail (8), the slider, and the locking device in coordination, the pillars (3) can be folded together when the robot is in a standby state or when carrying a large object to be processed, thereby saving space and facilitating the transportation of the object to be processed. Before use, the pillar (3) equipped with the slider is moved to a corresponding position, and the slider is fixed relative to the bottom guide rail (8) by the locking device.

7. The control method of the multi-dimensional rigid-flexible coupled intelligent robot according to claim 6, characterized in that: Proceed as follows: Step 1: Initialize the control system, reset the drive motor and sensor; Determine whether the bottom rail (8) is provided: If the robot includes a bottom rail (8), the position information of the support column (3) equipped with a slider is obtained by manual or automatic control. At this time, if the position information of the support column (3) equipped with a slider meets the setting requirements, the process proceeds to step 2. Otherwise, the support column (3) equipped with a slider is moved along the bottom rail (8) to a preset position by manual or automatic control, and then locked by a locking device, and then the process proceeds to step 2. The locking device is a mechanical component composed of a socket, a latch, a matching support seat and a cylinder. If the robot does not include a bottom rail (8), proceed directly to step 2; Step 2: Determine the work task of the working part (6) connected to the terminal link mechanism (4), perform task analysis based on the required work through the host PC, plan the motion trajectory of the terminal link mechanism (4), and write the corresponding motion execution program; The operating steps of the working component (6) installed on the end link mechanism (4) are as follows: Step a: Initialize the control system, reset the drive motor and sensor; Step b: Determine the task of the working part (6) connected to the terminal link mechanism (4), analyze the required work tasks through the host PC, plan the motion trajectory of the terminal link mechanism (4), and write the corresponding motion execution program; Step c: The motion execution program is transmitted to each drive motor of the intelligent robot through the PLC motion controller; the drive motors include: a boom rotation servo motor, a hydraulic cylinder motor, a screw nut mechanism motor, a small-capacity servo motor of the end connecting rod mechanism, and a flexible cable drive motor driver; Step d: The driving motors of each execution part perform corresponding operations according to the instructions of the PLC motion controller / driver. The robot controls the up and down movement, rotation and use of the flexible rope of the boom: firstly, it moves horizontally on a plane to reach the top of the specified position, then moves up and down to the required position, and finally, fine-tunes the position through the end link mechanism (4), thereby ensuring that the working part (6) achieves the target operation at the specified position; Step e: If the robot performs repeated tasks at the same station, continue with step 4, otherwise proceed to step 6; Step f: The robot returns to its initial position. If it is ready to enter the next task, it returns to step 2. Otherwise, it continues to wait for instructions. Step 3: The motion execution program is transmitted to each drive motor of the intelligent robot through the PLC motion controller; the drive motors include: a boom rotation servo motor, a hydraulic cylinder motor, a screw nut mechanism motor, a terminal connecting rod mechanism small capacity servo motor and / or a flexible cable drive motor driver; Step 4: The driving motors of each execution part perform corresponding operations according to the instructions of the PLC motion controller / driver. The robot controls the rotation of the boom and uses the flexible cable to move to the required position, and then fine-tunes the final position through the end link mechanism (4) to achieve the target operation; Step 5: If the robot performs repeated tasks at the same station, continue with step 4, otherwise proceed to step 6; Step 6: The robot returns to its initial position. If it is to enter the next task, it returns to step 2; otherwise, it continues to wait for instructions.

Citation Information

Patent Citations

  • Series-parallel robot with five degrees of freedom

    CN104057442A

  • Flexible rope driving series-parallel spraying robot mechanism and operating method thereof

    CN111360793A

  • Large-surface spraying flexible cable robot

    CN209093684U

  • Variable structure parameter flexible rope parallel connection robot system and control method

    CN104440870A

  • Cable-strut hybrid drive spraying robot with variable working interval

    CN113058778A