Synchronous control method, device and equipment for double control moment gyroscopes of robot, robot and storage medium

Through the software-level dual-control torque gyro synchronization control method, the attitude control torque and synchronous correction torque of the servo motor are used to achieve synchronous rotation of CMGs, which solves the problem of synchronous control of dual CMGs in the existing technology, and reduces the design difficulty and structural complexity. Improved flexibility and error compensation capabilities.

CN119017377APending Publication Date: 2024-11-26SHENZHEN SNAIL POWER TECHNOLOGY CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411098629.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-12
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

In the prior art, dual control torque gyros (CMGs) need to be strictly guaranteed to have the same rotation angle and opposite direction during synchronous control, otherwise the interference torque will not be completely eliminated, which increases the requirements for synchronous rotation structure.

Method used

The dual-control torque gyro synchronous control method at the software level is adopted. By receiving the pitch and inclination angle of the robot and the flip angle of the control torque gyro, the attitude control torque and synchronous correction torque of the servo motor are calculated to realize the transmission of the final output torque, and the PID algorithm is used for Error compensation reduces the impact on the original algorithm.

Benefits of technology

No additional mechanical structure is required, which reduces design difficulty and structural complexity, improves flexibility, facilitates the maintenance and expansion of programs and functions, and realizes error compensation and synchronization of CMGs flip angles.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119017377A_ABST
    Figure CN119017377A_ABST
Patent Text Reader

Abstract

The invention provides a synchronous control method, device and equipment for double control moment gyroscopes of a robot, the robot and a storage medium. The synchronous control method comprises the following steps: receiving a pitching inclination angle of the robot and turnover angles of the two control moment gyroscopes; according to the pitching inclination angle of the robot, attitude control moments of the two servo motors are calculated; calculating an angle difference value of the overturning angles of the two control moment gyroscopes according to the overturning angles of the two control moment gyroscopes; according to the respective overturning angles and the angle difference value of the two control moment gyroscopes, respectively calculating synchronous correction moments of the two servo motors; respectively calculating final output torque of the two servo motors according to the attitude control torque and the synchronous correction torque; and the final output torque is transmitted to the two servo motors. According to the method, error compensation and synchronization of the CMGs overturning angle are realized, meanwhile, the design difficulty and the structural complexity are reduced, and the influence on an original algorithm is reduced.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] Embodiments of the present invention generally relate to the field of robotics technology, and more specifically, to a method, device, equipment, robot and storage medium for synchronously controlling a dual control moment gyroscope of a robot. Background Art

[0002] In the field of robotics, control moment gyroscopes (CMGs) are used for attitude control. Control moment gyroscopes are a common attitude adjuster in aerospace, which generates the required gyro torque through the precession effect of the gyroscope to achieve spacecraft attitude control. Due to the characteristics of CMGs, such as fast response, high control accuracy and large output torque, they are also used in the field of attitude control of robots.

[0003] When a single CMG is working, in addition to generating torque in the desired direction, it will also generate interference torque perpendicular to the driving torque direction and the desired gyro torque direction, which is not conducive to the attitude control of the robot. Therefore, the field of robotics often uses two CMGs arranged in parallel and rotating in opposite directions, so that the interference torques generated by the CMGs cancel each other out and only retain the gyro torque in the desired direction. However, the coordinated operation of the two CMGs must strictly ensure that the rotation angles are the same and in opposite directions, otherwise the interference torque cannot be completely eliminated, which also puts forward certain requirements for the synchronous rotation structure. Summary of the invention

