Flywheel-driven mechanical arm device and control system and control method

Abstract

The application relates to the technical field of mechanical arm design and control, in particular to a flywheel-driven mechanical arm device, a control system and a control method. The main structure of the mechanical arm device comprises a base, an arm rod, a joint and a flywheel driving device. The control system comprises a rotating speed reference regulator and a motor rotating speed controller. The motor rotating speed controller drives the flywheel driving device to track the target rotating speed according to the error between the target rotating speed and the actual rotating speed of the flywheel and the inner and outer frames, so that the actual pose of the mechanical arm tracks the target pose. The reaction flywheel is used as the power source of the mechanical arm, the same size of torque is output through the high-speed rotation of the flywheel and the change of the rotating speed of the deflection frame, the weight and the joint complexity of the mechanical arm are significantly reduced, the complex and heavy transmission structure is omitted, the motion control of the mechanical arm is realized, the control precision and the response speed are improved, and the mechanical arm has the advantages of simple structure, small rotating inertia, high reliability, high control precision, fast response speed and the like.

Description

Technical Field

[0001] The present invention relates to the technical field of robot arm design and control, and in particular to a flywheel-driven robot arm device, a control system and a control method. Background Art

[0002] Existing robotic arms have different driving modes such as motor module drive, rope (wire) drive, and fluid drive. Motor module drive has the advantages of high control precision and mature control technology, but it comes at the cost of large and bulky motors and reducer components, resulting in a large moment of inertia for the robot arm, which is not conducive to high-speed and long-distance motion. Fluid drive mainly includes pneumatic and hydraulic drive. Because it relies on large and complex energy preparation and distribution systems, such as oil tanks, solenoid valves, valve blocks, pumps, etc., it not only causes severe heat generation and low transmission efficiency during frequent switching operations, but also has the risk of leakage. In addition, the nonlinear mechanical properties of the fluid make the position control stability poor. Rope (wire) drive places the drive motor at the rear of the base, thereby reducing the moment of inertia of the robot arm. However, the resulting structures such as vias, pulleys, and winding drums serving the rope (wire) drive are very complex. In the case of long-distance transmission, the hysteresis deformation effect of the rope (wire) is also very obvious, resulting in poor end-positioning accuracy and load capacity. At the same time, there are various defects such as fatigue fracture and friction loss, which are not conducive to achieving long-distance, high-precision, and high-reliability motion control tasks. Therefore, there is an urgent need for a robotic arm with a new drive method that has a simple transmission structure, small rotational inertia, high reliability, fast response speed, and high control accuracy. Summary of the Invention

[0003] The purpose of the present invention is to avoid the shortcomings of the prior art and provide a flywheel-driven robotic arm device and control system, which eliminates the complex and bulky transmission structure, uses a reaction flywheel as the power source of the robotic arm, and realizes the motion control of the robotic arm.

[0004] To achieve the above object, the technical solution adopted by the present invention is as follows: a flywheel-driven mechanical arm device is characterized by comprising a base, a first arm being provided on the base via a first joint, a first flywheel driving device being provided at an upper end of the first arm, the first arm being connected to a second arm via a second joint, a second flywheel driving device being provided at an upper end of the second arm;

[0005] The first flywheel drive device and the second flywheel drive device have the same structure. The first flywheel drive device includes a flywheel, which is installed on the flywheel motor rotor shaft of the flywheel drive motor. A motor end cover is provided on the upper part of the flywheel drive motor, and a flywheel speed measurement and control module is also provided on the flywheel drive motor.

[0006] The first arm and the second arm adopt a rigid structure, the first flywheel drive device on the first arm is set as a single or two first right flywheel drive device and a first left flywheel drive device, and the second flywheel drive device on the second arm is set as a second right flywheel drive device and a second left flywheel drive device.

[0007] The first flywheel drive device also includes an inner frame installed on the flywheel motor rotor shaft, the inner frame is connected to the inner frame motor rotor shaft of the inner frame drive motor, and the inner frame drive motor is also provided with an inner frame speed measurement and control module.

