Mechanical arm control device and method based on visual positioning
By designing joint driving mechanisms and joint locking mechanisms with the same structure but different sizes in the robotic arm, combined with the visual positioning system of 3D vision cameras and lidar, the gear damage caused by heavy load of the robotic arm joint is solved, and the machinery is improved The accuracy and service life of the arm reduce maintenance costs.
Patent Information
- Application Number
- CN202411461123.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-18
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-10-18
AI Technical Summary
The joints of the robot arm are damaged by the heavy load, which reduces the adjustment accuracy of the robot arm, shortens the maintenance cycle and increases costs.
A robot arm control device based on visual positioning is designed, and a first joint driving mechanism and a second joint driving mechanism with the same structure but different sizes are adopted to realize the locking state between the driving box and the rotating arm through the joint locking mechanism to avoid cones. The gear set causes tooth loss due to external force, and the object position information is obtained through 3D vision cameras and lidars, and the robotic arm movement command is generated in cooperation with the computer system to adjust the joint state in real time to complete the grabbing and removal actions.
It effectively avoids tooth loss caused by external force of bevel gear set, improves the rotation angle accuracy of the robot arm, protects the servo motor, extends the service life of the robot arm, and reduces maintenance costs.
Smart Images

Figure CN119017366A_ABST
Abstract
Description
Technical Field
[0001] The present invention specifically relates to the technical field of robotic arms, and in particular to a robotic arm control device and method based on visual positioning. Background Art
[0002] Visual positioning technology can determine the position of objects through image processing. At present, it is widely used in the field of intelligent robotic arms. In the control of robotic arms, real-time image transmission can be achieved through monocular vision, binocular vision or stereo vision. The image captured by the camera is used to calculate the position and posture of the target object in three-dimensional space through image processing algorithms, thereby providing accurate positioning information, allowing the robotic arm to accurately perform grasping and placement tasks in complex environments. However, after long-term manipulation operations, it was found that the joints between the single robotic arms were damaged due to heavy loads, causing the drive gear set or drive motor to be damaged, thereby reducing the adjustment accuracy between the single robotic arms, thereby shortening the maintenance cycle of the robotic arm and increasing costs. Summary of the invention
[0003] To this end, the present invention proposes a robot arm control device and method based on visual positioning to solve the problems raised in the above background technology.
[0004] To achieve the above object, the present invention provides the following technical solution: a robot arm control device based on visual positioning, comprising:
[0005] A first rotating arm, a mounting seat being fixed on the top end thereof;
[0006] A second rotating arm, a first joint driving mechanism being connected to the first rotating arm, and the first joint driving mechanism being capable of adjusting an angle between the first rotating arm and the second rotating arm;
[0007] A rotating seat, which is rotatably mounted on the second rotating arm and driven by a servo motor fixed on the second rotating arm;
[0008] A third rotating arm, a second joint driving mechanism is connected between the third rotating arm and the rotating seat, and the second joint driving mechanism can adjust the angle between the rotating seat and the third rotating arm;
[0009] And an end effector, which is fixedly mounted on the bottom end of the third rotating arm.
[0010] Further, preferably, the first joint driving mechanism and the second joint driving mechanism have the same structure but different sizes.
[0011] Further, as a preference, the first joint driving mechanism comprises
[0012] A drive box, which is fixed on the first rotating arm;
[0013] A rotating shaft, which is installed between the two bearing seats at the bottom of the driving box, and both ends of the rotating shaft extend outward and are fixedly connected to the U-shaped end of the second rotating arm;
[0014] A driven gear, which is disposed in the driving box and fixed on the side wall of the rotating shaft;
[0015] A driving bevel gear meshes with the driven gear for transmission, and the driving bevel gear is driven by a servo motor 2 fixed in the driving box;
[0016] And a joint locking mechanism is connected between the driving box and the U-shaped end of the second rotating arm, and the joint locking mechanism can drive the driving box and the second rotating arm to be fixedly locked.
[0017] Further, as a preference, the joint locking mechanism comprises an inner slide, an outer slide and two pressure-stopping components, wherein the inner slide cooperates with the outer slide to slide, the bottom end of the inner slide is rotatably connected to the U-shaped end of the second rotating arm, and the top end of the outer slide is rotatably connected to the driving box;
[0018] The two pressure-stop components are both fixed on the U-shaped end of the second rotating arm and are symmetrically arranged on the left and right sides of the outer sliding member, and the two pressure-stop components can squeeze the telescopic rod at the same time to limit the distance between the outer sliding member and the U-shaped end of the second rotating arm, so that the drive box and the second rotating arm remain in a locked state.
[0019] Further, as a preference, the pressure stop assembly comprises
[0020] A cylinder seat, which is fixed on the U-shaped end of the second rotating arm;
[0021] The damping block has a plurality of sliding holes in an array on its inner circumference, and an embedded ring is fixed in each of the sliding holes and close to the cylinder seat;
[0022] Sliding posts, the number of which is the same as the embedded ring, one end of each of the sliding posts is fixed on the cylinder seat, and the other end of each of the sliding posts is fixed with a limit block;
[0023] And a push cylinder is fixed on the cylinder seat, and the driving end of the push cylinder can push the damping block to move toward the outer sliding member and perform extrusion locking.
[0024] Further, preferably, the outer diameter of the limit block is slightly smaller than the inner diameter of the sliding hole.
[0025] Further, preferably, a compression spring is wound on the side wall of the sliding column, and the compression spring is located between the limit block and the embedded ring.
[0026] Further, as a preferred embodiment, it also includes
[0027] The visual positioning system consists of a 3D vision camera and a laser radar mounted on the end effector;
[0028] A robot arm control system, which is composed of a controller fixed on the first rotating arm and four sensors, wherein the four sensors are respectively installed on the first rotating arm, the second rotating arm, the third rotating arm and the rotating seat;
[0029] And a computer system, which is connected with the visual positioning system signal and sends control instructions to the first joint drive mechanism, the second joint drive mechanism and the servo motor through the controller.
[0030] The present invention also provides a robot arm control method based on visual positioning, which comprises the following steps:
[0031] Step 1: Obtain the location information of the object through 3D vision camera and lidar;
[0032] Step 2: Establish a digital model through a computer system, calculate and determine the point cloud data and spatial coordinates of the digital model;
[0033] Step 3: Perform motion recognition calculations based on the end effector coordinates to generate robot arm movement instructions, and use 3D visual cameras to guide the movements and perform obstacle avoidance actions;
[0034] Step 4: The controller receives the signal from the sensor and cooperates with the visual positioning system to adjust the angle between the first rotating arm and the second rotating arm, the rotation angle of the rotating seat, and the angle between the rotating seat and the third rotating arm, so as to control the overall motion state of the robot arm;
[0035] Step 5: Obtain the joint status of the robot arm in real time and adjust the position and posture of the end effector until the grasping and unloading actions are completed.
[0036] The present invention adopts the above technology and has the following beneficial effects compared with the existing technology:
[0037] The device of the present invention is provided with a first joint driving mechanism and a second joint driving mechanism with the same structure, wherein the first joint driving mechanism can drive the first rotating arm and the second rotating arm to adjust the angle. After the adjustment is completed, each push cylinder is started to drive the damping block to continuously move toward the outer sliding member. The damping block overcomes the elastic force of each compression spring and squeezes and fixes the outer sliding member, thereby limiting the positional relationship between the outer sliding member and the U-shaped end of the second rotating arm, so that a locking state is formed between the second rotating arm and the first rotating arm, thereby forming an auxiliary load, which can prevent the bevel gear set from being damaged by a large external force, thereby affecting the accuracy of the rotation angle between the second rotating arm and the first rotating arm, and also protects the servo motor 2;
[0038] The second joint driving mechanism is similar to the above, which drives the angle adjustment and locking action between the rotating seat and the third rotating arm to ensure the overall strength of the robotic arm. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] Figure 1 It is a schematic diagram of the three-dimensional structure of a robotic arm control device based on visual positioning;
[0040] Figure 2 It is a side view structural schematic diagram of a robotic arm control device based on visual positioning;
[0041] Figure 3 It is a structural schematic diagram of a first joint driving mechanism in a robotic arm control device based on vision positioning;
[0042] Figure 4 for Figure 3 A magnified schematic diagram of part A;
[0043] Figure 5 A schematic diagram of the connection between a damping block and a sliding column in a robotic arm control device based on visual positioning;
[0044] Figure 6 It is a system layout diagram of a robot arm control device based on vision positioning;
[0045] Figure 7 The figure is a flow chart of a robotic arm control method based on visual positioning.
[0046] In the figure: 1. mounting base; 2. controller; 3. first joint drive mechanism; 4. first rotating arm; 5. second rotating arm; 6. servo motor 1; 7. rotating base; 8. third rotating arm; 9. end effector; 10. second joint drive mechanism; 31. servo motor 2; 32. active bevel gear; 33. drive box; 34. rotating shaft; 35. driven gear; 36. inner slide; 37. outer slide; 38. push cylinder; 39. cylinder seat; 40. damping block; 41. sliding column; 42. embedded ring; 43. compression spring; 44. limit block. DETAILED DESCRIPTION
[0047] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0048] Example: Please refer to the attached Figure 1-7The present invention provides a technical solution: a robotic arm control device based on visual positioning, comprising:
[0049] A first rotating arm 4, a mounting seat 1 is fixed on the top end thereof;
[0050] The second rotating arm 5 is connected to the first rotating arm 4 by a first joint driving mechanism 3, and the first joint driving mechanism 3 can adjust the angle between the first rotating arm 4 and the second rotating arm 5;
[0051] A rotating seat 7, which is rotatably mounted on the second rotating arm 5 and driven by a servo motor 6 fixed on the second rotating arm 5;
[0052] The third rotating arm 8 is connected to the rotating seat 7 by a second joint driving mechanism 10, and the second joint driving mechanism 10 can adjust the angle between the rotating seat 7 and the third rotating arm 8;
[0053] And an end effector 9 which is fixedly mounted on the bottom end of the third rotating arm 8 .
[0054] In this embodiment, the first joint driving mechanism 3 and the second joint driving mechanism 10 have the same structure but different sizes. That is, the first joint driving mechanism 3 and the second joint driving mechanism 10 have the same structure but different sizes.
[0055] In this embodiment, the first joint driving mechanism 3 includes
[0056] A drive box 33, which is fixed on the first rotating arm 4;
[0057] The rotating shaft 34 is installed between the two bearing seats at the bottom of the driving box 33, and both ends of the rotating shaft 34 extend outward and are fixedly connected to the U-shaped end of the second rotating arm 5;
[0058] A driven gear 35, which is disposed in the driving box 33 and fixed on the side wall of the rotating shaft 34;
[0059] The driving bevel gear 32 is meshed with the driven gear 35 for transmission, and the driving bevel gear 32 is driven by a servo motor 31 fixed in the driving box 33;
[0060] Specifically, the servo motor 31 drives the active bevel gear 32 to rotate clockwise or counterclockwise, and the active bevel gear 32 is meshed with the driven gear 35 to drive the second rotating arm 5 to flip forward or reverse through the rotating shaft 34;
[0061] And a joint locking mechanism, which is connected between the driving box 33 and the U-shaped end of the second rotating arm 5, and the joint locking mechanism can drive the driving box 33 and the second rotating arm 5 to be fixedly locked.
[0062] In this embodiment, the joint locking mechanism is composed of an inner slide 36, an outer slide 37 and two pressing components, wherein the inner slide 36 and the outer slide 37 are slidably connected, the bottom end of the inner slide 36 is rotatably connected to the U-shaped end of the second rotating arm 5, and the top end of the outer slide 37 is rotatably connected to the driving box 33;
[0063] Specifically, a slider is provided in the outer sliding member 37 for sliding cooperation, and is used to limit the sliding distance between the inner sliding member 36 and the outer sliding member 37, and the slider is fixedly connected to the inner sliding member 36;
[0064] The two pressing stop assemblies are fixed on the U-shaped end of the second rotating arm 5 and are symmetrically arranged on the left and right sides of the outer sliding member 37. The two pressing stop assemblies can squeeze the telescopic rod 37 at the same time to limit the distance between the outer sliding member 37 and the U-shaped end of the second rotating arm 5, so that the driving box 33 and the second rotating arm 5 remain in a locked state;
[0065] It should be added that a rubber layer is fixed on the side wall of the outer sliding member 37 to increase friction resistance.
[0066] In this embodiment, the pressure stop assembly includes
[0067] A cylinder seat 39, which is fixed on the U-shaped end of the second rotating arm 5;
[0068] The damping block 40 has a plurality of sliding holes in an array on its inner circumference, and an embedded ring 42 is fixed in each sliding hole and close to the cylinder seat 39;
[0069] Slide posts 41, the number of which is the same as the number of the embedded rings 42, one end of each slide post 41 is fixed to the cylinder seat 39, and the other end of each slide post 41 is fixed to a limit block 44;
[0070] and a push cylinder 38, which is fixed on a cylinder seat 39, and a driving end of the push cylinder 38 can push the damping block 40 to move toward the outer slide 37 and perform extrusion locking;
[0071] Specifically, after the adjustment action between the first rotating arm and the second rotating arm is completed, each push cylinder 38 is started, driving the damping block to continuously move toward the outer sliding member. The damping block overcomes the elastic force of each compression spring and squeezes and fixes the outer sliding member 37, thereby limiting the positional relationship between the outer sliding member 37 and the U-shaped end of the second rotating arm 5, so that a locking state is formed between the second rotating arm 5 and the first rotating arm, thereby forming an auxiliary load, which can prevent the bevel gear set from generating tooth damage due to a large external force, thereby affecting the accuracy of the rotation angle between the second rotating arm 5 and the first rotating arm, and also protects the servo motor 2.
[0072] It should be noted that the structure of the first joint driving mechanism is the same as that of the second joint driving mechanism, that is, the adjustment method between the rotating seat and the third rotating arm is the same as the adjustment method between the first rotating arm and the second rotating arm, so it will not be repeated.
[0073] In this embodiment, the outer diameter of the limit block 44 is slightly smaller than the inner diameter of the sliding hole, so that the limit block 44 can slide into the sliding hole, but the outer diameter of the limit block 44 is larger than the inner diameter of the embedded ring 42 .
[0074] In this embodiment, a compression spring 43 is wound around the side wall of the sliding column 41 , and the compression spring 43 is located between the limiting block 44 and the embedded ring 42 .
[0075] In this embodiment, it also includes
[0076] A visual positioning system, which is composed of a 3D visual camera and a laser radar installed on the end effector 9;
[0077] The robot arm control system is composed of a controller 2 fixed on the first rotating arm 4 and four sensors, wherein the four sensors are respectively installed on the first rotating arm 4, the second rotating arm 5, the third rotating arm 8 and the rotating seat 7;
[0078] Specifically, the motion states of the first rotating arm, the second rotating arm, the third rotating arm and the rotating seat 7 are monitored in real time by sensors, such as position, speed, acceleration, angle, etc.;
[0079] And a computer system, which is connected to the visual positioning system signal and sends control instructions to the first joint drive mechanism 3, the second joint drive mechanism 10, and the servo motor 6 through the controller 2.
[0080] The present invention also provides a robot arm control method based on visual positioning, which comprises the following steps:
[0081] Step 1: Obtain the location information of the object through 3D vision camera and lidar;
[0082] Step 2: Establish a digital model through a computer system, calculate and determine the point cloud data and spatial coordinates of the digital model;
[0083] Step 3: Perform motion recognition calculations based on the end effector coordinates to generate robot arm movement instructions, and use 3D visual cameras to guide the movements and perform obstacle avoidance actions;
[0084] Step 4: The controller 2 receives the signal from the sensor and cooperates with the visual positioning system to adjust the angle between the first rotating arm 4 and the second rotating arm 5, the rotation angle of the rotating seat 7, and the angle between the rotating seat 7 and the third rotating arm 8, so as to control the overall motion state of the robot arm;
[0085] Step 5: Obtain the joint status of the robot arm in real time and adjust the position and posture of the end effector until the grasping and unloading actions are completed.
[0086] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.
Claims
1. A robotic arm control device based on visual positioning, characterized in that: It includes: A first rotating arm (4), a mounting seat (1) being fixed on the top end thereof; a second rotating arm (5), a first joint driving mechanism (3) being connected between the second rotating arm (5) and the first rotating arm (4), and the first joint driving mechanism (3) being capable of adjusting the angle between the first rotating arm (4) and the second rotating arm (5); a rotating seat (7) which is rotatably mounted on the second rotating arm (5) and driven by a servo motor 1 (6) fixed on the second rotating arm (5); a third rotating arm (8), a second joint driving mechanism (10) being connected between the third rotating arm (8) and the rotating seat (7), and the second joint driving mechanism (10) being capable of adjusting the angle between the rotating seat (7) and the third rotating arm (8); And an end effector (9), which is fixedly mounted on the bottom end of the third rotating arm (8).
2. The robot arm control device based on visual positioning according to claim 1, characterized in that: The first joint drive mechanism (3) and the second joint drive mechanism (10) have the same structure but different sizes.
3. The robot arm control device based on visual positioning according to claim 2, characterized in that: The first joint driving mechanism (3) comprises A drive box (33) fixed on the first rotating arm (4); A rotating shaft (34) is installed between two bearing seats at the bottom of the driving box (33), and both ends of the rotating shaft (34) extend outward and are fixedly connected to the U-shaped end of the second rotating arm (5); A driven gear (35) disposed in the driving box (33) and fixed on a side wall of the rotating shaft (34); A driving bevel gear (32) meshing with the driven gear (35) for transmission, and the driving bevel gear (32) is driven by a servo motor 2 (31) fixed in the driving box (33); and a joint locking mechanism connected between the drive box (33) and the U-shaped end of the second rotating arm (5), wherein the joint locking mechanism can drive the drive box (33) and the second rotating arm (5) to be fixedly locked.
4. The robot arm control device based on visual positioning according to claim 3, characterized in that: The joint locking mechanism comprises an inner sliding member (36), an outer sliding member (37) and two pressing stop assemblies, wherein the inner sliding member (36) and the outer sliding member (37) are slidably connected with each other, the bottom end of the inner sliding member (36) is rotatably connected to the U-shaped end of the second rotating arm (5), and the top end of the outer sliding member (37) is rotatably connected to the driving box (33); The two pressure-stop assemblies are both fixed on the U-shaped end of the second rotating arm (5) and are symmetrically arranged on the left and right sides of the outer sliding member (37). The two pressure-stop assemblies can simultaneously squeeze the telescopic rod (37) to limit the distance between the outer sliding member (37) and the U-shaped end of the second rotating arm (5), so that the drive box (33) and the second rotating arm (5) remain in a locked state.
5. The robot arm control device based on visual positioning according to claim 4, characterized in that: The pressure stop assembly includes A cylinder seat (39) fixed on the U-shaped end of the second rotating arm (5); A damping block (40) having a plurality of sliding holes in an array on its inner circumference, and an embedded ring (42) is fixed in each of the sliding holes and close to the cylinder seat (39); Sliding posts (41) having the same number as the embedded ring (42), one end of each sliding post (41) being fixed on the cylinder seat (39), and the other end of each sliding post (41) being fixed with a limiting block (44); And a push cylinder (38) fixed on the cylinder seat (39), the driving end of the push cylinder (38) can push the damping block (40) to move in the direction of the outer sliding member (37) and perform extrusion locking.
6. The robot arm control device based on visual positioning according to claim 5, characterized in that: The outer diameter of the limit block (44) is slightly smaller than the inner diameter of the sliding hole.
7. The robot arm control device based on visual positioning according to claim 5, characterized in that: A compression spring (43) is wound around the side wall of the sliding column (41), and the compression spring (43) is located between the limit block (44) and the embedded ring (42).
8. The robot arm control device based on visual positioning according to claim 1, characterized in that: Also includes A visual positioning system, which is composed of a 3D vision camera and a laser radar installed on the end effector (9); A robot arm control system, comprising a controller (2) fixed on a first rotating arm (4) and four sensors, wherein the four sensors are respectively mounted on the first rotating arm (4), the second rotating arm (5), the third rotating arm (8) and the rotating seat (7); And a computer system, which is connected to the visual positioning system signal and issues control instructions to the first joint drive mechanism (3), the second joint drive mechanism (10), and the servo motor 1 (6) through the controller (2).
9. A robotic arm control method based on visual positioning, characterized in that: It includes the following steps: Step 1: Obtain the location information of the object through 3D vision camera and lidar; Step 2: Establish a digital model through a computer system, calculate and determine the point cloud data and spatial coordinates of the digital model; Step 3: Perform motion recognition calculations based on the coordinates of the end effector (9) to generate robot arm movement instructions, and use a 3D visual camera to guide the motion and perform obstacle avoidance actions; Step 4: The controller (2) receives the signal from the sensor and cooperates with the visual positioning system to adjust the angle between the first rotating arm (4) and the second rotating arm (5), the rotation angle of the rotating seat (7), and the angle between the rotating seat (7) and the third rotating arm (8), so as to control the overall motion state of the robot arm; Step 5: Obtain the joint status of the robot arm in real time and adjust the position and posture of the end effector (9) until the grasping and unloading actions are completed.
Citation Information
Patent Citations
Mechanical arm active grabbing device and method based on multi-model fusion
CN109129474A
Upper limb artificial limb system and control method thereof
CN114795602A
Object grabbing method based on visual feedback control
CN116652962A
Mechanical arm grabbing system and method based on visual servo
CN116749233A
Neurosurgery operation arm holder
CN208160661U