[0004] In order to solve the above problems in the prior art, in the first aspect, the embodiment of the present invention provides a method for synchronous control of dual control moment gyros of a robot, wherein the robot comprises two control moment gyros and two corresponding servo motors, wherein the two control moment gyros are arranged symmetrically on both sides, the flywheels of the two control moment gyros rotate in opposite directions, and the two servo motors are used to apply a precession torque to the corresponding control moment gyros to drive the two control moment gyros to flip in opposite directions to each other. The method comprises: receiving the pitch tilt angle of the robot and the flip angle of the two control moment gyros; calculating the attitude control torque of the two servo motors according to the pitch tilt angle of the robot; calculating the angle difference of the flip angle of the two control moment gyros according to the flip angle of the two control moment gyros; calculating the synchronous correction torque of the two servo motors according to the flip angle of each of the two control moment gyros and the angle difference; calculating the final output torque of the two servo motors according to the attitude control torque and the synchronous correction torque; transmitting the final output torque to the two servo motors.

[0005] In some embodiments, the method also includes an initialization phase, during which: a reset signal is generated and the reset signal is transmitted to the two servo motors so that the two servo motors drive the two control moment gyroscopes to flip to a zero position; a target speed signal is generated and the target speed signal is transmitted to the two control moment gyroscopes so that the internal flywheels of the two control moment gyroscopes are accelerated to a target speed.

[0006] In some implementations, receiving the pitch tilt angle of the robot and the roll angles of the two control moment gyroscopes includes: receiving the pitch tilt angle of the robot and the roll angles of the two control moment gyroscopes according to a predefined acquisition cycle.

[0007] In some implementations, receiving the pitch tilt angle of the robot and the roll angles of the two control moment gyroscopes includes: receiving the pitch tilt angle of the robot and the roll angles of the two control moment gyroscopes in real time.

[0008] In some embodiments, the following steps are performed according to a predefined calculation cycle: calculating the attitude control torque of the two servo motors according to the pitch and tilt angles of the robot; calculating the angle difference of the flip angles of the two control moment gyroscopes according to the flip angles of the two control moment gyroscopes; calculating the synchronization correction torque of the two servo motors according to the respective flip angles of the two control moment gyroscopes and the angle difference; and calculating the final output torque of the two servo motors according to the attitude control torque and the synchronization correction torque.

[0009] In a second aspect, an embodiment of the present invention proposes a synchronous control device for a dual control moment gyro of a robot, wherein the robot comprises two control moment gyro and two corresponding servo motors, wherein the two control moment gyro are symmetrically arranged on the left and right, and the flywheels of the two control moment gyro rotate in opposite directions, and the two servo motors are used to apply a precession torque to the corresponding control moment gyro to drive the two control moment gyro to flip oppositely to each other. The device includes: a feedback data receiving module, configured to receive the pitch tilt angle of the robot and the flip angle of the two control moment gyroscopes; a posture control torque calculation module, configured to calculate the posture control torque of the two servo motors according to the pitch tilt angle of the robot; an angle difference calculation module, configured to calculate the angle difference of the flip angle of the two control moment gyroscopes according to the flip angle of the two control moment gyroscopes; a synchronous correction torque calculation module, configured to calculate the synchronous correction torque of the two servo motors according to the respective flip angles of the two control moment gyroscopes and the angle difference; a final output torque calculation module, configured to calculate the final output torque of the two servo motors according to the posture control torque and the synchronous correction torque; and a final output torque transmission module, configured to transmit the final output torque to the two servo motors.

[0010] In some embodiments, the device also includes an initialization module configured to: generate a reset signal and transmit the reset signal to the two servo motors so that the two servo motors drive the two control moment gyroscopes to flip to the zero position; generate a target speed signal and transmit the target speed signal to the two control moment gyroscopes so that the internal flywheels of the two control moment gyroscopes are accelerated to the target speed.

[0011] In a third aspect, an embodiment of the present invention proposes a synchronous control device for a dual control torque gyroscope of a robot, the device comprising a memory and a processor, the memory storing a computer program, and when the computer program is executed by the processor, the synchronous control method for the dual control torque gyroscope of the robot described in any of the above embodiments is implemented.

[0012] In a fourth aspect, an embodiment of the present invention provides a robot, comprising the device according to the above embodiment.