[0008] An outer frame is mounted on the inner frame motor rotor shaft. The outer frame is connected to the outer frame motor rotor shaft of the outer frame drive motor. The outer frame drive motor is also provided with an outer frame speed measurement and control module.

[0009] The first arm and the second arm are replaced by a first flexible arm and a second flexible arm with a flexible structure. A third joint is arranged between the first flexible arm and the second flexible arm, and a fourth joint is arranged at the front end of the second flexible arm. The third joint and the fourth joint have the same structure. The third joint includes a joint shell, and the two ends of the joint shell are respectively provided with a joint left end cover and a joint right end cover respectively connected to the first flexible arm and the second flexible arm.

[0010] A first flywheel driving device is also provided in the joint housings of the third joint and the fourth joint.

[0011] The flywheel speed measurement and control module, the inner frame speed measurement and control module and the outer frame speed measurement and control module measure and control the flywheel, the inner frame and the outer frame through an angle sensor, an angular velocity sensor, a motor drive unit or a motor control unit.

[0012] The flywheel is made of steel, brass, bronze or cast iron.

[0013] A control system for a flywheel-driven robotic arm device is characterized by including a speed reference regulator and a motor speed controller. The speed reference regulator calculates the target speed of the flywheel and the inner and outer frames based on the error between the target posture and the actual posture of the robotic arm; the motor speed controller drives the flywheel drive device to track the target speed based on the error between the target speed and the actual speed of the flywheel and the inner and outer frames, thereby realizing that the actual posture of the robotic arm tracks the target posture.

[0014] A control method for a flywheel-driven robotic arm device is characterized by adopting closed-loop feedback control, comprising the following steps:

[0015] (1) The speed reference regulator takes the target posture signal of the manipulator and obtains the real-time posture signal of the manipulator, compares the two signals and obtains the difference as the posture error. The speed reference regulator uses the posture error signal as the input signal to calculate and convert it to obtain the target speed of the flywheel, inner frame and outer frame;

[0016] (2) The motor speed controller obtains the target speed signal and the real-time speed signal of the flywheel of the flywheel drive device and the frame, and then compares the two signals to obtain the difference as the speed error signal. The motor speed controller uses the speed error signal as an input signal to drive the flywheel device to track the target speed.

[0017] (3) According to the principle of action and reaction, the reaction inertia force caused by the rotation of the flywheel and its posture change will act on the robot arm through the left and right end covers of each joint, eventually causing the movement posture of the robot arm to change;

[0018] Furthermore, the real-time posture of the robotic arm during operation is taken as an input signal by the speed reference regulator, thereby forming a closed-loop feedback control to achieve precise control of the flywheel-driven robotic arm device system.

[0019] The beneficial effects of the present invention are: the flywheel-driven robotic arm device, control system and control method described above adopt a reaction flywheel as the power source of the robotic arm, and output a torque of the same magnitude through the high-speed rotation of the flywheel and the change in the rotation speed of the deflection frame, which significantly reduces the weight and joint complexity of the robotic arm, eliminates the complex and bulky transmission structure, and realizes the motion control of the robotic arm; it is conducive to improving the control accuracy and response speed, and has the advantages of simple structure, small moment of inertia, high reliability, high control accuracy, and fast response speed. BRIEF DESCRIPTION OF THE DRAWINGS

[0020] Figure 1 This is a schematic diagram of the principle of the flywheel-driven robotic arm device of the present invention;

[0021] Figure 2 It is a schematic structural diagram of a first flywheel driving device of a flywheel-driven robotic arm device of the present invention;

[0022] Figure 3 Schematic diagram of a rigid robotic arm driven by a flywheel according to the present invention;

[0023] Figure 4 Schematic diagram of the control system of the flywheel-driven rigid robotic arm device of the present invention;

[0024] Figure 5 Schematic diagram of a flexible robotic arm driven by a control torque gyroscope of the present invention;

[0025] Figure 6 Schematic diagram of the external structure of the joints of the flexible robotic arm driven by the control torque gyro of the present invention;

[0026] Figure 7 A schematic structural diagram of a preferred flywheel drive device for the joints of a flexible robotic arm driven by a control torque gyro according to the present invention;

