Two-wheel self-balancing chassis with adjustable center of gravity

By setting the center of gravity adjustment component and DC brushless hub motor on the two-wheel self-balancing device, combined with the dual-core servo control system, switching between static and dynamic balance is achieved, solving the problem of large power consumption when the device has no tasks for a long time. , improves the energy saving and smoothness of the equipment.

CN109911085BActive Publication Date: 2024-11-01HEBEI HUIJIN ELECTROMECHANICAL
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN201711330118.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2017-12-13
Publication Date
2024-11-01
Estimated Expiration
2037-12-13

AI Technical Summary

Technical Problem

Due to the principle of dynamic stability, the existing two-wheel self-balancing equipment consumes a lot of battery power when there is no task for a long time, and auxiliary support is difficult to achieve and costly, which affects the appearance.

Method used

By setting the center of gravity adjustment component on the chassis, the attitude detection module is used to detect the attitude angle of the chassis in real time, and adjust the center of gravity through the linear drive mechanism, so that the system can switch between static balance and dynamic balance. The DC brushless hub motor and dual-core servo control system are used. , realize low-speed closed-loop control and precise driving.

Benefits of technology

Realize static balance when the equipment is idle, saves power, and does not need to drive the hub motor frequently, which improves the energy-saving effect of the equipment and quickly switches to dynamic balance during operation, improves the efficiency and smoothness of the system, and avoids external auxiliary support. need.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN109911085B_ABST
    Figure CN109911085B_ABST
Patent Text Reader

Abstract

The present invention discloses a two-wheel self-balancing chassis device with adjustable center of gravity, which belongs to the field of robot technology, and includes a chassis, two hub motors arranged on the chassis, running wheels installed on the hub motors, a battery installed under the chassis, and a matching control circuit, and is characterized in that: a center of gravity adjustment component is provided on the chassis, and the center of gravity adjustment component includes a center of gravity adjustment block and a linear drive mechanism for driving the center of gravity adjustment block to move up and down. When the device is idle, the device of the present invention controls the center of gravity adjustment block to descend, so that the center of gravity of the system descends below the horizontal plane of the hub motor output shaft, and no dynamic balance is required to be formed by frequent driving of the hub motor, and no external auxiliary support is required, which has an energy-saving effect and does not affect the appearance design of the chassis. When the device is running, the center of gravity adjustment block is controlled to rise, so that the center of gravity of the system rises above the horizontal line of the hub motor output shaft, so that the system enters dynamic balance.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of robots, and in particular relates to a two-wheel self-balancing chassis device with adjustable center of gravity. Background Art

[0002] The chassis of the electric two-wheeled self-balancing vehicle is based on the principle of "dynamic stability", that is, the gyroscope and acceleration sensor integrated inside the self-balancing vehicle chassis are used to detect changes in the vehicle chassis posture, and the matching servo control system is used to accurately drive the hub motor to make corresponding adjustments to maintain the dynamic balance of the system.

[0003] Two-wheeled electric balancing vehicles are generally supported by two wheels, powered by lithium-ion batteries, and driven by brushless DC motors. The microcontroller collects angular velocity and angular acceleration signals and calculates the attitude angle of the balancing vehicle chassis to control the balance of the vehicle. Usually, balancing vehicles achieve vehicle balance, walking, turning, braking, etc. by detecting changes in the center of gravity of the human body (i.e. changes in the attitude angle of the chassis).

[0004] Existing two-wheeled self-balancing devices have certain drawbacks: Since the realization of the balance car is based on the principle of "dynamic stability", the self-balancing two-wheeled device needs to continuously drive the hub motor forward and reverse to achieve the effect of dynamic stability. If the device has no tasks for a long time, most of the battery power will be consumed in dynamic balance, which is not in line with the concept of energy saving and environmental protection. In order to achieve energy-saving effects, some two-wheeled self-balancing devices generally add auxiliary supports, that is, the auxiliary supports automatically fall when the device is idle. However, the auxiliary supports are easily affected by factors such as uneven ground or foreign objects on the ground, and the adaptive auxiliary supports are difficult to implement and the cost is high. At the same time, the auxiliary supports will also have a certain impact on the appearance of the device. Summary of the invention

