CN203732988U - Unicycle robot capable of achieving self balancing - Google Patents

Abstract

The utility model discloses a self-balancing unicycle robot, which comprises a wireless module, a gyroscope, a motion controller, and a servo driver. Rod, waist plate and single wheel; swing rod servo driver, waist plate servo driver and single wheel servo driver are respectively connected to the motion controller through wires, gyroscope and swing rod encoder collect body posture, and feed back the signal to the motion controller. The signal is processed under the control program, so as to send control commands to the swing rod servo driver, waist disc servo driver and single wheel servo driver, and then respectively control the swing rod, waist disc and single wheel rotation, and adjust and control the attitude of the robot. The utility model can adjust the moment of inertia of the pendulum rod and the waist plate on-line, strengthens the balance and steering adjustment ability of the unicycle robot, and enhances the adaptability of the robot to the dynamic and complicated environment.

Description

A self-balancing unicycle robot

technical field

The utility model relates to the technical field of intelligent robots, in particular to a unicycle robot capable of realizing self-balancing.

Background technique

The unicycle robot is a robot system designed according to the mechanical mechanism of humans riding a unicycle. It has attracted the attention of robotics researchers because of its small size and high energy efficiency. Different from the general static balance robot, the unicycle robot is a mechanical system that is statically unstable and dynamically stable, and has broad application prospects: using its dynamic balance characteristics, it can be introduced into complex terrain environments for transportation and rescue; using its shape The feature of slim and flexible steering can realize the monitoring and detection of narrow environment.

A series of studies have been carried out abroad on self-balancing unicycle robots. In the early days, Jascha van Pommeren and others at the University of California in the United States successfully developed the Unibot, a self-balancing machine for a unicycle, which combines the drive mode of a wheeled inverted pendulum and an inertia wheel inverted pendulum to automatically maintain balance. But the Unibot lacks a steering mechanism, so the unicycle machine lacks the ability to turn and avoid obstacles. Ruan Xiaogang's team from Beijing University of Technology has done more research on unicycle robots in China. They made a prototype of a unicycle robot and performed front-to-back, left-to-right balance experiments. For example, the Chinese invention patent with the publication number CN102445944A is a self-balancing robot system with one wheel. The upper part of the robot system contains a vertically placed waist plate that can rotate left and right to realize the horizontal balance control of the robot; There is a rotatable horizontal waist plate in the middle, which is used to realize the turning of the robot; the lower part of the fuselage is a single wheel that can rotate back and forth, which is used to realize the front and rear balance system of the robot. The vertical waist plate and the horizontal The lumbar discs are placed to achieve the balance control of the fuselage through the overall steering, but there is no direct force on the yaw direction of the fuselage, and the moment of inertia of the rotor remains unchanged, and the waist rotation and upper body mass when riding a unicycle are not considered. Due to the influence of distribution dynamic changes on turning balance control, the ability to deal with complex and variable environments is weak, and it is more difficult in heading control, and because the waist plate is an overall rotation, its control accuracy is low.

Utility model content

The technical problem to be solved by the utility model is to provide a self-balancing unicycle robot based on variable moment of inertia lumbar disc control. The unicycle robot can not only achieve front, rear, left, right balance and flexible steering, but also can adjust the rotation of the pendulum on-line The inertia and the distribution of the center of mass of the car body can be adjusted to enhance the balance and steering control ability of the unicycle robot, making the controllable inclination angle larger and the turning radius smaller, thereby enhancing the adaptability of the robot to the dynamic and complex environment.

For solving the problems of the technologies described above, the technical scheme that the utility model adopts is as follows:

A self-balancing unicycle robot, comprising a wireless module, a gyroscope, a motion controller, a vehicle frame, a swing rod, a waist disc, a single wheel and a servo drive, the servo drive comprising a swing rod servo drive, a waist disc servo drive and the single-wheel servo driver; the swing rod servo driver, waist disc servo driver, and single-wheel servo driver are respectively connected to the motion controller through wires, the waist disc is connected to the waist disc servo driver, and the single wheel is connected to the single-wheel servo drive. The driver is connected, the swing rod is set on the upper part of the frame, the waist plate is set on the waist of the frame, and the single wheel is set on the lower part of the frame,