[0027] Figure 8 This is a schematic structural diagram of another preferred flywheel drive device for controlling the joints of a flexible robotic arm driven by a torque gyro according to the present invention.

[0028] In the figure, 1 is a base; 2 is a first joint; 3 is a first arm; 4 is a first flywheel drive device; 4-1 is a first left flywheel drive device; 4-2 is a first right flywheel drive device; 4-3 is a flywheel; 4-4 is a flywheel drive motor; 4-5 is a flywheel motor rotor shaft; 4-6 is a motor end cover; 4-7 is a flywheel speed measurement and control module; 4-8 is an outer frame; 4-9 is a outer frame motor rotor shaft; 4-10 is an outer frame drive motor; 4-11 is an outer frame speed measurement and control module ; 4-12, inner frame; 4-13, inner frame motor rotor shaft; 4-14, inner frame drive motor; 4-15, inner frame speed measurement and control module; 5, second joint; 6, second arm; 7, second flywheel drive device; 7-1, second left flywheel drive device; 7-2, second right flywheel drive device; 8, first flexible arm; 9, second flexible arm; 10, third joint; 11, fourth joint; 12, joint left end cover; 13, joint housing; 14, joint right end cover. DETAILED DESCRIPTION

[0029] The principles and features of the present invention are described below with reference to the accompanying drawings. The examples given are only used to explain the present invention and are not used to limit the scope of the present invention.

[0030] In order to achieve the above object, the present invention provides the following specific implementation methods: Figure 1 and 2 As shown, the flywheel-driven robotic arm device is characterized by comprising a base 1, a first arm 3 is provided on the base 1 through a first joint 2, a first flywheel driving device 4 is provided on the upper end of the first arm 3, the first arm 3 is connected to the second arm 6 through a second joint 5, and a second flywheel driving device 7 is provided on the upper end of the second arm 6;

[0031] The first flywheel drive device 4 and the second flywheel drive device 7 have the same structure. The first flywheel drive device 4 includes a flywheel 4-3, which is mounted on a flywheel motor rotor shaft 4-5 of a flywheel drive motor 4-4. A motor end cap 4-6 is provided on the upper portion of the flywheel drive motor 4-4. The flywheel drive motor 4-4 is also provided with a flywheel speed measurement and control module 4-7. The flywheel speed measurement and control module 4-7 adjusts the output torque of the flywheel drive device by controlling the rotation of the flywheel 4-3 and / or the deflection of the flywheel motor rotor shaft 4-5 to adjust the magnitude and direction of the output torque of the flywheel drive device.

[0032] like Figure 3 As shown, the first arm 3 and the second arm 6 adopt a rigid structure, the first flywheel drive device 4 on the first arm 3 is set as a first right flywheel drive device 4-2 and a first left flywheel drive device 4-1, and the second flywheel drive device 7 on the second arm 6 is set as a second right flywheel drive device 7-2 and a second left flywheel drive device 7-1.

[0033] like Figure 7 As shown, the first flywheel drive device 4 also includes an inner frame 4-12 installed on the flywheel motor rotor shaft 4-5, and the inner frame 4-12 is connected to the inner frame motor rotor shaft 4-13 of the inner frame drive motor 4-14. The inner frame drive motor 4-14 is also provided with an inner frame speed measurement and control module 4-15.

[0034] like Figure 8 As shown, an outer frame 4-8 is also installed on the inner frame motor rotor shaft 4-13, and the outer frame 4-8 is connected to the outer frame motor rotor shaft 4-9 of the outer frame drive motor 4-10. The outer frame drive motor 4-10 is also provided with an outer frame speed measurement and control module 4-11.

[0035] like Figure 5 and 6 As shown, the first arm 3 and the second arm 6 are replaced with a first flexible arm 8 and a second flexible arm 9 of a flexible structure. A third joint 10 is provided between the first flexible arm 8 and the second flexible arm 9, and a fourth joint 11 is provided at the front end of the second flexible arm 9. The third joint 10 and the fourth joint 11 have the same structure. The third joint 10 includes a joint housing 13. The joint housing 13 has a left joint end cap 12 and a right joint end cap 14 respectively connected to the first flexible arm 8 and the second flexible arm 9. The first flywheel drive device 4 is also provided in the joint housing 13 of the third joint 10 and the fourth joint 11.