[0013] In a fifth aspect, an embodiment of the present invention provides a storage medium storing computer-readable instructions, which, when executed by a processor, executes the method for synchronous control of a dual control torque gyroscope of a robot according to any of the above embodiments.

[0014] The synchronous control scheme of the dual control moment gyroscopes of the robot proposed in the embodiment of the present invention solves the problem of synchronous control of dual CMGs in the prior art from the software level. Synchronization is achieved through software algorithms without additional mechanical structures, which reduces the design difficulty and structural complexity. In addition, software synchronization has fewer restrictions on CMGs and is more flexible, which facilitates the maintenance and expansion of subsequent programs and functions.

[0015] The control torque consists of the original control torque and the synchronous correction torque. The original algorithm torque is compensated by the correction torque, and the synchronous rotation of CMGs is controlled while minimizing the impact on the original algorithm. In addition, the compensation torque is calculated by the PID algorithm to compensate for the error. The original control torque is compensated by the correction torque. It is easy to adjust and has strong applicability. Software synchronization does not require additional mechanical structure, which reduces the design difficulty and structural complexity, and facilitates the maintenance and expansion of subsequent programs and functions. This method reduces the impact on the original algorithm as a whole and realizes the error compensation and synchronization of the CMGs flip angle. BRIEF DESCRIPTION OF THE DRAWINGS

[0016] The above and other objects, features and advantages of the embodiments of the present invention will become readily understood by reading the following detailed description with reference to the accompanying drawings. In the accompanying drawings, several embodiments of the present invention are shown in an exemplary and non-limiting manner, in which:

[0017] Figure 1 A flow chart showing a method for synchronously controlling a dual control moment gyro of a robot according to an embodiment of the present invention is shown;

[0018] Figure 2 A front view showing an example of a dual control moment gyro of a robot according to an embodiment of the present invention;

[0019] Figure 3 A left view showing one example of a dual control moment gyro of a robot according to an embodiment of the present invention;

[0020] Figure 4 A top view showing one example of a dual control moment gyro of a robot according to an embodiment of the present invention;

[0021] Figure 5 A block diagram of a synchronous control device for dual control moment gyroscopes of a robot according to an embodiment of the present invention is shown.

[0022] In the drawings, the same or corresponding reference numerals represent the same or corresponding parts. DETAILED DESCRIPTION

[0023] The principle and spirit of the present invention will be described below with reference to several exemplary embodiments. It should be understood that these embodiments are provided only to enable those skilled in the art to better understand and implement the present invention, and are not intended to limit the scope of the present invention in any way.

[0024] In one aspect, an embodiment of the present invention provides a method for synchronously controlling dual control moment gyroscopes (CMGs) of a robot. Figure 1 , which shows a flow chart of a synchronous control method of a dual control moment gyro of a robot according to an embodiment of the present invention.

[0025] refer to Figure 2-Figure 4 , which respectively show a front view, a left view and a top view of an example of a dual control moment gyro of a robot according to an embodiment of the present invention. Figure 2-Figure 4 In the figure, the x-axis is the forward direction, the y-axis is the left-right direction, and the z-axis is the vertical direction.

[0026] The robot mentioned in the embodiments of the present invention may be a humanoid robot, a cargo-carrying robot, etc., and may have a wheel-foot structure.

[0027] The robot includes two control torque gyroscopes 2 and two corresponding servo motors 3. The two control torque gyroscopes 2 are arranged symmetrically on the left and right. The flywheels of the two control torque gyroscopes 2 rotate in opposite directions. The two servo motors 3 are used to apply precession torque to the corresponding control torque gyroscopes 2 to drive the two control torque gyroscopes 2 to flip in opposite directions to each other.