The fork includes a fork bracket, a fork shaft, a fork slider, a fork motor, and a fork encoder. The fork support is vertically arranged on the vehicle frame, and the fork shaft is connected to the fork support. Between the two sides, one end of the swing rod shaft is connected to the swing rod motor, the other end of the swing rod shaft is connected to the swing rod encoder, and the swing rod motor and the swing rod encoder are respectively connected to the swing rod servo driver through wires;

The swing rod slider is arranged in the swing rod bracket through the slide rod, the swing rod slider is connected with the worm gear shaft through the swing rod steel rope, the worm gear and the worm are matched, the worm and the worm drive motor are coaxially connected, and the forward and reverse rotation of the worm gear Drive the pendulum slider to move up and down;

The gyroscope and the pendulum encoder collect the posture of the vehicle body, feed back the signal to the motion controller, process the signal under the control program, and send a control command to the pendulum servo driver;

The pendulum rod servo driver, the waist disc servo driver and the one-wheel servo driver all receive instructions from the motion controller to respectively control the rotation of the pendulum rod, the waist disc and the one-wheel, and adjust and control the posture of the robot.

In order to dynamically change the moment of inertia of the lumbar disc, the lumbar disc includes a lumbar disc shaft, a rim of the lumbar disc, a lumbar disc drive motor, a lumbar disc slider drive motor A and a lumbar disc slider drive motor B;

One end of the lumbar disk shaft is connected to the lumbar disk drive motor, the lumbar disk drive motor is fixed on the waist of the vehicle body, and the lumbar disk drive motor is connected to the lumbar disk servo driver through wires;

The lumbar disc rim is connected with the vehicle frame through the lumbar disc shaft, and a lumbar disc slider is arranged on the lumbar disc rim, and the lumbar disc slider and the cross-shaped rocker are matched through a keyway, and the lumbar disc slider and the lumbar disc slider They are connected with each other through connecting rods. The drive motor B of the waist disc slider is connected to the outside of the waist disc slider through the waist disc steel rope, which can drive the slider to move outward. The waist disc slider drive motor A is connected to the waist disc The inner surface of the disc slider is connected, which can drive the slider to move inward.

Preferably, there are four waist disc sliders, which are respectively arranged on two vertical diameters of the waist disc rim, and are symmetrical in pairs.

Preferably, the waist disc drive motor, waist disc slider drive motor A and waist disc slider drive motor B are stepping motors.

Preferably, the single wheel includes a single wheel shaft, a single wheel motor and a single wheel encoder,

The single wheel is connected with the vehicle frame through the single wheel shaft, the single wheel is connected with the single wheel motor and the single wheel encoder through the rim gear, the single wheel encoder is connected with the single wheel shaft through the meshing of the encoder gear and the gear, the single wheel motor and The single-wheel encoder is connected with the single-wheel servo driver through wires, and the single-wheel servo driver is connected with the motion controller through wires.

In order to improve the acceleration and deceleration performance of the motor, and then precisely control the stepping process, the single-wheel motor is a single-wheel pancake motor.

Preferably, there are 2 or more sliders of the swing rod, arranged in the vertical direction, and distributed on the upper and lower sides of the swing rod shaft.

Preferably, the swing rod motor is a swing rod pancake motor.

Compared with the prior art, the utility model has the following advantages:

1. The self-balancing unicycle robot designed by this utility model can realize the balance movement of the robot in situ, linear balance movement and turning balance movement, and the height of the center of gravity of the balance adjustment mechanism can be adjusted, and the size of the moment of inertia can be adjusted. Based on the principle of conservation, such a system has a larger adjustment angle, a smaller turning radius, and a faster response speed.

2. Different from the previous single design of the balance wheel or balance bar to maintain the lateral balance of the vehicle body, this utility model is designed as a swing bar with adjustable mass divisions. In order to meet different environmental requirements, the swing bar can be freely switched into three working modes:

① Balance wheel working mode: the swing rod rotates at high speed to simulate the balance wheel, and the swing rod slider moves synchronously, which can replace the traditional balance wheel to realize the adjustability of the moment of inertia, improve the flexibility of steering, and greatly reduce the minimum turning radius;