[0005] The technical problem to be solved by the present invention is to provide a two-wheeled self-balancing chassis device with an adjustable center of gravity. By arranging a center of gravity adjustment component on the chassis, a posture detection module detects changes in the chassis posture angle in real time, and the center of gravity of the chassis device is changed by the center of gravity adjustment component so that it can switch between static balance and dynamic balance.

[0006] In order to solve the above technical problems, the technical solution adopted by the present invention is: a two-wheel self-balancing chassis device with adjustable center of gravity, including a chassis, two hub motors arranged on the chassis, running wheels installed on the hub motors, batteries installed under the chassis and a matching control circuit, characterized in that: a center of gravity adjustment component is provided on the chassis, and the center of gravity adjustment component includes a center of gravity adjustment block and a linear drive mechanism for driving the center of gravity adjustment block to move up and down.

[0007] The beneficial technical effects of the present invention are as follows: 1. When the equipment is idle, the control circuit will issue a control instruction to make the lifting drive motor drive the center of gravity adjustment block to descend, so that the center of gravity of the system drops below the horizontal plane of the hub motor output shaft, and the system enters static balance. The dynamic balance formed by frequent driving of the hub motor is no longer required, and external auxiliary support is not required, which has an energy-saving effect and does not affect the appearance design of the chassis. When the equipment is running, the control circuit issues a control instruction to make the lifting drive motor drive the center of gravity adjustment block to rise, so that the center of gravity of the system rises above the horizontal line of the hub motor output shaft, so that the system enters dynamic balance; 2. A DC brushless hub motor is adopted, and the hub motor body is integrated with the hub, which saves the physical space required for installing the motor, and the DC brushless hub motor has the functions of no friction, no electric spark, and maintenance-free. Compared with the DC brushless motor, the DC brushless motor has a higher utilization rate of the bus voltage, which makes the system more efficient and effectively extends the working time of the equipment; 3. During the operation of the equipment, the travel motor controller integrates the internal FOC of the PMSM 4. After the equipment is powered on, the MCU reads the data of MPU6050 in real time, fuses the data of MPU6050 and accelerometer through Kalman filtering technology, and corrects the zero drift of gyroscope data in time, so that the pitch angle and yaw angle of the self-balancing vehicle chassis are solved more accurately; 5. During the operation of the equipment, the MCU realizes the PID control of the speed loop of the single hub motor, the differential PID control of the speed execution percentage of the dual hub motor, and the PID control of the yaw angle correction read by the gyroscope, so that the movement of the self-balancing vehicle chassis is smoother and more accurate; 6. The MCU performs dual closed-loop control by introducing the yaw angle data of the gyroscope MPU6050 and the Hall signal of the DC brushless hub motor, so that both the steering angle and speed can be accurately controlled. 7. During the operation of the equipment, the microcontroller smoothes and filters the calculation results and outputs them. Except for the emergency stop, each decomposition action of the self-balancing chassis is smoother. 8. During the operation of the equipment, the role of the lithium-ion battery in this system is fully considered, and the circuit is equipped with short-circuit protection, over-current protection and under-voltage protection to prevent the impact of large current on the lithium-ion battery and the premature aging caused by excessive discharge of the lithium-ion battery.

[0008] The present invention is described in detail below with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0009] Figure 1 2 is a schematic structural diagram of a two-wheel self-balancing chassis device with adjustable center of gravity according to the present invention;

[0010] Figure 2The figure is a schematic diagram of the control principle of the two-wheel self-balancing chassis device with adjustable center of gravity of the present invention.