[0028] like Figure 2-Figure 4 As shown, only as a specific example, a frame 1 is set inside the robot, and two CMGs are arranged inside the frame 1. CMGs 2 consists of a circular shell, a high-speed motor, a flywheel and its shaft system. During operation, the high-speed motor drives the flywheel to rotate at high speed. The support shafts extending from the two sides of the CMGs are perpendicular to the direction of the angular momentum and are installed on the frame through bearings and related structures. The servo motor is connected to one side of the support shaft to drive the CMGs to rotate. In the figure, the two CMGs 2 are arranged symmetrically on the left and right, and the flywheels rotate in opposite directions. Two support shafts extend from the sides of the shell, and the axes are perpendicular to the direction of the angular velocity of the flywheel rotation. The support shafts are installed on the frame 1 through bearings, and one side of the support shaft continues to extend outward and is connected to the servo motor 3.

[0029] like Figure 1 As shown, the synchronous control method of the dual control moment gyro of the robot includes steps S101-S106.

[0030] In step S101, the pitch tilt angle of the robot and the roll angles of two control moment gyroscopes are received. The pitch tilt angle of the robot and the roll angles of the two control moment gyroscopes are, for example, from sensor feedback data.

[0031] As an embodiment of the present invention, the pitch tilt angle of the robot and the roll angles of the two control moment gyroscopes may be received according to a predefined acquisition cycle (or referred to as a control cycle), that is, regularly and cyclically.

[0032] As another embodiment of the present invention, the pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes may be received in real time.

[0033] As a specific example, during the working phase, the flip angle of CMGs 2 is collected in each control cycle. and the pitch tilt angle θ(t) of frame 1.

[0034] In step S102, the attitude control torque of the two servo motors, also called the original control torque, is calculated according to the pitch tilt angle of the robot.

[0035] As just one example, the attitude control torque can be derived according to the following formula (1):

[0036] T=f(θ(t)) (1)

[0037] Wherein, T is the calculated attitude control torque of CMGs; f is the attitude control algorithm, which can adopt any existing or future attitude control algorithm, and the present invention is not limited in this regard; θ(t) is the pitch tilt angle of the frame.

[0038] In step S103, the angle difference between the flip angles of the two control moment gyroscopes is calculated according to the flip angles of the two control moment gyroscopes.

[0039] As a specific example, the angle difference between the flip angles of the two control moment gyros is It can be obtained according to the following formula (2):

[0040]

[0041] in, is the flip angle difference of the two CMGs at time t, are the flip angles of the two CMGs at time t.

[0042] In step S104, the synchronous correction torques of the two servo motors are calculated respectively according to the respective flip angles and angle differences of the two control torque gyroscopes.

[0043] As a specific implementation of the present invention, a PID (proportional integral differential) control algorithm can be used to calculate the synchronous correction torque. The PID algorithm is easy to adjust and has strong applicability.

[0044] For example, the synchronous correction torque can be calculated by the following formula (3):

[0045]

[0046] where T′ is the synchronous correction torque of CMGs (2); K p , K i , K d They are the proportional, integral, and differential coefficients of the PID algorithm, which can be adjusted based on experience or practice.

[0047] In step S105, the final output torques of the two servo motors are calculated according to the attitude control torque and the synchronization correction torque. The control torque of CMGs 2 includes the original attitude control torque and the synchronization correction torque. The original algorithm torque is compensated by the correction torque, and the synchronous rotation of CMGs is controlled while reducing the impact on the original control algorithm.

[0048] For example, the output control torque of two CMGs (2) is obtained according to the following formula (4):

[0049] T1=TT′

[0050] T2=T+T′ (4)

[0051] Among them, T is the attitude control torque of CMGs, T′ is the synchronization correction torque of CMGs, and T1 and T2 are the final output torques of the servo motors of the two CMGs, respectively.

[0052] As an implementation of the present invention, steps S102 - S105 may be performed according to a predefined calculation cycle.

[0053] As another embodiment of the present invention, steps S102 to S105 may be performed each time the pitch tilt angle of the robot and the flip angle of the control moment gyro are updated.

[0054] In step S106 , the final output torque is transmitted to the two servo motors.