②Horizontal bar working mode: the pendulum bar is in a horizontal position as shown in Figure 3. There is a slider inside the pendulum bar that can move independently and freely. The control ability is stronger, and the body posture can be adjusted more quickly, which meets the requirement of adjusting the center of mass of the body when passing the slope road;

③ Heavy swing working mode: the pendulum is in the vertical position as shown in Figure 4, and the slider of the pendulum moves down, and the center of gravity of the pendulum moves down to simulate heavy pendulum. The displacement is controllable, so that the moment of inertia of the heavy swing and the center of gravity of the vehicle body can be adjusted in real time, so that the control sensitivity is higher and the control function is more perfect. The center of gravity can change the requirements in real time, so that the robot runs more smoothly.

3. The waist plate of the utility model can dynamically change its moment of inertia by moving the position of the waist plate slider. Since the waist plate slider is made of dense metal, the moment of inertia of the waist plate can be realized in a wide range to be nearly continuous. Therefore, the self-adjusting ability of the unicycle robot is improved, and the adaptability to different environments is greatly improved.

4. The single wheel of the utility model adopts the meshing transmission of the rim gear and the motor gear, which improves the reduction ratio and reduces the driving torque of the motor, replaces the traditional reducer design, and solves the problem of insufficient output torque of the traditional motor.

Description of drawings

Fig. 1 is an isometric isometric view of a unicycle robot that can realize self-balancing;

Fig. 2 is a left view of a self-balancing unicycle robot;

Fig. 3 is a front view of a working mode of a unicycle robot crossbar capable of self-balancing;

Fig. 4 is a front view of a re-swing working mode of a unicycle robot that can realize self-balancing;

Fig. 5 is the structural diagram of lumbar disc;

Fig. 6 is the top view of lumbar disc;

Fig. 7 is the bottom view of lumbar disc;

Figure 8 is a sectional view of the swing rod;

Figure 9 is an isometric view of the swing rod.

Labels in the figure: 1-wireless module; 2-gyroscope; 3-frame; 4-swing rod; 5-swing rod encoder; 6-frame board; 7-waist plate; 8-lumbar drive motor; -motion controller; 10-single wheel; 11-swing bar pancake motor; 12-single wheel pancake motor; 13-gear; 14-single wheel encoder; 15-encoder gear; 16-rim gear; 17-independent Wheel shaft; 18-servo driver; 19-waist disc rim; 20-cross rocker; 21-connecting rod; 22-waist disc slider; 23-waist disc slider drive motor A; 24-waist disc slider drive Motor B; 25-waist plate pulley; 26-waist plate steel rope; 27-swing rod bracket; 28-swing rod slider; 29-swing rod pulley; 30-swing rod steel rope; 33-worm drive motor; 34-sliding rod; 35-battery pack.

Detailed ways

In order to more clearly illustrate the technical characteristics of this scheme, the following will describe this scheme in detail in conjunction with the accompanying drawings and specific implementation methods:

As shown in Figures 1 and 2, a self-balancing unicycle robot of the present invention is an aluminum alloy frame, including a wireless module 1, a gyroscope 2, a motion controller 9, a servo driver 18, a vehicle frame 3, and a vehicle frame. Plate 6, battery pack 35, swing rod 4, waist disc 7 and single wheel 10; said servo drive 18 includes swing rod servo drive, waist disc servo drive, single wheel servo drive, servo drive 18, motion controller 9, and The battery pack 35 is fixedly connected on the vehicle frame plate 6 . The waist disc 7 is connected to the waist disc servo driver, the single wheel 10 is connected to the single wheel servo driver, the pendulum rod servo driver, the waist disc servo driver and the single wheel servo driver are respectively connected to the motion controller 9 through wires, The swing rod 4 is arranged on the top of the vehicle frame 3 , the waist plate 7 is arranged on the waist of the vehicle frame 3 , and the single wheel 10 is arranged on the bottom of the vehicle frame 3 .