[0036] The flywheel speed measurement and control module 4-7, the inner frame speed measurement and control module 4-15 and the outer frame speed measurement and control module 4-11 realize the measurement and control of the flywheel 4-3, the inner frame 4-12 and the outer frame 4-8 through an angle sensor or an angular velocity sensor, a motor drive unit or a motor control unit.

[0037] The flywheel 4-3 is made of steel, brass, bronze or cast iron.

[0038] like Figure 4 As shown, a control system of a flywheel-driven manipulator device is characterized in that it includes a speed reference regulator and a motor speed controller. The speed reference regulator calculates the target speed of the inner frame 4-12 and the outer frame 4-8 of the flywheel 4-3 according to the error between the target posture and the actual posture of the manipulator; the motor speed controller drives the flywheel drive device to track the target speed according to the error between the target speed and the actual speed of the flywheel 4-3 and the inner and outer frames, so as to realize that the actual posture of the manipulator tracks the target posture.

[0039] A control method for a flywheel-driven robotic arm device control system is characterized by adopting closed-loop feedback control and includes the following steps:

[0040] (1) The speed reference regulator obtains the target posture signal of the manipulator and the real-time posture signal of the manipulator, compares the two signals and obtains the difference as the posture error. The speed reference regulator uses the posture error signal as the input signal to calculate and convert it to obtain the target speed of the flywheel 4-3, the inner frame 4-12 and the outer frame 4-8;

[0041] (2) The motor speed controller obtains the target speed signal and the real-time speed signal of the flywheel 4-3 of the flywheel drive device, and then compares the two signals to obtain the difference as a speed error signal. The motor speed controller uses the speed error signal as an input signal to drive the flywheel device to track the target speed.

[0042] (3) According to the principle of action and reaction, the reaction inertia force caused by the rotation of flywheel 4-3 and its posture change will act on the robot arm through the left end cover and the right end cover of each joint, eventually causing the movement posture of the robot arm to change;

[0043] Furthermore, the real-time posture of the robotic arm during operation is taken as an input signal by the speed reference regulator, thereby forming a closed-loop feedback control to achieve precise control of the flywheel-driven robotic arm device system.

[0044] In the aforementioned flywheel-driven robotic arm device, during operation, the rotation direction of the flywheel 4-3 is parallel to one rotation direction of the first arm 3 relative to the base 1. The first right flywheel drive device 4-2 and the first left flywheel drive device 4-1 are mounted perpendicularly and alternately on the first arm 3, with the rotation direction of their flywheels 4-3 being parallel to another rotation direction of the first arm 3 relative to the base 1. Based on the principle of action and reaction, the reaction inertial force caused by the rotation of the flywheel 4-3 acts on the first arm 3 through the motor end cap 4-6, ultimately causing the motion posture of the robotic arm to change.

[0045] When the robotic arm is working, the control system measures or calculates the actual joint angle value of the robotic arm in real time, calculates the error of the joint angle value, and based on the dynamics of the robotic arm, calculates the target amount of the flywheel speed that can generate the corresponding control torque in real time. The flywheel speed measurement and control module 4-7 measures the actual speed of the flywheel 4-3 and drives the flywheel drive motor to track the target amount. The flywheel 4-3 generates a corresponding reaction torque to act on the robotic arm, thereby changing the joint angle to track the target joint angle, and the cycle continues.

[0046] The flywheel-driven mechanical arm device, such as Figure 5-Figure 7 As shown, the flywheel drive device is installed inside the joint housing 13 of the third joint 10. The joint right end cap 14 is connected to the stator of the inner frame drive motor 4-14. The inner frame 4-12 is connected to the inner frame motor rotor shaft 4-13. The inner frame motor rotor shaft 4-13 is mounted on the joint housing 13 via a bearing and is driven by the inner frame drive motor 4-14. The stator of the flywheel drive motor 4-4 is connected to the inner frame 4-12. The flywheel 4-3 is connected to the flywheel motor rotor shaft 4-5. The flywheel motor rotor shaft 4-5 is mounted on the inner frame 4-12 via a bearing and is driven by the flywheel drive motor 4-4. The flywheel motor rotor shaft 4-5 perpendicularly intersects the inner frame motor rotor shaft 4-13.