[0055] The synchronous control method of the dual control moment gyroscopes of the robot proposed in the embodiment of the present invention solves the problem of synchronous control of dual CMGs in the prior art from the software level. Synchronization is achieved through software algorithms without additional mechanical structures, which reduces the design difficulty and structural complexity. In addition, software synchronization has fewer restrictions on CMGs and is more flexible, which facilitates the maintenance and expansion of subsequent programs and functions.

[0056] The control torque consists of the original control torque and the synchronous correction torque. The original algorithm torque is compensated by the correction torque, and the synchronous rotation of CMGs is controlled while minimizing the impact on the original algorithm. In addition, the compensation torque is calculated by the PID algorithm to compensate for the error. The original control torque is compensated by the correction torque. It is easy to adjust and has strong applicability. Software synchronization does not require additional mechanical structure, which reduces the design difficulty and structural complexity, and facilitates the maintenance and expansion of subsequent programs and functions. This method reduces the impact on the original algorithm as a whole and realizes the error compensation and synchronization of the CMGs flip angle.

[0057] As an embodiment of the present invention, the method may further include an initialization phase. In the initialization phase, the hardware such as the motor is reset and initialized. In the initialization phase: a reset signal is generated and transmitted to the two servo motors so that the two servo motors drive the two control torque gyros to flip to Figure 2-Figure 4 The initial zero position shown is then locked to the position of the servo motor 3 and the high-speed motor is started; subsequently, a target speed signal is generated and transmitted to the two control moment gyroscopes so that the internal flywheels of the two control moment gyroscopes are accelerated to the target speed. The initialization is completed after the high-speed motor drives the flywheel to rotate to the set speed. This stage can ensure the initial position synchronization of CMGs 2.

[0058] In this embodiment, the synchronous control method includes two parts: initial angle synchronization of CMGs and synchronous correction of angles during operation. The steps of the initialization phase ensure the synchronization of the two CMGs during initial operation. In the initialization phase, the hardware such as the motor is initialized, the servo motor is driven to rotate the CMGs to zero position, and the flywheel inside the CMGs is driven to accelerate to the target speed. In the synchronous correction phase, the motor and sensor feedback data are collected in a regular cycle. On the one hand, the original control torque of the servo motor is calculated according to the attitude control algorithm. On the other hand, the synchronous correction torque of the two servo motors is calculated according to the flip angle of the two CMGs and the PID control algorithm. The final output torque of the two servo motors is calculated based on the original control torque and the synchronous correction torque. The original algorithm torque is compensated by the correction torque to achieve synchronous rotation of CMGs and error compensation, while reducing the impact on the original algorithm.

[0059] In the implementation mode proposed by the present invention, the synchronous control method of the dual control moment gyro can be executed by a processor (or CPU, or processing unit, or computer, or controller). The arrangement of the processor can take a variety of forms. As an example, the processor can be arranged on the above-mentioned robot, and the specific arrangement form can be flexibly adjusted according to needs or scenarios, and the present invention does not impose any restrictions in this regard. As another example, the processor can be arranged outside the robot, that is, remotely set, and can be communicatively connected to the robot by wire or wireless means. For example, the processor can be communicatively connected to each corresponding component of the robot by any wireless communication method. For example, the processor can be arranged on a remote control, computer, or mobile terminal outside the robot. The present invention does not impose any restrictions on the communication method. In addition, the processor can be a single physical entity or distributed on multiple different physical entities.

[0060] On the other hand, an embodiment of the present invention provides a synchronous control device for dual control moment gyros of a robot. The robot includes two control moment gyros and two corresponding servo motors, the two control moment gyros are arranged symmetrically, the flywheels of the two control moment gyros rotate in opposite directions, and the two servo motors are used to apply a precession torque to the corresponding control moment gyros to drive the two control moment gyros to flip in opposite directions. The device includes modules 501-506.

[0061] The feedback data receiving module 501 may be configured to receive the pitch angle of the robot and the roll angle of the two control moment gyroscopes.

