Motion platform and control method
Through the inverted pendulum control algorithm and the coordinated control of the torque gyro and the virtual balance weight system, the problem that existing ground mobile platforms cannot achieve mobility and stability at the same time is solved, and efficient movement and stability are achieved in multiple scenarios. Suitable for a variety of application scenarios.
Patent Information
- Application Number
- CN202411240531.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2022-04-13
- Publication Date
- 2024-11-29
AI Technical Summary
Existing ground mobile platforms cannot achieve mobility, flexibility and stability at the same time, resulting in limited use in multiple scenarios and complex road conditions.
A motion platform was designed, combining the inverted pendulum control algorithm, the control torque gyro and the virtual balance weight system to achieve self-balancing and anti-interference through collaborative control, including the body system, the wheel system, the control torque gyro, the virtual balance weight system and the power system , CMGs and servo motors drive wheels and gyroscopes to achieve flexibility and stability of the platform.
It realizes efficient movement in small spaces and complex road conditions, has strong mobility, long-term stability and flexibility, is suitable for a variety of application scenarios, and improves safety and practicality through coordinated control of the system.
Smart Images

Figure CN119037607A_ABST
Abstract
Description
[0001] This application is a divisional application of the Chinese patent application with application date of April 13, 2022, application number 202210389375.6, and invention name “A Motion Platform and Control Method”. Technical Field
[0002] The embodiments of the present invention relate to the field of automatic control technology, and in particular to a motion platform and a control method. Background Art
[0003] A self-balancing, stable, flexible, and autonomously movable platform, as the basis of today's social service mobile devices, can meet people's needs in many scenarios in life and work.
[0004] The existing ground mobile platform / chassis, using existing technology, cannot "fully and simultaneously" achieve the following three characteristics: mobility (ability to smoothly follow the trajectory, passing ability, obstacle crossing ability); flexibility (generally reflected by the turning radius, the smaller the turning radius, the more flexible); stability (anti-interference ability, whether it is easy to overturn). The reason is that these three characteristics are "mutually exclusive". If one or two characteristics are met, the third characteristic will inevitably be weakened. For example, the two-wheel solution has "flexibility", but lacks "stability" and "mobility", and cannot rely on itself to resist external interference; for example, the four-wheel solution has "mobility" and "stability". Correspondingly, it does not have "flexibility" because the turning radius is generally larger than the vehicle body.
[0005] Lit motors was the first to conduct research on two-wheeled electric vehicles. It added a pair of high-speed rotating gyroscopes inside the vehicle body, and through the active deflection of the gyroscopes, it further improved the anti-interference ability of the two-wheeled electric vehicle. This measure did solve the problem of poor stability of two-wheeled electric vehicles, but its lack of flexibility still limited its usage scenarios and could not meet the requirements of a courtyard-level mobile platform. At the same time, there were no further measures for the continuous anti-interference ability (the "saturation phenomenon" of the control torque gyroscope).
[0006] Therefore, the existing technology urgently needs a mobile platform that has "stability", "mobility" and "flexibility" to meet the society's demand for the use of carrying and transportation tools. Summary of the invention
[0007] The present invention provides a motion platform and a control method to provide a motion platform and a control method with mobility, flexibility and stability. Based on these characteristics, through the decoupling design of the motion control layer and the application layer, adaptive development can be carried out according to the application requirements of different fields to meet the application requirements of multiple scenarios and multiple purposes.
[0008] In a first aspect, the present invention provides a motion platform, the motion platform comprising: a body system, a wheel system, a control moment gyro CMGs, a virtual counterweight system, a control system, and a power supply system;
[0009] The body system includes: a base frame;
[0010] The wheel system comprises: a first wheel and a second wheel arranged opposite to each other, wheel bearings, a servo motor and a servo control unit installed on the first wheel and the second wheel;
[0011] The CMGs include: 2 or more moment gyroscopes, and attached high-speed motors, servo motors and control units thereof;
[0012] The power supply system includes: a battery and a connecting harness;
[0013] The control system includes: an inertial navigation unit, a micro control unit and a control circuit;
[0014] The virtual counterweight system: a unit composed of the CMGs, power supply system, control system and other weights, which plays the role of counterweight;
[0015] The wheel system is connected to the body system via a wheel bearing;
[0016] The virtual counterweight system is connected to the vehicle body system via a connecting rod with a bearing, and can move horizontally along the travel direction of the motion platform to maintain the normal operation of the functions of its components.
[0017] In a second aspect, the present invention provides a control method for a motion platform, which is applicable to the motion platform described in any embodiment, and uses an inverted pendulum control algorithm, CMGs, and virtual counterweight collaborative control, and is executed by the control system. The control method includes:
[0018] When the center of gravity of the platform is detected to be deflected, the driving signals of the two wheels are respectively given through the inverted pendulum control algorithm, and the corresponding wheels are driven to move simultaneously by two servo motors, thereby adjusting the center of gravity position so that the motion platform reaches a self-balancing state;
[0019] When the deviation between the current center of gravity position and the theoretical center of gravity position due to the load on the motion platform is greater than a set threshold, the virtual balance weight is controlled to move horizontally in the opposite direction to reduce the deviation between the current center of gravity position and the theoretical center of gravity position, so that the platform can achieve self-balancing;
[0020] When the motion platform receives the motion command, it drives the virtual counterweight to move horizontally, so that the center of gravity of the motion platform is deflected, and the deflection angle of the center of gravity is used as the input of the inverted pendulum system to drive the wheel movement;
[0021] When the virtual counterweight has reached the limit of motion and cannot provide the required center of gravity deflection angle for the motion platform, the CMGs are driven to output torque, and the torque drives the center of gravity of the platform to further deflect, thereby enabling the platform to obtain the required acceleration / deceleration;
[0022] When the motion signal is recognized, the inverted pendulum system calculates the corresponding wheel drive signal according to the center of gravity swing angle and the current vehicle speed, and drives the wheels to move respectively through two servo motors to generate corresponding acceleration / deceleration. The vehicle speed corresponds to the center of gravity swing angle, following the inverted pendulum control logic.
[0023] When a turning signal is recognized, the inverted pendulum system recognizes the turning demand and controls the movement of the wheels on both sides to generate a wheel speed difference and realize the turning action;
[0024] When it is recognized that the motion platform is subject to internal or external interference, the CMGs are driven to deflect and generate torque, and the torque is used to resist the internal and external interference torques on the motion platform;
[0025] When it is identified that the motion platform is subject to internal or external interference, and the interference needs to be resisted by the virtual counterweight, the virtual counterweight is driven to make the virtual counterweight move horizontally, and the torque generated is used to resist the interference;
[0026] When the CMGs reaches the deflection angle threshold, the virtual counterweight is driven to move horizontally, thereby generating a deflection of the center of gravity, so that the motion platform is in an unbalanced state. The gravity torque generated in this unbalanced state is used to drive the control torque gyro to passively deflect back to the center.
[0027] When the CMGs reaches the yaw angle threshold and the inverted pendulum system is required to provide a restoring torque for the CMGs, the motion platform is placed in an unbalanced state by adjusting the corresponding relationship between the center of gravity yaw angle and the vehicle speed. The gravitational torque generated in this unbalanced state is used to drive the gyro's passive yaw to return to the center.
[0028] In a third aspect, the present invention provides a control method for a motion platform, which is applicable to the motion platform described in any embodiment, and uses an inverted pendulum control algorithm and CMGs for coordinated control, which is executed by the control system, and the control method includes:
[0029] When the center of gravity of the motion platform is detected to be deflected, the driving signals of the two wheels are respectively given through the inverted pendulum control algorithm, and the corresponding wheels are driven to move simultaneously by two servo motors, thereby adjusting the center of gravity position so that the motion platform reaches a self-balancing state;
[0030] When the motion platform receives a motion command, the drive motor inside the CMGs drives the rotor to yaw to generate torque, thereby causing the center of gravity of the platform to yaw. The yaw angle of the center of gravity serves as the input of the inverted pendulum system to drive the wheel to move.
[0031] When the motion signal is recognized, the inverted pendulum system calculates the corresponding wheel drive signal according to the center of gravity swing angle and the current vehicle speed, and drives the wheels to move respectively through two servo motors to generate corresponding acceleration / deceleration. The vehicle speed corresponds to the center of gravity swing angle, following the inverted pendulum control logic.
[0032] When a turning signal is recognized, the inverted pendulum system recognizes the turning demand and controls the movement of the wheels on both sides to generate a wheel speed difference and realize the turning action;
[0033] When it is identified that the motion platform is subject to internal or external interference, the high-speed rotating rotor is driven to deflect by the drive motor inside the CMGs, thereby generating a torque, which is used to resist the internal and external interference torques on the motion platform;
[0034] When the CMGs reaches the yaw angle threshold, the platform is placed in an unbalanced state by adjusting the corresponding relationship between the center of gravity yaw angle and the vehicle speed. The gravity torque generated in this unbalanced state is used to drive the gyro to passively yaw back to the center.
[0035] Through the above-mentioned design scheme, the present invention can bring the following beneficial effects: the motion platform and its control method, through the coordinated control of the inverted pendulum system, the control torque gyroscope, and the virtual counterweight system, can realize a mobile platform with strong mobility, long-term system stability, flexible movement, and applicability to various narrow spaces or complex road conditions; the motion control of the platform is decoupled from the upper-level functional control (application control), and after the fundamental characteristics of the mobile platform (mobility, stability, and flexibility) are developed, the mobile platform can be promoted and applied to various industrial and life fields that need to release manpower, such as factories, shopping malls, hospitals, closed parks, etc. BRIEF DESCRIPTION OF THE DRAWINGS
[0036] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0037] Figure 1 is a structural schematic diagram of a motion platform provided by an embodiment of the present invention;
[0038] Figure 2 is a physical line drawing of a motion platform provided by an embodiment of the present invention;
[0039] Figure 3 is a front view of a motion platform provided by an embodiment of the present invention;
[0040] Figure 4 is a side view of a motion platform provided by an embodiment of the present invention;
[0041] Figure 5 is a flow chart of a method for controlling a motion platform provided by an embodiment of the present invention;
[0042] Figure 6 is a schematic diagram of driving a wheel according to an inverted pendulum control algorithm provided by an embodiment of the present invention;
[0043] Figure 7 is a schematic diagram of driving a wheel according to an inverted pendulum control algorithm provided by an embodiment of the present invention;
[0044] Figure 8 is a structural schematic diagram of a motion platform provided by an embodiment of the present invention;
[0045] Fig. 9 is a physical line drawing of a motion platform provided by an embodiment of the present invention;
[0046] Fig.10 is a front view of a motion platform provided by an embodiment of the present invention;
[0047] Fig.11 It is a flow chart of a method for controlling a motion platform provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0048] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be described clearly and completely below. 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 belong to the scope of protection of the present invention.
[0049] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.
[0050] In the description of the present invention, it is also necessary to explain that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0051] Embodiment 1
[0052] Figure 1 It is a structural schematic diagram of a motion platform provided by an embodiment of the present invention, including: a body system, a wheel system, control moment gyroscopes CMGs, a virtual counterweight system, a control system, and a power supply system. Figure 1 The left picture is the main view of the motion platform. Figure 1 The picture on the right is a side view of the motion platform.
[0053] Specifically, the body system includes: a basic frame;
[0054] The wheel system includes: a first wheel and a second wheel distributed opposite to each other, wheel bearings installed on the first wheel and the second wheel, a servo motor (not shown), and a servo control unit (not shown); the wheel system is connected to the body system through the wheel bearings.
[0055] The CMGs include: 2 or more moment gyroscopes, and attached high-speed motors, servo motors and control units thereof;
[0056] The power supply system includes: a battery and a connecting harness (not shown);
[0057] The control system includes: an inertial navigation unit, a micro control unit and a control circuit (not shown);
[0058] The virtual counterweight system is a unit composed of the CMGs, power supply system, control system and other weights, which acts as a counterweight. The virtual counterweight system is connected to the vehicle body system and can move horizontally along the direction of travel of the motion platform to maintain the normal operation of the functions of its components.
[0059] This embodiment creatively proposes a "virtual counterweight" system, which is a combination of CMGs, a power system, and a control system. The movement of the virtual counterweight along the direction of travel of the platform generates a gravity torque, thereby achieving functions such as speed change, anti-interference, and passive self-centering of the CMGs. It is worth mentioning that the virtual counterweight is connected to the vehicle body system through a connecting rod with a bearing (but not limited to a parallelogram structure) or a slide rail, and the movement of the virtual counterweight is horizontal to ensure that the various components of the virtual counterweight do not rotate and maintain the normal operation of the functions of its components. In order to facilitate the description of the movement of the virtual counterweight, a coordinate system applicable to the platform is defined. The origin position is not limited, the X-axis is parallel to the forward and backward movement direction of the platform, the Y-axis is parallel to the axial direction of the wheel, and the Z-axis is perpendicular to the X-axis and Y-axis, see Figure 1 . Driven by the drive unit, the virtual counterweight moves horizontally along the X-axis of the platform coordinate system (φ1 is the angle of the virtual counterweight around the Y-axis). It should be noted that the virtual counterweight cannot move around the Z-axis. In the present invention, the functions of the virtual counterweight include: adjusting the center of gravity of the motion platform (φ2 is the deflection angle of the center of gravity), thereby driving the inverted pendulum system to work and realize the autonomous movement function; and / or, generating torque through tiny swings to drive the CMGs back to the center and eliminate the saturation of the CMGs; and / or, generating torque through the swing of the virtual counterweight to resist internal and external interference on the motion platform.
[0060] Control Moment Gyroscopes (CMGs) are commonly used attitude adjustment actuators on spacecraft. The principle is that when a torque perpendicular to the rotation axis of a gyroscope is applied, a torque around a third axis perpendicular to the rotation axis and perpendicular to the torque axis will be generated. CMGs can be used for active deflection to generate anti-interference torque, and can be passively corrected under the action of gravity torque. Using two or more gyroscopes can offset the non-anti-interference torque generated by the torsion of the gyroscopes. In the embodiment of the present invention, the functions of CMGs include resisting internal and external interference, driving the center of gravity of the motion platform to deflect, and causing the motion platform to perform movement.
[0061] The servo control unit of the wheel system controls the movement of the first wheel and the second wheel separately. The wheel system adopts an inverted pendulum control algorithm. The inverted pendulum control algorithm includes: detecting the position deviation between the actual center of gravity and the theoretical center of gravity of the platform through the inertial navigation unit, and controlling the movement of the first wheel and the second wheel separately so that the actual center of gravity coincides with the theoretical center of gravity to achieve standing balance. Through the corresponding relationship between the vehicle speed and the center of gravity swing angle, the movement of the first wheel and the second wheel is controlled separately so that the vehicle speed and the center of gravity swing angle reach the equilibrium state of the inverted pendulum control and achieve motion balance. The function of the inverted pendulum system is to achieve self-balancing of the system, execute the desired motion intention, and drive the CMGs back to the center.
[0062] The inertial navigation unit in the control system is used to detect the attitude and position of the platform and can be used for path navigation and interference detection.
[0063] The microcontroller unit in the control system is used for the superimposed coordinated control of the inverted pendulum system, the control moment gyro, and the virtual counterweight system. By comprehensively processing the vehicle speed signal, the vehicle body posture signal, the center of gravity position, the movement intention and other information, the active yaw signal of the control moment gyro, the driving signal of the first and second wheels, and the horizontal movement signal of the virtual counterweight are obtained, and then the three systems are controlled to ensure the performance of the platform.
[0064] The sports platform provided by the embodiment of the present invention has the following effects:
[0065] 1. Strong mobility: Only motion input signals are required, no human cooperation is required, the platform can achieve follow-up movement, and can maintain stability and comfort above the platform, which is very friendly to manned and transported.
[0066] 2. Long-term stability: CMGs are used to resist internal and external interference and maintain system stability. Even after long-term operation, the anti-interference system has the ability to "self-correct" and will not suddenly fail due to the saturation of CMGs.
[0067] 3. Flexible movement: It has a small size and can achieve a turning radius of 0. It is suitable for public roads as well as courtyard-level indoor use. The center of gravity can be adjusted and it is suitable for a variety of complex road conditions such as slopes, uneven roads, etc.
[0068] 4. Practicality: The CMGs, power system, control system and other weight units in the system are combined into a virtual counterweight, which realizes the gravity control function without adding additional mass units, reduces the weight and volume of the system, and improves the practicality of the platform.
[0069] 5. Safety: In terms of safety-related functions such as stability and motion control, dual-system backup of functions is achieved through the coordination of three systems. When one of the systems or parts fails, the backup system takes over and executes the function, and there will be no sudden functional failure, which greatly improves the system's safety level.
[0070] Embodiment 2
[0071] Figure 2 is a physical line drawing of a motion platform provided by an embodiment of the present invention, Figure 3 is a front view of a motion platform provided by an embodiment of the present invention, Figure 4 It is a side view provided by an embodiment of the present invention.
[0072] Combination Figure 2 to Figure 4The two ends of the base frame of the vehicle body system are connected to the bearings of the first wheel and the second wheel respectively; a virtual counterweight system is suspended on the base frame through a connecting rod, and the virtual counterweight can move horizontally through the suspension. This embodiment does not limit the virtual counterweight composed of the control moment gyro, power system, and control system, but may also include other weight units, and does not limit the positional relationship of each component.
[0073] A structure of a virtual counterweight is that the virtual counterweight is composed of CMGs, a power system and a control system, and a bracket is designed on the outer frame of the control moment gyro to carry the electrical and control unit.
[0074] A suspension structure of a virtual counterweight is that a basic frame includes at least two support rods distributed in parallel along the Y axis, the number of the connecting rods is at least 3, one end of each connecting rod is connected to the support rod, and the other end is connected to the control moment gyro outer frame. There are 6 bearings at both ends of the three connecting rods, and the support rods, connecting rods and the control moment gyro outer frame form a parallelogram. Due to the structural characteristics of the parallelogram, each module inside the virtual counterweight remains horizontal, and each module will not rotate around its own Y axis and Z axis.
[0075] Optionally, the platform also includes an external interface and / or a carrying platform. The external interface and / or the carrying platform can be an actual carrying platform or a special installation interface, which is characterized by being able to adjust the structure according to the needs of the application layer, such as a seat installation interface, a screw connection interface, a control signal input interface, etc. In specific application scenarios, the following improvements can be made to the external interface or the carrying platform to realize products with different functions.
[0076] 1) Add equipment to the carrying platform and it can be used as a logistics vehicle.
[0077] 2) Add a robotic arm as the robot chassis.
[0078] 3) Install a seat as a means of transportation.
[0079] 4) Install sensors as a special detection / inspection system.
[0080] Embodiment 3
[0081] Figure 5 Flow chart of the control method of the motion platform provided in the embodiment of the present invention, applicable to any motion platform provided in the first embodiment and the second embodiment, the method is applicable to the superimposed coordinated control of the inverted pendulum system, CMGs, and the virtual counterweight system. The method is executed by the control system, and specifically comprises the following steps:
[0082] S110, when it is detected that the center of gravity of the platform is deflected, the driving signals of the two wheels are respectively given through the inverted pendulum control algorithm, and the corresponding wheels are driven to move simultaneously by two servo motors, thereby adjusting the center of gravity position so that the motion platform reaches a self-balancing state.
[0083] The power of the motion platform is turned on, and the control system detects the spatial posture of the vehicle body in six degrees of freedom through the inertial navigation unit. When the center of gravity is detected to be skewed, the wheel drive command is calculated through the inverted pendulum control algorithm, and the wheel drive motor drives the wheel to adjust the movement of the wheel, ultimately achieving a self-balancing state for the platform.
[0084] The control logic of the inverted pendulum is to make the pendulum reach a balanced position as quickly as possible without large oscillations and excessive angles and speeds. When the center of gravity reaches the desired position, that is, the center of gravity position in this embodiment reaches the theoretical center of gravity position when the platform is upright, the platform can maintain a balanced state through self-adjustment.
[0085] Figure 6 Schematic diagram of driving wheels according to an inverted pendulum control algorithm provided by an embodiment of the present invention. The left figure is the initial state, the center of gravity of the platform is skewed and in an unbalanced state. The middle figure shows that the wheel is driven to the right by the inverted pendulum control algorithm, a non-zero speed and acceleration are generated, and the center of gravity moves toward the center of the platform. The right figure is the self-balancing state.
[0086] S120. When the deviation between the current center of gravity position and the theoretical center of gravity position of the motion platform due to load is greater than a set threshold, the virtual balance weight is controlled to move horizontally in the opposite direction to reduce the deviation between the current center of gravity position and the theoretical center of gravity position, so that the platform can achieve self-balancing.
[0087] The threshold can be set through experimental calibration. When the actual center of gravity deviates greatly from the theoretical center of gravity, the inverted pendulum system needs to move a certain distance to make the platform self-balanced. This is an undesirable movement and should be avoided. At the same time, using a virtual balance weight to adjust the center of gravity does not affect the angle of the platform bearing the platform, avoiding the deflection of the platform caused by the center of gravity adjustment, which is very user-friendly.
[0088] For example, assuming that the current center of gravity is located to the left of the theoretical center of gravity, the virtual counterweight is driven to move to the right, wherein the deflection angle of the virtual counterweight is determined by the offset between the current center of gravity and the theoretical center of gravity.
[0089] S130. After receiving the motion instruction, the motion platform drives the virtual counterweight to move horizontally, so that the center of gravity of the motion platform is deflected. The deflection angle of the center of gravity is used as an input for the inverted pendulum system to drive the wheel to move.
[0090] The source of the motion command can be a waypoint signal, which is converted into a drive command for the virtual counterweight after analysis by the control system. According to the control system's requirement for the platform's operating speed, the virtual counterweight is driven to move horizontally accordingly, resulting in a yaw of the platform's center of gravity, and then driving the inverted pendulum system to drive the wheels, generating wheel drive torque.
[0091] S140. When the virtual counterweight has reached its movement limit and cannot provide the required center of gravity swing angle for the motion platform, drive the CMGs to output torque, which can drive the center of gravity of the platform to further swing, thereby enabling the platform to obtain the required acceleration / deceleration.
[0092] The horizontal movement of the virtual counterweight has a limit position. When the platform requires a higher speed, but the virtual counterweight still cannot provide sufficient vehicle speed even if it moves to the limit position, the CMGs drives its internal motor to cause the gyroscope to swing and generate torque, causing the platform's center of gravity to swing further, and then generates additional wheel drive torque through the inverted pendulum system to meet the desired operating speed.
[0093] S150. When a motion signal is recognized, the inverted pendulum system calculates the corresponding wheel drive signal according to the center of gravity swing angle and the current vehicle speed, and drives the wheels to move respectively through two servo motors to generate corresponding acceleration / deceleration. The vehicle speed corresponds to the center of gravity swing angle, following the inverted pendulum control logic.
[0094] Figure 7 It is a schematic diagram of driving the wheels according to the inverted pendulum control algorithm provided by an embodiment of the present invention. The left figure is a balanced state, the platform is stationary (the speed v and the acceleration a are both 0) and the center of gravity is centered. The middle figure shows that the center of gravity deflects to the right, generating a deflection angle φ, and the wheels are driven to the right under the action of the inverted pendulum control algorithm, generating a non-zero speed and acceleration. The right figure shows that when the vehicle speed and the center of gravity deflection angle reach the balanced state in the inverted pendulum control logic, the speed reaches the expected value and the acceleration is 0. In fact, the center of gravity of the platform is constantly adjusted, so the speed and acceleration of the platform are also constantly changing with the change of the deflection angle of the platform center of gravity.
[0095] When a turning signal is recognized, the inverted pendulum system will identify the steering requirement, control the movement of the wheels on both sides respectively, generate a wheel speed difference, and realize the steering action; for example, when the platform receives an instruction to turn right on the spot, by giving the left wheel a forward drive and the right wheel a backward drive, the driving torque is the same, and the platform can realize a right turn on the spot.
[0096] S160: When it is identified that the motion platform is subject to internal or external interference, the CMGs are driven to yaw and generate torque, and the torque is used to resist the internal and external interference torques on the motion platform.
[0097] The inertial navigation unit detects internal and external disturbances to the platform (internal disturbances: such as the swing of people or robotic arms on the platform, grabbing heavy objects, etc.; external disturbances: such as sudden external forces, uneven roads, etc., which will cause unexpected changes in the center of gravity of the system are all considered disturbances). The control system gives a command to control the yaw of the torque gyro to drive the yaw motor inside the CMGs to make the control torque gyro yaw (the yaw of the control torque gyro refers to: the high-speed rotating rotor inside the control torque gyro rotates along the second axis perpendicular to its rotation axis. The yaw refers to controlling the angular velocity and duration of the rotation axis, thereby generating a torque rotating around the third axis in the coordinate system), generating an anti-interference torque to maintain the stability of the platform.
[0098] S170: When it is identified that the motion platform is subject to internal or external interference, and the interference needs to be resisted by a virtual counterweight, the virtual counterweight is driven to move horizontally, and the torque generated is used to resist the interference.
[0099] Because the deflection of the control moment gyro will generate torque on the third axis, when the deflection of the control moment gyro reaches 90°, the direction of the torque it generates will change, and it can no longer provide the torque required by the platform to resist interference. Therefore, the threshold of the control moment gyro should be less than 90°. When the control torque reaches the threshold, it will no longer work.
[0100] At this time, if the platform needs to resist the interference torque, the control system will drive the virtual counterweight to move and generate the torque to resist the interference.
[0101] S180, when the CMGs reaches the deflection angle threshold, the virtual counterweight is driven to move horizontally, thereby generating a deflection of the center of gravity, so that the motion platform is in an unbalanced state. The gravity torque generated in this unbalanced state is used to drive the gyro to passively deflect back to the center.
[0102] The threshold is less than 90°, and the angle of horizontal movement is, for example, 10°, which needs to be set in actual matching.
[0103] S190. When the CMGs reaches the yaw angle threshold and the inverted pendulum system is required to provide a restoring torque for the CMGs, the motion platform is placed in an unbalanced state by adjusting the corresponding relationship between the center of gravity yaw angle and the vehicle speed. The gravity torque generated in this unbalanced state is used to drive the gyro to passively yaw and return to the center.
[0104] In a specific implementation, when the virtual counterweight is performing other tasks or is in a swing limit state, the inverted pendulum system is required to provide a restoring torque for the CMGs.
[0105] It is worth mentioning that the virtual counterweight is composed of weight units such as CMGs, power supply system, and control system in the platform, and does not increase the overall weight and volume of the platform. The virtual counterweight can move horizontally along the direction of travel of the platform, and realize the counterweight control function without affecting the functions of its constituent units. Through the coordinated control method of the above three systems, a motion platform with "flexibility", "stability" and "mobility" can be realized.
[0106] In summary of the above steps, the present invention, based on the two-wheel opposite distribution structure, first meets the "flexibility" of the platform, and then uses the superimposed collaborative control of the inverted pendulum system, the control torque gyroscope, and the virtual counterweight system to solve the "stability" and "mobility" problems from three aspects: First, solving the self-balancing problem; second, solving the problem of real-time "following" movement intentions; third, solving the problem of resisting internal and external stable interference.
[0107] Embodiment 4
[0108] Figure 8 It is a schematic diagram of the structure of a motion platform provided by an embodiment of the present invention, including: control moment gyroscopes (CMGs), a body system, a wheel system, a control system and a power supply system (including battery accessories).
[0109] Specifically, the body system includes: a basic frame.
[0110] The wheel system includes: a first wheel and a second wheel distributed opposite to each other, wheel bearings installed on the first wheel and the second wheel, a servo motor (not shown), and a servo control unit (not shown); the wheel system is connected to the body system through the wheel bearings.
[0111] The CMGs are arranged in the CMGs outer frame, and include: 2 or more moment gyroscopes, and attached high-speed motors, servo motors and control units thereof. The description of the CMGs structure can be found in Example 1. In this embodiment, the function of the CMGs is to resist internal and external interference, and to drive the center of gravity of the platform to deflect, so that the platform performs movement.
[0112] The power supply system includes: battery accessories and connecting harness (not shown).
[0113] The control system includes: an inertial navigation unit, a micro control unit and a control circuit (not shown).
[0114] The servo control unit of the wheel system controls the movement of the first wheel and the second wheel separately. The wheel system adopts an inverted pendulum control algorithm, which is used to achieve self-balancing of the system, execute the desired movement intention, and drive the CMGs back to the center.
[0115] The inertial navigation unit in the control system is used to detect the attitude and position of the platform, which can be used for path navigation and interference detection.
[0116] The microcontroller unit in the control system is used to superimpose and coordinate the inverted pendulum system and the control torque gyro. Fig. 9 and Figure 2 The difference is that Figure 2 The two ends of the connecting rod are rotating bearings, so that the deflection of the virtual balance weight can be used for dynamic and static control. Fig. 9 The two ends of the connecting rod are fixedly connected and cannot swing.
[0117] The implementation case of the present invention is based on implementation case one and implementation case two, and cancels the control of the virtual counterweight system. Instead, through the coordinated control of the control torque gyro and the inverted pendulum system, a self-balancing, long-term stable and flexible motion platform that can move according to intention can be realized. The platform is suitable for use in an environment with little unpredictable interference and relatively fixed operating scenarios.
[0118] Fig. 9 is a physical line drawing of a motion platform provided by an embodiment of the present invention, Fig.10 It is a front view of the motion platform provided by an embodiment of the present invention.
[0119] Combination Figure 8 to Figure 10 The two ends of the base frame of the vehicle body system are respectively connected to the bearing of the first wheel and the bearing of the second wheel; and CMGs are connected to the base frame. This embodiment does not limit the connection method of CMGs and the base frame.
[0120] A connection structure between CMGs and a basic frame is that the basic frame includes at least two axially distributed support rods, the number of the connecting rods is at least 3, one end of each connecting rod is connected to the support rod, and the other end is connected to the control moment gyro outer frame.
[0121] Optionally, the platform also includes an external interface and / or a carrying platform. The external interface and / or the carrying platform can be an actual carrying platform or a special installation interface, which is characterized in that the structure can be adjusted according to the requirements of the application layer, such as a seat installation interface, a screw connection interface, a control signal input interface, etc.
[0122] In specific application scenarios, the following improvements can be made to the external interface or the carrier platform to implement products with different functions.
[0123] 1) Add equipment to the carrying platform and it can be used as a logistics vehicle.
[0124] 2) Add a robotic arm as the robot chassis.
[0125] 3) Install a seat as a means of transportation.
[0126] 4) Install sensors as a special detection / inspection system.
[0127] Embodiment 5
[0128] Fig.11 This is a flow chart of a control method for a motion platform provided in an embodiment of the present invention, which is applicable to the motion platform provided in Embodiment 5. This method is applicable to the superimposed coordinated control of an inverted pendulum system and a control moment gyro. This method is executed by a control system, and specifically comprises the following steps:
[0129] S210: When it is detected that the center of gravity of the motion platform is deflected, driving signals of the two wheels are respectively given through the inverted pendulum control algorithm, and the corresponding wheels are driven to move simultaneously by two servo motors, thereby adjusting the center of gravity position so that the motion platform reaches a self-balancing state.
[0130] The power of the motion platform is turned on, and the control system detects the spatial posture of the vehicle body in six degrees of freedom through the inertial navigation unit. When the center of gravity is detected to be skewed, the wheel drive command is calculated through the inverted pendulum control algorithm, and the wheel drive motor drives the wheel to adjust the movement of the wheel, ultimately achieving a self-balancing state for the platform.
[0131] The control logic of the inverted pendulum is to make the pendulum reach a balanced position as quickly as possible without large oscillations and excessive angles and speeds. When the center of gravity reaches the desired position, that is, the center of gravity position in this embodiment reaches the theoretical center of gravity position when the platform is upright, the platform can maintain a balanced state through self-adjustment. Figure 6 , I will not go into details here.
[0132] S220, when the motion platform receives the motion command, the drive motor inside the CMGs drives the rotor to swing to generate torque, thereby causing the center of gravity of the platform to swing. The center of gravity swing angle serves as the input of the inverted pendulum system to drive the wheel movement.
[0133] The source of the motion command can be a waypoint signal, which is converted into a drive command for the control torque gyro after analysis by the control system. According to the control system's requirement for the platform's operating speed, the gyro inside the control torque gyro is driven accordingly to deflect, generating a torque that causes the platform's center of gravity to deflect, thereby driving the platform's center of gravity to deflect, and then driving the inverted pendulum system to execute the driving action on the wheel, generating wheel driving torque.
[0134] S230. When a motion signal is recognized, the inverted pendulum system calculates the corresponding wheel drive signal according to the center of gravity swing angle and the current vehicle speed, and drives the wheels to move respectively through two servo motors to generate corresponding acceleration / deceleration. The vehicle speed corresponds to the center of gravity swing angle, following the inverted pendulum control logic.
[0135] See Figure 7 , I will not go into details here.
[0136] S240: When a turning signal is recognized, the inverted pendulum system is used to recognize the turning demand, and the wheels on both sides are controlled to move respectively, thereby generating a wheel speed difference and realizing the turning action.
[0137] For example, when the platform receives a command to turn right on the spot, the platform turns right on the spot by giving the left wheel a forward drive and the right wheel a backward drive with the same driving torque.
[0138] S250: When it is recognized that the motion platform is subject to internal or external interference, the high-speed rotating rotor is driven to deflect by the drive motor inside the CMGs, thereby generating a torque, which is used to resist the internal and external interference torque from the motion platform.
[0139] The inertial navigation unit detects internal and external disturbances of the platform (internal disturbances: such as the swing of people or robotic arms on the platform, grabbing heavy objects, etc.; external disturbances: such as sudden external forces, uneven roads, etc., which will cause unexpected changes in the center of gravity of the system are all considered disturbances). The control system will give a CMGs yaw command to drive the yaw motor inside the CMGs to make the gyro yaw (CMGs yaw refers to: the high-speed rotating rotor inside the CMGs rotates along the second axis perpendicular to its rotation axis. The yaw refers to controlling the angular velocity and duration of the rotation axis, thereby generating a torque rotating around the third axis in the coordinate system), generating an anti-interference torque to maintain the stability of the platform.
[0140] S260, when CMGs reaches the yaw angle threshold, the platform is placed in an unbalanced state by adjusting the corresponding relationship between the center of gravity yaw angle and the vehicle speed. The gravity torque generated in this unbalanced state is used to drive the gyro to passively yaw back to the center.
[0141] Among them, the yaw angle threshold is <90°.
[0142] Through the above-mentioned design scheme, the present invention can bring the following beneficial effects: the motion platform and its control method, through the coordinated control of the inverted pendulum system and the control torque gyroscope, can realize a mobile platform with strong mobility, long-term system stability, flexible movement and applicability to various narrow spaces or complex road conditions; the motion control of the platform is decoupled from the upper-level functional control (application control), and after the fundamental characteristics of the mobile platform (mobility, stability, flexibility) are developed, the mobile platform can be promoted and applied to various industrial and life fields that need to release manpower, such as factories, shopping malls, hospitals, closed parks, etc.
[0143] Further beneficial effects of the present invention are:
[0144] 1. Strong mobility: Only motion input signals are needed, no human cooperation is required, the platform can achieve follow-up movement, and can maintain stability and comfort on the platform, which is very friendly to manned and transported;
[0145] 2. Long-term stability: CMGs are used to resist internal and external interference and maintain system stability. Even if it operates for a long time, the anti-interference system has the ability to "self-correct" and will not suddenly fail to maintain stability due to the saturation of CMGs;
[0146] 3. Flexible movement: It has a small size and can achieve a turning radius of 0. It is suitable for public roads as well as courtyard-level indoor use. The center of gravity can be adjusted and it is suitable for a variety of complex road conditions such as slopes, uneven roads, etc.
[0147] 4. Practicality: The weight units such as CMGs, power system, control system, etc. in the system are combined into a virtual counterweight. While realizing the gravity control function, no additional mass units are added, which reduces the weight and volume of the system and improves the practicality of the platform.
[0148] 5. Safety: In terms of safety-related functions such as stability and motion control, dual-system backup of functions is achieved through the coordination of three systems. When one of the systems or parts fails, the backup system takes over and executes the function, and there will be no sudden functional failure, which greatly improves the system's safety level.
[0149] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments described herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
Claims
1. A sports platform, characterized in that: include: Body systems, wheel systems, control moment gyros CMGs, control systems and power systems; The body system includes: a base frame; The wheel system comprises: a first wheel and a second wheel arranged opposite to each other, wheel bearings, a servo motor and a servo control unit installed on the first wheel and the second wheel; The CMGs include: 2 or more moment gyroscopes, and attached high-speed motors, servo motors and control units thereof; The power supply system includes: a battery and a connecting harness; The control system includes: an inertial navigation unit, a micro control unit and a control circuit; The wheel system is connected to the body system via a wheel bearing. The control system is used to: detect the spatial posture of the vehicle body in six degrees of freedom through the inertial navigation unit, and when the center of gravity position is identified to be skewed, calculate the wheel drive command through the inverted pendulum control algorithm, and drive the wheel through the wheel drive motor to adjust the movement of the wheel, so as to finally achieve the self-balancing state of the platform; and when the internal and external interference of the platform is detected through the inertial navigation unit, give the CMGs yaw command, drive the yaw motor inside the CMGs, make the CMGs yaw, and generate an anti-interference torque.
2. The motion platform according to claim 1, characterized in that: The CMGs are arranged in a CMGs outer frame, and the basic frame includes a connecting rod and at least two axially distributed support rods, the number of the connecting rods is at least 3, one end of each connecting rod is connected to the support rod, and the other end is connected to the CMGs outer frame.
3. The motion platform according to claim 2, characterized in that: The two ends of the connecting rod are fixedly connected.
4. The motion platform according to claim 1, characterized in that: Both ends of the base frame of the vehicle body system are respectively connected to the wheel bearing of the first wheel and the wheel bearing of the second wheel.
5. The motion platform according to claim 1, characterized in that: The servo control unit of the wheel system controls the movement of the first wheel and the second wheel separately and independently.
6. The motion platform according to claim 1, characterized in that: The motion platform also includes an external interface and / or a carrying platform.
7. The motion platform according to claim 6, characterized in that: The external interface includes one or more of a seat installation interface, a screw connection interface, and a control signal input interface.
8. The motion platform according to claim 6, characterized in that: The carrying platform is installed with one or more of the following: an instrument, a mechanical arm, a seat, and a sensor.
9. A method for controlling a motion platform, characterized in that: The motion platform according to any one of claims 1 to 8 is applied with an inverted pendulum control algorithm and CMGs for coordinated control, and is executed by the control system, wherein the control method comprises: When the center of gravity of the motion platform is detected to be deflected, the driving signals of the two wheels are respectively given through the inverted pendulum control algorithm, and the corresponding wheels are driven to move simultaneously by two servo motors, thereby adjusting the center of gravity position so that the motion platform reaches a self-balancing state; When the motion platform receives a motion command, the drive motor inside the CMGs drives the rotor to yaw to generate torque, thereby causing the center of gravity of the platform to yaw. The yaw angle of the center of gravity serves as the input of the inverted pendulum system to drive the wheel to move. When the motion signal is recognized, the inverted pendulum system calculates the corresponding wheel drive signal according to the center of gravity swing angle and the current vehicle speed, and drives the wheels to move respectively through two servo motors to generate corresponding acceleration / deceleration. The vehicle speed corresponds to the center of gravity swing angle, following the inverted pendulum control logic. When a turning signal is recognized, the inverted pendulum system recognizes the turning demand and controls the movement of the wheels on both sides to generate a wheel speed difference and realize the turning action; When it is identified that the motion platform is subject to internal or external interference, the high-speed rotating rotor is driven to deflect by the drive motor inside the CMGs, thereby generating a torque, which is used to resist the internal and external interference torques on the motion platform; When the CMGs reaches the yaw angle threshold, the platform is placed in an unbalanced state by adjusting the corresponding relationship between the center of gravity yaw angle and the vehicle speed. The gravity torque generated in this unbalanced state is used to drive the gyro to passively yaw back to the center.
10. The method according to claim 9, characterized in that The deflection angle threshold is less than 90°.
Citation Information
Patent Citations
Signal processing method for motion type inverted pendulum system control and intelligent self-balancing vehicle signal control system
CN103792946A
Unmanned bicycle balance control method based on rate gyroscope
CN106919177A
Static balance control system and method for two-wheeled single-track carrier
CN113093822A
Motion platform and control method
CN114987667A
Integrated Control Method for Balancing a Two-Wheeled Vehicle Using Control Moment Gyroscopes and Drive-by-Wire Steering Systems
US20210107573A1