[0047] According to the principle of action and reaction, the reaction inertia force caused by the rotation of flywheel 4-3 and its change in posture acts on the robotic arm through the left and right end caps of the third joint 10, ultimately causing the robotic arm's motion posture to change. While the robotic arm is operating, the control system measures or calculates the actual posture of the robotic arm in real time, calculates the posture error, and, based on the dynamics of the flexible robotic arm, calculates the target flywheel speed and internal frame speed in real time to generate the corresponding control torque.

[0048] The flywheel speed measurement and control module 4-7 measures the actual speed of the flywheel 4-3 and drives the flywheel drive motor 4-4 to track the flywheel speed target. The inner frame speed measurement and control module 4-15 measures the actual speed of the inner frame 4-12 and drives the inner frame drive motor 4-14 to track the inner frame speed target. This preferred single-frame flywheel drive device solution is suitable for applications with smaller loads.

[0049] Another preferred flywheel drive device scheme is as follows Figure 8 As shown, it is installed in the joint housing 13. Specifically, the joint right end cover 14 is connected to the stator of the outer frame drive motor 4-10, and the outer frame motor rotor shaft 4-9 is installed in the joint housing 13 through a bearing. The stator of the inner frame drive motor 4-14 is connected to the outer frame 4-8, and the inner frame 4-12 is connected to the inner frame motor rotor shaft 4-13. The inner frame motor rotor shaft 4-13 is installed on the outer frame 4-8 through a bearing, driven by the inner frame drive motor 4-14, and perpendicularly intersects with the outer frame motor rotor shaft 4-9. The stator of the flywheel drive motor 4-4 is connected to the inner frame 4-12, and the flywheel 4-3 is connected to the flywheel motor rotor shaft 4-5. The flywheel motor rotor shaft 4-5 is installed on the inner frame 4-12 through a bearing, driven by the flywheel drive motor 4-4, and perpendicularly intersects with the inner frame motor rotor shaft 4-13.

[0050] According to the principle of action and reaction, the reaction inertia force caused by the rotation of flywheel 4-3 and its posture change will act on the robotic arm through the left and right end caps of the third joint 10, ultimately causing the robotic arm's motion posture to change. When the robotic arm is operating, the control system measures or calculates the actual posture of the robotic arm in real time, calculates the posture error, and, based on the dynamics of the flexible robotic arm, calculates the target flywheel speed and the inner and outer frame speeds that can generate the corresponding control torque in real time. The flywheel speed measurement and control module 4-7 measures the actual speed of the flywheel and drives the flywheel drive motor 4-4 to track the flywheel speed target. The inner frame speed measurement and control module 4-15 measures the actual speed of the inner frame 4-12 and drives the inner frame drive motor 4-14 to track the inner frame 4-12 speed target. The outer frame speed measurement and control module 4-11 measures the actual speed of the outer frame 4-8 and drives the outer frame drive motor 4-10 to track the outer frame 4-8 speed target.

[0051] The flywheel-driven robotic arm device is suitable for occasions with larger loads, and is also suitable for different occasions such as on-orbit operation, aerial refueling, and medical surgery.

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

Claims