[0062] The attitude control torque calculation module 502 may be configured to calculate the attitude control torque of the two servo motors according to the pitch and tilt angles of the robot.

[0063] The angle difference calculation module 503 may be configured to calculate the angle difference between the flip angles of the two control moment gyroscopes according to the flip angles of the two control moment gyroscopes.

[0064] The synchronous correction torque calculation module 504 may be configured to calculate the synchronous correction torques of the two servo motors respectively according to the respective flip angles and angle differences of the two control torque gyroscopes.

[0065] The final output torque calculation module 505 may be configured to calculate the final output torques of the two servo motors respectively according to the attitude control torque and the synchronization correction torque.

[0066] The final output torque transmission module 506 may be configured to transmit the final output torque to the two servo motors.

[0067] As an embodiment of the present invention, the device may also include an initialization module, configured to: generate a reset signal and transmit the reset signal to two servo motors so that the two servo motors drive the two control torque gyroscopes to flip to zero position; generate a target speed signal and transmit the target speed signal to the two control torque gyroscopes so that the internal flywheels of the two control torque gyroscopes are accelerated to the target speed.

[0068] It should be noted that the functions implemented by each module in the synchronous control device of the dual control torque gyroscope of the robot proposed in the embodiment of the present invention correspond one-to-one to the various steps of the synchronous control method of the dual control torque gyroscope of the robot executed by the processor described above. For its specific implementation methods, examples and beneficial effects, please refer to the above description of the method.

[0069] On the other hand, an embodiment of the present invention proposes a synchronous control device for a dual control torque gyroscope of a robot, the device including a memory and a processor, the memory storing a computer program, and when the computer program is executed by the processor, the synchronous control method for the dual control torque gyroscope of the robot described in any of the above embodiments is implemented.

[0070] In yet another aspect, an embodiment of the present invention provides a robot, comprising the synchronous control device of the dual control moment gyroscope of the robot described in the above embodiment.

[0071] In yet another aspect, an embodiment of the present invention provides a storage medium storing computer-readable instructions, which, when executed by a processor, executes the method for synchronously controlling a dual control moment gyroscope of a robot described in any of the above embodiments.

[0072] The synchronous control scheme of the dual control moment gyroscopes of the robot proposed in the embodiment of the present invention solves the problem of synchronous control of dual CMGs in the prior art from the software level. Synchronization is achieved through software algorithms without additional mechanical structures, which reduces the design difficulty and structural complexity. In addition, software synchronization has fewer restrictions on CMGs and is more flexible, which facilitates the maintenance and expansion of subsequent programs and functions.

[0073] The control torque consists of the original control torque and the synchronous correction torque. The original algorithm torque is compensated by the correction torque, and the synchronous rotation of CMGs is controlled while minimizing the impact on the original algorithm. In addition, the compensation torque is calculated by the PID algorithm to compensate for the error. The original control torque is compensated by the correction torque. It is easy to adjust and has strong applicability. Software synchronization does not require additional mechanical structure, which reduces the design difficulty and structural complexity, and facilitates the maintenance and expansion of subsequent programs and functions. This method reduces the impact on the original algorithm as a whole and realizes the error compensation and synchronization of the CMGs flip angle.

[0074] For the purpose of illustration, the foregoing description of the embodiments of the present invention has been given, which is not exhaustive nor intended to limit the present invention to the disclosed exact form. It will be appreciated by those skilled in the art that various changes can be made without departing from the scope of the present invention, and that the elements therein can be replaced with equivalents. In addition, without departing from the basic scope of the present invention, many modifications can be made so that specific situations or materials are adapted to the teachings of the present invention. Therefore, the present invention is not intended to be limited to the specific embodiments disclosed as the best mode for realizing the present invention, and the present invention will include all embodiments falling within the scope of the appended claims.

Claims