As shown in Figures 8 and 9, the swing rod 4 is an adjustable mechanical body, which includes a swing rod bracket 27, a swing rod shaft, a swing rod slider 28, a swing rod motor, a swing rod encoder 5, and the swing rod Support 27 is vertically arranged on the vehicle frame 3, and the swing rod rotating shaft is then connected between the both sides of the swing rod support 27, and one end of the swing rod rotating shaft is connected with the swing rod motor, and the other end of the swing rod rotating shaft is connected with the swing rod encoder. 5 is connected, the swing rod motor and the swing rod encoder 5 are respectively connected with the swing rod servo drive through wires.

Described swing rod slide block 28 is arranged in the swing rod support 27 by slide rod 34, and swing rod slide block 28 is connected with worm gear shaft by swing rod steel rope 30, and swing rod steel rope 30 passes through swing rod pulley 29, and worm wheel 31 is connected with worm gear. 32, the worm 32 is coaxially connected with the worm drive motor 33, the positive and negative rotation of the worm wheel 31 drives the swing rod slider 28 to move up and down, and the movement of the swing rod slider 28 adjusts the mass distribution of the swing rod 4, so that the swing rod 4 can be changed in real time. The moment of inertia of bar 4 and the position of the center of mass of the car body. Described fork slide block 28 is 4 and is divided into two groups, and 2 fork slide blocks 28 in every group are arranged along the vertical direction, and two groups of fork slide blocks 28 are distributed on the upper and lower sides of the fork shaft. By adjusting the swing rod shaft, the swing rod slider 28, etc., the swing rod 4 can realize three motion control modes: circular balance wheel motion, horizontal fine-tuning motion and vertical heavy swing motion.

As shown in Figures 5, 6, and 7, the waist disc 7 is an adjustable mechanical body, which includes a waist disc shaft, a waist disc rim 19, a waist disc drive motor 8, a waist disc slider drive motor A23 and a waist disc slider. Block drive motor B24.

One end of the waist disc shaft is connected with the waist disc drive motor 8, the waist disc drive motor 8 is fixed on the waist of the vehicle body, and the waist disc drive motor 8 is connected with the waist disc servo driver through wires.

The waist disc rim 19 is connected with the vehicle frame 3 through the waist disc shaft, and the waist disc slider 22 is arranged on the waist disc rim 19, and the waist disc slider 22 cooperates with the cross rocker through the keyway, and the waist disc slider 22 and the waist disc slider 22 are connected to each other through a connecting rod 21. Each waist disc slider 22 is made of denser metal material and has equal quality. The waist disc slider 22 and the cross rocker 20 adopt The keyway is connected, and can slide mutually, and described waist disc slide block 22 is 4 pieces, is arranged on 2 vertical diameters of waist disc rim 19 respectively, and two pairs of symmetry. The waist plate steel rope 26 passes through the waist plate pulley 25, and the waist plate slider drive motor B24 is connected to the outside of the waist plate slider 22 through the waist plate steel rope 26, which can drive the slider to move outwards, and the waist plate slider drive motor A23 The waist disc steel rope 26 is connected with the inner surface of the waist disc slider 22, which can drive the slider to move inward.

Described single wheel 10 comprises single wheel shaft 17, single wheel motor and single wheel encoder 14, and described single wheel 10 is connected with vehicle frame 3 by single wheel shaft 17, and single wheel 10 is connected with single wheel motor and single wheel by rim gear 16. The wheel encoder 14 is connected, the single wheel encoder 14 is connected with the single wheel shaft 17 through the meshing of the encoder gear 15 and the gear 13, the single wheel motor and the single wheel encoder 14 are connected with the single wheel servo driver through the wire, and the single wheel servo driver is connected through the wire Connect with motion controller 9.

The single-wheel motor and the pendulum motor of the utility model adopt the pancake motor, and the pancake motor is used as the driving power source of the single wheel 10. Its advantage is that the pancake motor belongs to the power motor and has good acceleration and deceleration performance, thereby accurately controlling the step journey.

The waist disc drive motor 8, the waist disc slider drive motor A23 and the waist disc slider drive motor B24 adopt stepper motors, and the stepper motors are used as the drive power source of the waist disc slider 22. The advantage is that the volume is small and easy to install. , the step process can be accurately controlled, and the movement position of the waist disc slider 22 can be precisely controlled, thereby eliminating the need to add an additional displacement sensor to obtain the position signal of the waist disc slider 22, thus reducing the cost.