1. A flywheel-driven robotic arm device, characterized in that The invention comprises a base (1), wherein a first arm (3) is provided on the base (1) via a first joint (2), a first flywheel driving device (4) is provided at the upper end of the first arm (3), the first arm (3) is connected to a second arm (6) via a second joint (5), and a second flywheel driving device (7) is provided at the upper end of the second arm (6); The first flywheel drive device (4) and the second flywheel drive device (7) have the same structure. The first flywheel drive device (4) includes a flywheel (4-3). The flywheel (4-3) is mounted on a flywheel motor rotor shaft (4-5) of a flywheel drive motor (4-4). A motor end cover (4-6) is provided on the upper portion of the flywheel drive motor (4-4). A flywheel speed measurement and control module (4-7) is also provided on the flywheel drive motor (4-4). The first flywheel drive device (4) further comprises an inner frame (4-12) mounted on the flywheel motor rotor shaft (4-5), the inner frame (4-12) being connected to the inner frame motor rotor shaft (4-13) of the inner frame drive motor (4-14), and the inner frame drive motor (4-14) is further provided with an inner frame speed measurement and control module (4-15); An outer frame (4-8) is also mounted on the inner frame motor rotor shaft (4-13), the outer frame (4-8) is connected to the outer frame motor rotor shaft (4-9) of the outer frame drive motor (4-10), and an outer frame speed measurement and control module (4-11) is also provided on the outer frame drive motor (4-10); The flywheel speed measurement and control module (4-7), the inner frame speed measurement and control module (4-15), and the outer frame speed measurement and control module (4-11) measure and control the flywheel (4-3), the inner frame (4-12), and the outer frame (4-8) through an angle sensor, an angular velocity sensor, a motor drive unit, or a motor control unit. The invention comprises a speed reference regulator and a motor speed controller. The speed reference regulator calculates the target speed of the flywheel (4-3) and the inner frame (4-12) and the outer frame (4-8) according to the error between the target posture and the actual posture of the robot arm; the motor speed controller drives the flywheel driving device to track the target speed according to the error between the target speed and the actual speeds of the flywheel (4-3) and the inner and outer frames, so as to realize that the actual posture of the robot arm tracks the target posture.

2. A flywheel-driven robotic arm device according to claim 1, characterized in that: The first arm (3) and the second arm (6) are rigid structures. The first flywheel drive device (4) on the first arm (3) is configured as a single first right flywheel drive device (4-2) and a first left flywheel drive device (4-1) or two. The second flywheel drive device (7) on the second arm (6) is configured as a second right flywheel drive device (7-2) and a second left flywheel drive device (7-1).

3. A flywheel-driven robotic arm device according to claim 1, characterized in that: The first arm (3) and the second arm (6) are replaced by a first flexible arm (8) and a second flexible arm (9) with a flexible structure. A third joint (10) is provided between the first flexible arm (8) and the second flexible arm (9). A fourth joint (11) is provided at the front end of the second flexible arm (9). The third joint (10) and the fourth joint (11) have the same structure. The third joint (10) includes a joint housing (13). The two ends of the joint housing (13) are respectively provided with a joint left end cover (12) and a joint right end cover (14) connected to the first flexible arm (8) and the second flexible arm (9). A first flywheel drive device (4) is also provided in the joint housing (13) of the third joint (10) and the fourth joint (11).

4. A flywheel-driven robotic arm device according to claim 1, characterized in that: The flywheel (4-3) is made of steel, brass, bronze or cast iron.

5. The control method of a flywheel-driven robotic arm device according to claim 1, characterized in that: Adopt closed-loop feedback control, including the following steps: (1) The speed reference regulator obtains the target posture signal of the manipulator and the real-time posture signal of the manipulator, compares the two signals and obtains the difference as the posture error. The speed reference regulator uses the posture error signal as the input signal to calculate and convert it to obtain the target speed of the flywheel (4-3), the inner frame (4-12) and the outer frame (4-8); (2) The motor speed controller obtains the target speed signal and the real-time speed signal of the flywheel (4-3) of the flywheel drive device, and then compares the two signals to obtain the difference as a speed error signal. The motor speed controller uses the speed error signal as an input signal to drive the flywheel device to track the target speed. (3) According to the principle of action and reaction, the reaction inertia force caused by the rotation of the flywheel (4-3) and its posture change will act on the robot arm through the left end cover and the right end cover of each joint, eventually causing the movement posture of the robot arm to change.

6. The control method of a flywheel-driven robotic arm device according to claim 5, characterized in that: The real-time posture of the robotic arm during operation is taken as an input signal by the speed reference regulator, thereby forming a closed-loop feedback control to achieve precise control of the flywheel-driven robotic arm device system.

Images