[0011] In the attached drawings: 1 is the chassis, 2 is the hub motor, 3 is the travel wheel, 4 is the battery, 5 is the center of gravity adjustment block, 6 is the mounting plate, 7 is the lifting drive motor, 8 is the gear, 9 is the rack, 10 is the slide rail, 11 is the slider, 12 is the single-chip microcomputer, 13 is the travel motor controller, and 14 is the posture detection module. DETAILED DESCRIPTION

[0012] See attached Figure 1 The present invention provides a two-wheel self-balancing chassis device with adjustable center of gravity, comprising a chassis 1, two wheel hub motors 2 arranged on the chassis 1, walking wheels 3 installed on the wheel hub motors 2, a battery 4 installed under the chassis 1 and a matching control circuit. The key lies in: a center of gravity adjustment component is provided on the chassis 1, and the center of gravity adjustment component includes a center of gravity adjustment block 5 and a linear drive mechanism for driving the center of gravity adjustment block 5 to move up and down.

[0013] The above-mentioned linear drive mechanism includes a mounting plate 6 fixed on the chassis 1, a lifting drive motor 7 arranged on the mounting plate 6, a gear 8 fixed on the output shaft of the lifting drive motor 7, a rack 9 limited on the mounting plate 6 by a guide assembly and meshed with the gear 8, and a center of gravity adjustment block 5 is connected to the bottom of the rack 9. It can be imagined by those skilled in the art that the linear drive mechanism can also adopt a linear drive mechanism such as an electric push rod and a cylinder.

[0014] A placement hole matching the center of gravity adjustment block 5 is provided on the chassis 1. When the center of gravity is at a high position (i.e., in dynamic balance), the center of gravity adjustment block 5 passes through the placement hole and is located in or above the placement hole. When the center of gravity is at a low position (i.e., in static balance), the center of gravity adjustment block 5 moves downward through the placement hole and is located below the placement hole. The guide assembly includes a slide rail 10 provided on the mounting plate 6 and a slider 11 matching the slide rail 10, and the slider 11 is connected to the rack 9. The hub motor 2 is preferably a DC brushless hub motor. The battery 4 can also be provided on the center of gravity adjustment block 5 to use the weight of the battery as part of the center of gravity adjustment.

[0015] See attached Figure 2The control circuit includes a single-chip microcomputer 12, a walking motor controller 13 connected to the single-chip microcomputer 12, and a posture detection module 14. The wheel hub motor 2 is connected to the walking motor controller 13, and the signal end of the linear drive mechanism is connected to the single-chip microcomputer 12. Both the single-chip microcomputer 12 and the walking motor controller 13 use STM32F103RCT6. The posture detection module 14 uses MPU-6050, which integrates a three-axis gyroscope and a three-axis accelerometer in one, and has a smaller size. The single-chip microcomputer 12 sends a first control signal to the walking motor controller 13, and the walking motor controller 13 sends signals to the two DC brushless wheel hub motors respectively, thereby driving the chassis to move. The two DC brushless wheel hub motors drive the self-balancing chassis to achieve balancing, walking, turning, braking and other actions.

[0016] More specifically, the single-chip microcomputer 12 cooperates with the travel motor controller 13 to complete the servo control of the DC brushless hub motor, wherein the travel motor controller 13 realizes the inner loop (current loop) control of the DC brushless hub motor drive, and the single-chip microcomputer 12 completes the outer loop (speed loop) control of the DC brushless hub motor by introducing the Hall signal of the DC brushless hub motor. In addition, the single-chip microcomputer 12 completes the matching adjustment of the synchronous operation of the dual hub motors through the Hall signal of the DC brushless hub motor. At the same time, the single-chip microcomputer 12 can accurately control the steering angle, steering speed and straight-line forward correction compensation of the chassis part by introducing the yaw angle data calculated by the attitude detection module 14. The single-chip microcomputer 12 sends a second control signal to the lifting drive motor 7, and the lifting drive motor 7 changes the center of gravity of the entire device by driving the center of gravity adjustment block 5 to rise or fall. The single-chip microcomputer 12 and the travel motor controller 13 communicate in real time through the serial port.