1. A method for synchronously controlling a dual control moment gyro of a robot, characterized in that: The robot comprises two control moment gyros and two corresponding servo motors, the two control moment gyros are arranged symmetrically, the flywheels of the two control moment gyros rotate in opposite directions, the two servo motors are used to apply precession torque to the corresponding control moment gyros to drive the two control moment gyros to flip in opposite directions to each other, and the method comprises: Receiving the pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes; Calculating the attitude control torque of the two servo motors according to the pitch tilt angle of the robot; Calculating an angle difference between the flip angles of the two control moment gyroscopes according to the flip angles of the two control moment gyroscopes; Calculating the synchronous correction torque of the two servo motors respectively according to the respective flip angles of the two control torque gyroscopes and the angle difference; Calculating the final output torques of the two servo motors respectively according to the attitude control torque and the synchronization correction torque; The final output torque is transmitted to the two servomotors.

2. The method according to claim 1, characterized in that The method further comprises an initialization phase, during which: generating a reset signal, and transmitting the reset signal to the two servo motors, so that the two servo motors drive the two control moment gyroscopes to flip to a zero position; A target rotation speed signal is generated and transmitted to the two control moment gyro, so that the internal flywheels of the two control moment gyro are accelerated to the target rotation speed.

3. The method according to claim 1, characterized in that Receiving the pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes comprises: The pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes are received according to a predefined acquisition cycle.

4. The method according to claim 1, characterized in that: Receiving the pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes comprises: The pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes are received in real time.

5. The method according to claim 1, characterized in that: The following steps are performed according to the predefined calculation cycle: Calculating the attitude control torque of the two servo motors according to the pitch tilt angle of the robot; Calculating an angle difference between the flip angles of the two control moment gyroscopes according to the flip angles of the two control moment gyroscopes; Calculating the synchronous correction torque of the two servo motors respectively according to the respective flip angles of the two control torque gyroscopes and the angle difference; The final output torques of the two servo motors are calculated respectively according to the attitude control torque and the synchronization correction torque.

6. A synchronous control device for a dual control moment gyro of a robot, characterized in that: The robot comprises two control moment gyros and two corresponding servo motors, the two control moment gyros are arranged symmetrically, the flywheels of the two control moment gyros rotate in opposite directions, the two servo motors are used to apply precession torque to the corresponding control moment gyros to drive the two control moment gyros to flip in opposite directions to each other, and the device comprises: A feedback data receiving module configured to receive the pitch tilt angle of the robot and the flip angles of the two control moment gyroscopes; A posture control torque calculation module, configured to calculate the posture control torque of the two servo motors according to the pitch tilt angle of the robot; An angle difference calculation module, configured to calculate an angle difference between the flip angles of the two control moment gyroscopes according to the flip angles of the two control moment gyroscopes; A synchronous correction torque calculation module, configured to calculate the synchronous correction torque of the two servo motors according to the respective flip angles of the two control torque gyroscopes and the angle difference; A final output torque calculation module, configured to calculate the final output torques of the two servo motors respectively according to the attitude control torque and the synchronization correction torque; The final output torque transmission module is configured to transmit the final output torque to the two servo motors.

7. The device according to claim 6, characterized in that The device also includes an initialization module configured to: generating a reset signal, and transmitting the reset signal to the two servo motors, so that the two servo motors drive the two control moment gyroscopes to flip to a zero position; A target rotation speed signal is generated and transmitted to the two control moment gyro, so that the internal flywheels of the two control moment gyro are accelerated to the target rotation speed.

8. A synchronous control device for a dual control moment gyro of a robot, characterized in that: The device includes a memory and a processor, wherein a computer program is stored in the memory, and when the computer program is executed by the processor, the synchronous control method of the dual control moment gyroscope of the robot according to any one of claims 1 to 5 is implemented.

9. A robot, characterized in that: The robot comprises the device according to claim 8.

10. A storage medium storing computer-readable instructions, which, when executed by a processor, executes the method for synchronously controlling a dual control moment gyro of a robot according to any one of claims 1 to 5.

Citation Information

Cited By

  • Robot attitude control method, electronic equipment and storage medium

    CN121578807A