The gyroscope 2 and the pendulum encoder 5 collect the attitude of the vehicle body, feed back the signal to the motion controller 9, process the signal under the control program, and send a control command to the pendulum servo driver.

The swing rod servo driver, the waist disc servo driver and the single wheel servo driver receive instructions from the motion controller 9, and then control the swing rod 4, the waist disc 7 and the The unicycle 10 rotates to adjust and control the attitude of the robot.

The utility model is a self-balancing unicycle robot, which can also be called a variable-structure self-balancing unicycle robot. The process of maintaining the balance of the vehicle body during the traveling process is:

The main function of the unicycle robot is to realize the front and rear movement and turning control of the robot under the premise of maintaining the front and rear pitch balance and lateral balance of the vehicle body, and to change the moment of inertia of the waist plate 7 and the pendulum 4 according to different space environments and landform environments , to improve the adaptability of the robot. The motion controller 9 of the unicycle robot obtains the vehicle body attitude signal collected by the gyroscope 2, and calculates the driving torque of the motor, and calculates the acceleration corresponding to the motor torque, and sends the ASCII code to the pendulum servo driver, waist disc servo driver and Single-wheel servo driver performs control:

(1) The single-wheel servo driver controls the movement of the single-wheel pancake motor 12, and the single-wheel encoder (14) feeds back the speed and acceleration of the single-wheel 10. The single-wheel pancake motor 12 meshes with the gear 13 to drive the single-wheel 10 to maintain the balance of the robot in the front and rear directions. and can realize linear motion; the swing rod servo driver controls the movement of the swing rod pancake motor 11, the swing rod encoder 5 feeds back the speed and acceleration of the swing rod 4, and the swing rod pancake motor 11 is coaxial with the swing rod shaft, thereby driving the swing rod 4 to rotate and maintain The body is laterally balanced. The gyroscope 2 detects the inclination angle information and sends it to the motion controller 9, and the motion controller 9 controls the rotation of the pendulum 4 according to a predetermined motion balance control algorithm. 4. Rotate to the left, so that the vehicle body obtains a moment to the right, so that the vehicle body swings to the right. When the gyroscope 2 detects that the fuselage deviates to the left, if the balance wheel is in the balance wheel working mode, the balance wheel will accelerate the rotation counterclockwise, so that the body will obtain a moment to the right, so that the fuselage will swing to the right; if it is in the crossbar working mode Next, as shown in Figure 3, the pendulum 4 rotates counterclockwise so that it generates a rotational moment to offset the effect of the robot's gravity moment; , the two sliders move down, the mass of the swing bar 4 is concentrated at the lower end of the swing bar 4, and the center of mass offset generated by the right turn of the swing bar 4 lower end offsets the center of gravity offset of the robot. In the same way, when the gyroscope 2 detects that the body has an offset to the right, the pendulum 4 rotates to the right to keep the body in lateral balance.

(2) The waist disc servo driver controls the rotation of the waist disc drive motor 8, and the waist disc drive motor 8 is coaxial with the waist disc axis, thereby controlling the rotation of the waist disc 7. When turning left, the motion controller 9 controls the rotation according to the predetermined motion The algorithm controls the waist plate 7 to turn right, so that the vehicle body obtains a leftward twisting moment to make the robot body turn left. When the external environment changes and the torsional moment needs to be significantly increased, the waist disc slider drive motor B24 can be controlled to rotate, and the waist disc slider 22 is connected with the waist disc slider drive motor B24 through a steel rope to drive the waist disc slider 22, and The waist disc sliders 22 are connected with the waist disc sliders 22 through the connecting rod 21, so that the four waist disc sliders 22 all move outwards to increase the moment of inertia of the waist disc 7, and achieve the purpose of significantly improving the torsional moment.

Claims (8)

1. can realize the wheelbarrow robot of self-equilibrating for one kind, comprise wireless module (1), gyroscope (2), motion controller (9), vehicle frame (3), fork (4), waist dish (7), single wheel (10) and servo-driver (18), described servo-driver (18) comprises fork servo-driver, waist dish servo-driver and single wheel servo-driver; Described fork servo-driver, waist dish servo-driver, single wheel servo-driver are connected with motion controller (9) by wire respectively, described waist dish (7) is connected with waist dish servo-driver, described single wheel (10) is connected with single wheel servo-driver, described fork (4) is arranged at vehicle frame (3) top, described waist dish (7) is arranged at the waist of vehicle frame (3), described single wheel (10) is arranged at the bottom of vehicle frame (3), it is characterized in that:

Described fork (4) comprises swing link bracket (27), fork rotating shaft, fork slide block (28), fork motor, fork scrambler (5), described swing link bracket (27) is vertically arranged on vehicle frame (3), fork rotating shaft is connected between the both sides of swing link bracket (27), and one end of fork rotating shaft is connected with fork motor, the other end of fork rotating shaft is connected with fork scrambler (5), and fork motor is connected with fork servo-driver respectively by wire with fork scrambler (5);

Described fork slide block (28) is arranged in swing link bracket (27) by slide bar (34), fork slide block (28) is connected with worm-wheel shaft by fork steel cable (30), worm gear (31) matches with worm screw (32), worm screw (32) is coaxially connected with worm drive motor (33), and the rotating of worm gear (31) drives fork slide block (28) to move up and down;

Described gyroscope (2) and fork scrambler (5) gather body gesture, signal feedback, to motion controller (9), is processed signal under control program, thereby sent steering order to servo-driver (18);

Described fork servo-driver, waist dish servo-driver, single wheel servo-driver are all accepted instruction from motion controller (9), control respectively fork (4), waist dish (7) and single wheel and rotate, and the attitude of robot is regulated to control.

2. the wheelbarrow robot that realizes self-equilibrating according to claim 1, is characterized in that: described waist dish (7) comprises waist dish axle, waist plate wheel edge (19), waist disk-drive motor (8), waist dish slider-actuated motor A(23) and waist dish slider-actuated motor B (24);

Described waist dish axle one end is connected with waist disk-drive motor (8), and waist disk-drive motor (8) is fixed on vehicle body waist, and waist disk-drive motor (8) is connected with waist dish servo-driver by wire;

Described waist plate wheel edge (19) is connected with vehicle frame (3) by waist dish axle, be provided with waist dish slide block (22) at waist plate wheel edge (19), waist dish slide block (22) matches by keyway with cross rocking bar, between waist dish slide block (22) and waist dish slide block (22), interconnect by connecting rod (21), waist dish slider-actuated motor B (24) is connected with waist dish slide block (22) outside by waist dish steel cable (26), can be with movable slider outwards to move, waist dish slider-actuated motor A(23) be connected with waist dish slide block (22) inner face by waist dish steel cable (26), can be with movable slider to move inward.

3. the wheelbarrow robot that realizes self-equilibrating according to claim 2, is characterized in that: described waist dish slide block (22) is 4, is arranged at respectively in 2 perpendicular diameter of waist plate wheel edge (19), and symmetrical between two.

4. the wheelbarrow robot that realizes self-equilibrating according to claim 2, is characterized in that: described waist disk-drive motor (8), waist dish slider-actuated motor A(23) and waist dish slider-actuated motor B (24) be stepper motor.

5. the wheelbarrow robot that realizes self-equilibrating according to claim 1, is characterized in that: described single wheel (10) comprises single wheel axle (17), single wheel motor and single wheel scrambler (14),

Described single wheel (10) is connected with vehicle frame (3) by single wheel axle (17), single wheel (10) is connected with single wheel scrambler (14) with single wheel motor by wheel rim gear (16), single wheel scrambler (14) is connected with single wheel axle (17) with gear (13) engagement by encoder gear (15), single wheel motor is connected with single wheel servo-driver by wire with single wheel scrambler (14), and single wheel servo-driver is connected with motion controller (9) by wire.

6. the wheelbarrow robot that realizes self-equilibrating according to claim 5, is characterized in that: described single wheel motor is single wheel pancake motor (12).

7. the wheelbarrow robot that realizes self-equilibrating according to claim 1, is characterized in that: described fork slide block (28) is more than 2 or 2, vertically arranges, and is distributed in the both sides up and down of fork rotating shaft.

8. the wheelbarrow robot that realizes self-equilibrating according to claim 1, is characterized in that: described fork motor is fork pancake motor (11).