[0017] When the equipment is idle, the single-chip computer 12 will issue a control command to make the lifting drive motor 7 drive the center of gravity adjustment block 5 to descend, so that the center of gravity of the system drops below the horizontal plane of the output shaft of the hub motor 2, and the system enters static balance. It no longer requires the dynamic balance formed by frequent driving of the hub motor 2, nor does it require external auxiliary support, which has an energy-saving effect and does not affect the appearance design of the chassis. When the equipment is running, the single-chip computer 12 issues a control command to make the lifting drive motor 7 drive the center of gravity adjustment block 5 to rise, so that the center of gravity of the system rises above the horizontal line of the output shaft of the hub motor 2, and the system enters dynamic balance.

[0018] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, ordinary technicians in the field should understand that the specific implementation methods of the present invention can still be modified or some technical features can be replaced by equivalents without departing from the spirit of the technical solution of the present invention, which should be included in the scope of the technical solution for protection of the present invention.

Claims

1. A two-wheel self-balancing chassis device with an adjustable center of gravity, comprising a chassis (1), two wheel hub motors (2) arranged on the chassis (1), running wheels (3) mounted on the wheel hub motors (2), a battery (4) mounted below the chassis (1) and a matching control circuit, characterized in that: A center of gravity adjustment component is provided on the chassis (1), and the center of gravity adjustment component comprises a center of gravity adjustment block (5) and a linear drive mechanism for driving the center of gravity adjustment block (5) to move up and down; The linear drive mechanism comprises a mounting plate (6) fixed on the chassis (1), a lifting drive motor (7) arranged on the mounting plate (6), a gear (8) fixed on an output shaft of the lifting drive motor (7), and a rack (9) limited on the mounting plate (6) by means of a guide assembly and meshing with the gear (8), wherein the center of gravity adjustment block (5) is connected to the rack (9). A placement hole matching the center of gravity adjustment block (5) is provided on the chassis (1); when in dynamic balance, the center of gravity adjustment block (5) is located in the placement hole or above the placement hole; when in static balance, the center of gravity adjustment block (5) is located below the placement hole; When the device is idle, the single-chip microcomputer (12) issues a control command to cause the lifting drive motor (7) to drive the center of gravity adjustment block (5) to descend, so that the center of gravity of the system descends to below the horizontal plane of the output shaft of the wheel hub motor (2), and the system enters static balance; when the device is running, the single-chip microcomputer (12) issues a control command to cause the lifting drive motor (7) to drive the center of gravity adjustment block (5) to ascend, so that the center of gravity of the system rises to above the horizontal line of the output shaft of the wheel hub motor (2), and the system enters dynamic balance.

2. The two-wheel self-balancing chassis device with adjustable center of gravity according to claim 1, characterized in that: The guide assembly comprises a slide rail (10) arranged on the mounting plate (6) and a slider (11) matching the slide rail (10), wherein the slider (11) is connected to the rack (9).

3. The two-wheel self-balancing chassis device with adjustable center of gravity according to claim 1, characterized in that: The wheel hub motor (2) is a brushless DC wheel hub motor.

4. The two-wheel self-balancing chassis device with adjustable center of gravity according to any one of claims 1 to 3, characterized in that: The control circuit comprises a single chip microcomputer (12), a walking motor controller (13) connected to the single chip microcomputer (12), and a posture detection module (14); the wheel hub motor (2) is connected to the walking motor controller (13); and the signal end of the linear drive mechanism is connected to the single chip microcomputer (12).

5. The two-wheel self-balancing chassis device with adjustable center of gravity according to claim 4, characterized in that: The single chip microcomputer (12) and the walking motor controller (13) both adopt STM32F103RCT6.

6. The two-wheel self-balancing chassis device with adjustable center of gravity according to claim 4, characterized in that: The posture detection module (14) adopts MPU-6050.