CN103183088B - High-precision speed-regulating front and rear self-balance one-wheel scooter - Google Patents

High-precision speed-regulating front and rear self-balance one-wheel scooter Download PDF

Info

Publication number
CN103183088B
CN103183088B CN201310129811.7A CN201310129811A CN103183088B CN 103183088 B CN103183088 B CN 103183088B CN 201310129811 A CN201310129811 A CN 201310129811A CN 103183088 B CN103183088 B CN 103183088B
Authority
CN
China
Prior art keywords
speed
mrow
msub
module
control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN201310129811.7A
Other languages
Chinese (zh)
Other versions
CN103183088A (en
Inventor
阮晓钢
马圣策
于乃功
朱晓庆
孙荣毅
于淼淼
张晓平
魏若岩
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing University of Technology
Original Assignee
Beijing University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing University of Technology filed Critical Beijing University of Technology
Priority to CN201310129811.7A priority Critical patent/CN103183088B/en
Publication of CN103183088A publication Critical patent/CN103183088A/en
Application granted granted Critical
Publication of CN103183088B publication Critical patent/CN103183088B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Motorcycle And Bicycle Frame (AREA)

Abstract

本发明属于交通工具领域,公布了一种高精度调速前后自平衡独轮代步车,包括车轮、轮毂电机、踏板、支架、可伸缩连杆、调速转把、驱动模块和电源模块,还包括控制模块、高精度测速模块和姿态测量模块。独轮代步车的速度通过转动右手把调整,左右方向的平衡靠人体自身的平衡能力控制,前后方向上的平衡及速度控制,由姿态平衡控制量和速度控制量进行叠加得到的综合控制量经驱动模块驱动轮毂电机实现。本发明的速度测量模块由于增加了同轴齿轮和加速齿轮,使测速精度大大提高,解决了独轮车在低速运行时速度和位置信息测量精度难以满足要求的问题,实现了独轮代步车高精度的前后方向姿态自平衡控制和速度控制。

The invention belongs to the field of vehicles, and discloses a high-precision speed-regulating front and rear self-balancing single-wheel scooter, including wheels, hub motors, pedals, brackets, scalable connecting rods, speed-regulating handles, drive modules and power modules. Including control module, high-precision speed measurement module and attitude measurement module. The speed of the unicycle scooter is adjusted by turning the right hand handle. The balance in the left and right directions is controlled by the balance ability of the human body itself. The drive module drives the hub motor to realize. The speed measurement module of the present invention greatly improves the speed measurement accuracy due to the addition of the coaxial gear and the acceleration gear, solves the problem that the measurement accuracy of the speed and position information of the unicycle is difficult to meet the requirements when the unicycle is running at low speed, and realizes the high precision of the unicycle. Front and rear attitude self-balancing control and speed control.

Description

一种高精度调速前后自平衡独轮代步车A high-precision speed regulation front and rear self-balancing unicycle scooter

技术领域technical field

本发明属于交通工具领域,尤其涉及一种高精度调速前后自平衡独轮代步车。The invention belongs to the field of vehicles, in particular to a high-precision speed-regulating front and rear self-balancing unicycle.

背景技术Background technique

独轮车作为一种新兴的代步工具,具有体积小、成本低、使用便捷等优点,随着机器人技术应用水平的提高,对智能交通的要求也越来越高,对于自平衡独轮车的要求不仅停留在姿态平衡控制上,而是需要有高精度的稳定的速度控制。As a new means of transportation, the unicycle has the advantages of small size, low cost, and convenient use. With the improvement of the application level of robot technology, the requirements for intelligent transportation are getting higher and higher. The requirements for self-balancing unicycles are not only limited to In terms of attitude balance control, high-precision and stable speed control is required.

申请号为200810179658.8的发明专利“前后向自平衡式电动车”,通过对独轮车前后方向上俯仰倾角和角速度的测量、补偿,对独轮车进行前后姿态平衡控制,但却未能对独轮车的速度进行控制。而作为一种交通工具,独轮车在实际应用时准确的速度控制是非常最重要的,这就对车体的精准测速提出了很高的要求。The invention patent with the application number of 200810179658.8 "front and rear self-balancing electric vehicle" controls the front and rear posture balance of the unicycle by measuring and compensating the pitch angle and angular velocity in the front and rear directions of the unicycle, but fails to control the speed of the unicycle . As a means of transportation, accurate speed control of the unicycle is very important in practical applications, which puts forward high requirements for accurate speed measurement of the vehicle body.

通常对于电动车的速度测量采用霍尔传感器测速。霍尔传感器一般由霍尔元件和磁钢组成。霍尔是半导体磁敏器件,当霍尔元件和磁钢相对运动时产生信号脉冲,检测单位时间霍尔输出的脉冲数(频率),乘以车轮周长即可得到速度(米/秒)。根据磁性转盘上磁极数目,就可以确定传感器测量转速的分辨率。但由于磁极数量和霍尔元件数量的限制,车轮每转一周得到的脉冲数有限,当转速较低时,测速误差较大,很难满足速度控制的要求。Usually, Hall sensors are used for speed measurement of electric vehicles. Hall sensors are generally composed of Hall elements and magnetic steel. Hall is a semiconductor magnetic sensitive device. When the Hall element and the magnetic steel move relative to each other, a signal pulse is generated, and the number of pulses (frequency) output by the Hall per unit time is detected, and multiplied by the circumference of the wheel to obtain the speed (m/s). According to the number of magnetic poles on the magnetic turntable, the resolution of the sensor to measure the rotational speed can be determined. However, due to the limitation of the number of magnetic poles and the number of Hall elements, the number of pulses obtained per wheel revolution is limited. When the speed is low, the error of speed measurement is large, and it is difficult to meet the requirements of speed control.

我们曾在2012年申请过一个名为“一种基于惯性平衡轮的自平衡载人独轮车”的专利,申请号为201210217335.X。专利中描述行走轮同轴连接驱动电机,行走轮测速编码器与行走轮同轴连接。首先,电机与车轮同轴连接的结构设计在使用时电机易受外界磕碰而损坏。另外,测速编码器直接与车轮同轴连接,由于测量精度直接受到光电脉冲编码器本身的分辨率以及内部码盘的分度精度的影响,而独轮代步车是一种低速运动工具,单位时间所产生的脉冲信号数量有限,因此,该发明虽然具有速度控制功能,但测速精度却难以满足高精度速度控制的要求。提高编码器的分辨率虽然可以减小测量误差,但成本往往是随分辨率的增加而成倍增加,在具体使用中受到很大的限制。In 2012, we applied for a patent named "A self-balancing unicycle based on inertial balance wheel", the application number is 201210217335.X. The patent describes that the traveling wheel is coaxially connected to the drive motor, and the traveling wheel speed measuring encoder is coaxially connected with the traveling wheel. First of all, the structural design of the coaxial connection between the motor and the wheel is vulnerable to external bumps and damage to the motor during use. In addition, the speed measuring encoder is directly connected to the wheel coaxially, since the measurement accuracy is directly affected by the resolution of the photoelectric pulse encoder itself and the indexing accuracy of the internal code disc, and the unicycle is a low-speed movement tool, the unit time The number of generated pulse signals is limited. Therefore, although the invention has a speed control function, the speed measurement accuracy is difficult to meet the requirements of high-precision speed control. Although improving the resolution of the encoder can reduce the measurement error, the cost is often multiplied with the increase of the resolution, which is greatly limited in specific use.

发明内容Contents of the invention

针对现有技术中存在的上述问题,为了既能实现独轮代步车良好的前后自平衡能力,又能在低成本的前提下实现良好的速度控制,本发明提供了一种高精度调速前后自平衡独轮代步车。Aiming at the above-mentioned problems existing in the prior art, in order to not only realize the good front and rear self-balancing ability of the unicycle scooter, but also realize good speed control under the premise of low cost, the present invention provides a high-precision speed regulation front and rear Self-balancing unicycle.

本发明涉及一种高精度调速前后自平衡独轮代步车,代步车的速度通过转动右手把(内装线性霍尔调速部件)粗略调整,左右方向的平衡靠人自身的平衡能力控制,速度的精确控制及前后方向上的平衡由电气控制系统完成,电气控制系统的电路组成框图如图3所示。姿态测量模块分别测得独轮车的角加速度和角速度信息,反馈至控制模块得到姿态平衡控制量ubal;轮毂电机驱动车轮上安装的速度测量模块测量代步车的车速,反馈至控制模块得到速度控制量uv。将姿态平衡控制量ubal和速度控制量uv进行叠加融合,得到电机驱动的综合控制量uD,通过驱动模块驱动轮毂电机,实现高精度的独轮代步车前后方向姿态自平衡控制和速度控制。The invention relates to a high-precision speed-regulating front and rear self-balancing single-wheel scooter. The speed of the scooter is roughly adjusted by turning the right hand handle (with a built-in linear Hall speed regulating part), and the balance in the left and right directions is controlled by the balance ability of the person himself. The precise control and balance in the front and rear directions are completed by the electrical control system. The circuit diagram of the electrical control system is shown in Figure 3. The attitude measurement module measures the angular acceleration and angular velocity information of the unicycle respectively, and feeds back to the control module to obtain the attitude balance control value u bal ; the speed measurement module installed on the wheel driven by the in-wheel motor measures the speed of the scooter, and feeds back to the control module to obtain the speed control value u v . Superimposed and fused the attitude balance control quantity u bal and the speed control quantity u v to obtain the comprehensive control quantity u D driven by the motor, and the hub motor is driven by the drive module to realize high-precision self-balancing control of the front and rear attitude and speed of the single-wheeled scooter control.

姿态平衡控制环节需根据姿态测量模块测得的俯仰角度和角速度信息对姿态倾角补偿。由于独轮车的姿态检测信号中不可避免地存在噪声信号,使积分器消除静态误差的同时产生控制误差,因此,PID控制中去掉积分环节,选用非线性PD算法控制。The attitude balance control link needs to compensate the attitude tilt angle according to the pitch angle and angular velocity information measured by the attitude measurement module. Because there is inevitably a noise signal in the attitude detection signal of the wheelbarrow, the integrator eliminates the static error and produces a control error at the same time. Therefore, the integral link is removed in the PID control, and the nonlinear PD algorithm is used for control.

姿态平衡控制量ubal由非线性PD算法按下式得到:The attitude balance control value u bal is obtained by the nonlinear PD algorithm according to the following formula:

uu balthe bal (( tt )) == PDPD balthe bal (( θθ )) == KK PP balthe bal (( θθ )) ++ KK DD. balthe bal (( dθdθ dtdt ))

其中,PDbal(θ)为姿态平衡的非线性PD控制器;为非线性比例参数;为非线性微分参数。Among them, PD bal (θ) is the nonlinear PD controller of attitude balance; is a nonlinear scale parameter; is a nonlinear differential parameter.

速度控制量uv采用PID正反馈算法按下式得到:The speed control value u v is obtained by using the PID positive feedback algorithm as follows:

uu vv (( tt )) == PIDPIDs vv (( ee vv )) == KK PP vv ee vv ++ KK II vv ∫∫ ee vv dtdt ++ KK DD. vv dede vv dtdt

其中,是实际速度与期望速度vD的差;PIDv(ev)为速度控制器;为比例项,为正反馈,用于调节独轮车行进速度;为积分项,为正反馈,累积位移差形成的位移势能,这种位移势能不仅能消除速度静差,还可以保障复杂路面(包括坡道)行进时行进速度的平稳,另外使独轮车具备了突破障碍的能力;为微分项,为负反馈,用于消除系统的自激和振荡。in, is the actual speed The difference with the desired speed v D ; PID v (e v ) is the speed controller; is a proportional item, It is positive feedback, used to adjust the speed of the unicycle; is the integral item, It is positive feedback, the displacement potential energy formed by the cumulative displacement difference, this displacement potential energy can not only eliminate the static speed difference, but also ensure the stability of the speed when driving on complex road surfaces (including ramps), and also enable the unicycle to have the ability to break through obstacles; is the differential item, For negative feedback, it is used to eliminate self-excitation and oscillation of the system.

在独轮车行进速度控制器PIDv(ev)中,起主导作用的是比例项,其次是积分项,因此,PIDv(ev)是一个正反馈器。In PID v (e v ), the speed controller of the unicycle, the proportional term plays a leading role, followed by the integral term, therefore, PID v (e v ) is a positive feedback device.

在独轮车的控制算法中,作用于电机的综合控制量uD(t)由姿态平衡控制量ubal和行进速度控制量uv按下式叠加而成:In the control algorithm of the unicycle, the comprehensive control variable u D (t) acting on the motor is superimposed by the attitude balance control variable u bal and the travel speed control variable u v as follows:

uD(t)=ubal(t)+uv(t)=PDbal(θ)+PIDv(ev)u D (t)=u bal (t)+u v (t)=PD bal (θ)+PID v (e v )

在uD(t)中,姿态平衡控制器PDbal(θ)占据主导地位,行进速度控制器PIDv(ev)次之。独轮车的行进速度控制是通过其姿态平衡控制实现的。为了控制速度,正反馈的行进速度控制器PIDv(ev)先放纵速度,导致独轮车前后姿态失衡,从而引发起主导作用的姿态控制PDbal(θ),使原本可能矛盾的速度和姿态θ控制转变为一致的控制问题,即独轮车统一叠加后的综合控制量uD(t)能在控制姿态平衡的同时使行进速度稳定地跟踪期望速度vDIn u D (t), the attitude balance controller PD bal (θ) plays a dominant role, followed by the travel speed controller PID v (e v ). The speed control of the unicycle is realized through its posture balance control. In order to control the speed, the positive feedback travel speed controller PID v (e v ) indulges the speed first, which leads to the imbalance of the front and rear posture of the unicycle, which leads to the dominant attitude control PD bal (θ), making the originally contradictory speed And attitude θ control is transformed into a consistent control problem, that is, the comprehensive control value u D (t) of the wheelbarrow after uniform superposition can control the attitude balance and make the traveling speed stably track the desired speed v D .

一种高精度调速前后自平衡独轮代步车,包括:车轮,轮毂电机,踏板,踏板连接轴,支架,可伸缩连杆,调速转把,控制模块,驱动模块和电源模块。其特征在于,还包括:控制模块、速度测量模块和姿态测量模块。其中,A high-precision speed-regulating front and rear self-balancing unicycle scooter, including: wheels, hub motors, pedals, pedal connecting shafts, brackets, telescopic connecting rods, speed-regulating handles, control modules, drive modules and power modules. It is characterized in that it also includes: a control module, a speed measurement module and an attitude measurement module. in,

所述控制模块,安装在支架上槽内,用于产生电机的综合控制量uD(t)。其核心控制器为一DSP芯片,包括捕获速度测量模块中编码器脉冲的捕获单元CAP_QEP,将调速转把输出的速度模拟信号转换为数字信号的ADC单元,产生综合控制信号uD(t)(PWM脉宽调制波)的事件管理器EV单元,调试过程中与上位机通信(SCI协议)的异步串行通信接口单元和与接收姿态测量模块通信(SPI协议)的同步串行接口单元。The control module is installed in the upper groove of the bracket and is used to generate the comprehensive control value u D (t) of the motor. Its core controller is a DSP chip, including the capture unit CAP_QEP that captures the encoder pulse in the speed measurement module, and the ADC unit that converts the output speed analog signal into a digital signal by the speed control to generate a comprehensive control signal u D (t) (PWM pulse width modulated wave) event manager EV unit, an asynchronous serial communication interface unit communicating with the host computer (SCI protocol) during debugging, and a synchronous serial interface unit communicating with the receiving attitude measurement module (SPI protocol).

所述速度测量模块,安装在支架右侧槽内,用于精确测量电机的转速。包括:同轴齿轮a,加速齿轮b,光栅码盘和光电编码器。同轴齿轮a与轮毂电机中心轴同轴连接,同轴齿轮a与加速齿轮b啮齿,光栅码盘与加速齿轮b同轴连接。车轮转动时,带动同轴齿轮a同轴旋转,同轴齿轮a通过加速齿轮b带动光栅码盘与加速齿轮b同轴旋转,增量式光电编码器输出脉冲信息并送至控制模块。The speed measurement module is installed in the slot on the right side of the bracket, and is used to accurately measure the rotational speed of the motor. Including: coaxial gear a, acceleration gear b, grating code disc and photoelectric encoder. The coaxial gear a is coaxially connected with the central shaft of the hub motor, the coaxial gear a is meshed with the acceleration gear b, and the grating code disc is coaxially connected with the acceleration gear b. When the wheel rotates, it drives the coaxial gear a to rotate coaxially. The coaxial gear a drives the grating code disc and the accelerated gear b to rotate coaxially through the acceleration gear b. The incremental photoelectric encoder outputs pulse information and sends it to the control module.

增量式编码器利用光电转换原理输出三组方波脉冲A、B和C相。A、B两组脉冲相位差90°,可方便地判断旋转方向;C相方波每转只有一个脉冲,用于基准点定位。The incremental encoder uses the principle of photoelectric conversion to output three groups of square wave pulses A, B and C phases. The phase difference between A and B two groups of pulses is 90°, which can easily judge the direction of rotation; the C-phase square wave has only one pulse per revolution, which is used for reference point positioning.

采用传统方法检测位置时,为了确定具体的相位,零位脉冲作为起始脉冲,通过对编码器输出脉冲采用简单的记数方式可得到被测角位移θM为:When the traditional method is used to detect the position, in order to determine the specific phase, the zero pulse is used as the initial pulse, and the measured angular displacement θ M can be obtained by using a simple counting method for the encoder output pulse as:

θθ Mm == 360360 Mm KZKZ

其中,Z为编码器的分辨率,即每转一周产生的脉冲个数;M为脉冲编码器输出脉冲总数;K为编码器输出脉冲的倍频系数。Among them, Z is the resolution of the encoder, that is, the number of pulses generated per revolution; M is the total number of output pulses of the pulse encoder; K is the frequency multiplication coefficient of the output pulse of the encoder.

由θM的表达式可知,测量精度直接受到光电脉冲编码器本身的分辨率以及内部码盘的分度精度的影响。由于制造工艺和成本的限制,难以得到很高的分辨率,因此,分辨率成为影响测量精度的主要因素,尤其是对于运动速度较低的独轮车系统影响更为严重。It can be seen from the expression of θ M that the measurement accuracy is directly affected by the resolution of the photoelectric pulse encoder itself and the indexing accuracy of the internal code disc. Due to the limitations of the manufacturing process and cost, it is difficult to obtain a high resolution. Therefore, the resolution becomes the main factor affecting the measurement accuracy, especially for the unicycle system with a low moving speed.

为了提高光电码盘的分辨率,本发明在速度测量模块中增加了一个与轮毂电机中心轴同轴连接的同轴齿轮a,和一个与同轴齿轮a啮合、与光栅码盘同轴连接的加速齿轮b,其结构示意图如图4所示。在不改变码盘本身结构的提前下,本发明使光电码盘的分辨率提高到a/b倍(a、b分别为同轴齿轮a与加速齿轮b的齿数),使测速精度也提高到将近a/b倍。In order to improve the resolution of the photoelectric code disc, the present invention adds a coaxial gear a coaxially connected with the central axis of the hub motor to the speed measurement module, and a coaxial gear a meshed with the coaxial gear a and coaxially connected with the grating code disc The schematic diagram of the acceleration gear b is shown in Figure 4. Without changing the structure of the code disc itself, the present invention increases the resolution of the photoelectric code disc to a/b times (a and b are the number of teeth of the coaxial gear a and the acceleration gear b respectively), and the accuracy of speed measurement is also improved to Almost a/b times.

所述姿态测量模块,由加速度计和陀螺仪组成,安装在支架上槽内,用于测量独轮车的角加速度和角速度信息,并实时反馈给控制模块,经过滤波和计算处理后得到对代步车前后方向(俯仰角)进行平衡控制所需的、精确的角度和角速度信息。The attitude measurement module is composed of an accelerometer and a gyroscope, installed in the upper groove of the bracket, and used to measure the angular acceleration and angular velocity information of the unicycle, and feed back to the control module in real time. Accurate angle and angular velocity information required for balance control in the direction (pitch angle).

本发明所具有的有益效果是:The beneficial effects that the present invention has are:

本发明中的速度测量模块,在不增加成本的条件下,大大提高了速度和位置信息的测量精度,解决了独轮车在低速运行时因光电码盘分辨率不足造成的速度和位置信息测量精度难以满足要求的问题。结合姿态测量模块测得的角加速度和角速度信息,控制模块将速度控制量与姿态平衡控制量进行叠加融合得到电机驱动的综合控制量,实现了独轮代步车高精度的前后方向姿态自平衡控制和速度控制。The speed measurement module in the present invention greatly improves the measurement accuracy of speed and position information without increasing the cost, and solves the difficulty in the measurement accuracy of speed and position information caused by the insufficient resolution of the photoelectric code disc when the wheelbarrow is running at low speed. meet the requirements of the problem. Combined with the angular acceleration and angular velocity information measured by the attitude measurement module, the control module superimposes and fuses the speed control amount and the attitude balance control amount to obtain the comprehensive control amount of the motor drive, realizing the high-precision self-balancing control of the front and rear attitude of the unicycle and speed control.

附图说明Description of drawings

图1为本发明所涉及的独轮车的机械结构示意图;Fig. 1 is the schematic diagram of the mechanical structure of the wheelbarrow involved in the present invention;

图2为本发明所涉及的电气控制系统的结构示意图;Fig. 2 is the structural representation of electrical control system involved in the present invention;

图3为本发明所涉及的电气控制系统的电路组成框图;Fig. 3 is the circuit composition block diagram of electrical control system involved in the present invention;

图4为本发明所涉及的速度测量装置的结构示意图。Fig. 4 is a schematic structural diagram of the speed measuring device involved in the present invention.

图中:1车轮,2踏板,3轮毂电机,4支架左侧槽,5支架右侧槽,6支架上槽,7可伸缩连杆,8转把连杆,9电源模块,10速度测量装置,11驱动模块,12控制模块,13姿态测量模块,14调速转把,15控制转把,16同轴齿轮a,17加速齿轮b,18光栅码盘,19增量式光电编码器。In the figure: 1 wheel, 2 pedal, 3 wheel hub motor, 4 left slot of bracket, 5 right slot of bracket, 6 upper slot of bracket, 7 retractable connecting rod, 8 turning handle connecting rod, 9 power module, 10 speed measuring device , 11 drive module, 12 control module, 13 attitude measurement module, 14 speed control handle, 15 control handle, 16 coaxial gear a, 17 acceleration gear b, 18 grating code disc, 19 incremental photoelectric encoder.

具体实施方式Detailed ways

下面结合附图和具体实施方式对本发明作进一步的说明。The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments.

一种高精度调速前后自平衡独轮代步车,其机械结构示意图如图1所示,电气控制系统的结构示意图如图2所示,电气控制系统的电路组成框图如图3所示,包括:车轮(1)、轮毂电机(3)、踏板(2)、踏板连接轴、支架、可伸缩连杆(7)、调速转把(14)、驱动模块(11)、电源模块(9)。支架两侧轴孔与轮毂电机(3)的轴通过螺丝固定;踏板(2)与支架两侧下端轴孔通过踏板轴相连;可伸缩连杆(7)下端与支架上槽(6)前端连接,上端与转把连杆(8)连接;调速转把(14)套在转把连杆(8)右侧,调速转把(14)为一种线性调速部件,与控制模块(12)连接;转把连杆(8)左侧转把(15)上装有启动开关、喇叭和刹车;电源模块(9)安放在支架左侧槽(4)内;驱动模块(11)安装在支架右侧槽(5)内,一端与轮毂电机(3)连接,中间经过电流保护装置,另一端与控制模块(12)连接,接收控制模块(12)发出的控制信号。其特征在于,还包括控制模块(12)、速度测量模块(10)和姿态测量模块(13)。A self-balancing single-wheel scooter before and after high-precision speed regulation, its mechanical structure schematic diagram is shown in Figure 1, the structural schematic diagram of the electrical control system is shown in Figure 2, and the circuit composition block diagram of the electrical control system is shown in Figure 3, including : Wheel (1), hub motor (3), pedal (2), pedal connecting shaft, bracket, telescopic link (7), speed control handle (14), drive module (11), power module (9) . The shaft holes on both sides of the bracket are fixed to the shaft of the hub motor (3) by screws; the pedal (2) is connected to the shaft holes on both sides of the bracket through the pedal shaft; the lower end of the telescopic connecting rod (7) is connected to the front end of the upper groove (6) of the bracket , the upper end is connected with the handle connecting rod (8); the speed regulating handle (14) is set on the right side of the rotating handle connecting rod (8), and the speed regulating handle (14) is a linear speed regulating component, which is connected with the control module ( 12) Connection; the turning handle connecting rod (8) on the left turning handle (15) is equipped with a start switch, horn and brake; the power module (9) is placed in the slot (4) on the left side of the bracket; the drive module (11) is installed on the In the slot (5) on the right side of the bracket, one end is connected to the hub motor (3), the middle passes through the current protection device, and the other end is connected to the control module (12) to receive the control signal from the control module (12). It is characterized in that it also includes a control module (12), a speed measurement module (10) and an attitude measurement module (13).

控制模块(12),安装在支架上槽(6)内,用于产生电机的综合控制量uD(t)。控制模块(12)选用南京傅立叶电子有限公司HDSP-Core2812核心板,该系统的处理器采用TI公司TMS320F2812DSP,系统为5V直流供电。The control module (12) is installed in the upper slot (6) of the bracket, and is used to generate the comprehensive control quantity u D (t) of the motor. The control module (12) selects HDSP-Core2812 core board of Nanjing Fourier Electronics Co., Ltd., the processor of the system adopts TMS320F2812DSP of TI Company, and the system is powered by 5V DC.

速度测量模块(10),安装在支架右侧槽(5)内,用于精确测量电机的转速。包括:同轴齿轮a(16),加速齿轮b(17),光栅码盘(18)和增量式光电编码器(19)。同轴齿轮a(16)与轮毂电机(3)中心轴同轴连接,同轴齿轮a(16)与加速齿轮b(17)啮齿,光栅码盘(18)与加速齿轮b(17)同轴连接。The speed measurement module (10) is installed in the slot (5) on the right side of the bracket, and is used to accurately measure the rotational speed of the motor. Including: coaxial gear a (16), acceleration gear b (17), grating code disc (18) and incremental photoelectric encoder (19). The coaxial gear a (16) is coaxially connected with the center shaft of the hub motor (3), the coaxial gear a (16) is meshed with the acceleration gear b (17), and the grating code disc (18) is coaxial with the acceleration gear b (17) connect.

姿态测量模块(13),选用ADI公司生产的ADIS16300四自由度惯性测量传感器,包括单轴陀螺仪和三轴加速度计,安装在支架上槽(6)内,用于测量独轮车的角加速度和角速度信号。The attitude measurement module (13) uses the ADIS16300 four-degree-of-freedom inertial measurement sensor produced by ADI, including a single-axis gyroscope and a three-axis accelerometer, and is installed in the upper slot (6) of the bracket to measure the angular acceleration and angular velocity of the unicycle Signal.

为了保证代步车使用起来安全、耐用,本系统支架、侧槽及踏板材料均采用优质钢材料。轮毂电机(3)选用永康市久久科技有限公司生产的电动车配套的轮毂电机,额定电压48v,额定功率1000w。驱动模块(11)为与之配套的1000w大功率控制器。电源模块(9)由48v和5v可充电锂电池构成,48v锂电池选用玮孚标准锂离子电池,标称电压:48V,工作范围:39V-54.6V,标称容量:10Ah。内置过充、过放、过流及短路保护和集成电量监控电路。5v可充电锂电池为控制器供电。In order to ensure that the scooter is safe and durable to use, the brackets, side slots and pedals of this system are all made of high-quality steel materials. The hub motor (3) selects the hub motor matched with the electric vehicle produced by Yongkang Jiujiu Technology Co., Ltd., with a rated voltage of 48v and a rated power of 1000w. The drive module (11) is a matching 1000w high-power controller. The power module (9) is composed of 48v and 5v rechargeable lithium batteries. The 48v lithium battery is a Weifu standard lithium-ion battery, with a nominal voltage of 48V, an operating range of 39V-54.6V, and a nominal capacity of 10Ah. Built-in overcharge, overdischarge, overcurrent and short circuit protection and integrated power monitoring circuit. A 5v rechargeable lithium battery powers the controller.

使用时可双脚踏在踏板上,根据个人身高调节手把连杆长度。双手握住转把,左手打开启动开关,调整车体,车体支架上槽(6)与地面平行,即俯仰角接近零度。系统上电后,控制模块(12)对姿态测量模块(13)元件进行初始化。When in use, both feet can be stepped on the pedals, and the length of the connecting rod of the handle can be adjusted according to the height of the individual. Hold the turning handle with both hands, turn on the start switch with the left hand, and adjust the car body. The groove (6) on the car body bracket is parallel to the ground, that is, the pitch angle is close to zero. After the system is powered on, the control module (12) initializes the elements of the attitude measurement module (13).

转动右转把上的调速转把,给代步车一定速度要求(期望速度vD),控制模块(12)结合速度测量模块中实时得到的速度信息,得到行进速度控制量uv。将姿态平衡控制量ubal与速度控制量uv叠加,通过驱动模块(11)驱动电机,最终在姿态平衡中达到稳定的速度vD跟踪控制。Turn the speed control handle on the right turn handle to give the scooter a certain speed requirement (desired speed v D ), and the control module (12) combines the speed information obtained in real time from the speed measurement module to obtain the travel speed control value u v . The attitude balance control quantity u bal and the speed control quantity u v are superimposed, and the motor is driven through the drive module (11), finally achieving a stable speed v D tracking control in the attitude balance.

以上实施例仅用于说明本发明而并非限制本发明所描述的技术方案,一切不脱离发明精神和范围的技术方案及其改进,均应涵盖在本发明的权利要求范围当中。The above embodiments are only used to illustrate the present invention rather than limit the technical solutions described in the present invention. All technical solutions and their improvements that do not deviate from the spirit and scope of the invention should be covered by the claims of the present invention.

Claims (4)

1. A self-balancing single wheel car of riding instead of walk around high accuracy speed governing includes: the device comprises a wheel (1), a hub motor (3), a pedal (2), a pedal connecting shaft, a support, a telescopic connecting rod (7), a speed-regulating rotating handle (14), a driving module (11) and a power module (9); it is characterized by also comprising: the device comprises a control module (12), a speed measuring module (10) and an attitude measuring module (13); wherein,
the control module (12) is arranged in the bracket upper groove (6) and is used for generating comprehensive control quantity u of the motorD(t); its core controller is a DSP chip, includes: encoding in acquisition speed measurement moduleA capture unit CAP _ QEP of the pulse of the device, an ADC unit for converting the speed analog signal output by the speed regulation converter (14) into a digital signal and generating an integrated control signal uD(t) (PWM pulse width modulation wave) event manager EV unit, asynchronous serial communication interface unit communicating with upper computer (SCI protocol) and synchronous serial interface unit communicating with receiving attitude measurement module (ADIS16300) (SPI protocol) during debugging;
the speed measuring module (10) is arranged in the right side groove (5) of the bracket and is used for accurately measuring the rotating speed of the motor; the method comprises the following steps: a coaxial gear a (16), an accelerating gear b (17), a grating code disc (18) and an incremental photoelectric encoder (19); the coaxial gear a (16) is coaxially connected with a central shaft of the hub motor (3), the coaxial gear a (16) is meshed with the accelerating gear b (17), and the grating code disc (18) is coaxially connected with the accelerating gear b (17); when the wheel (1) rotates, the coaxial gear a (16) is driven to coaxially rotate, the coaxial gear a (16) drives the grating code disc (18) and the acceleration gear b (17) to coaxially rotate through the acceleration gear b (17), and the incremental photoelectric encoder (19) outputs pulse information and sends the pulse information to the control module (12);
the attitude measurement module (13) consists of an accelerometer and a gyroscope, is arranged in the upper groove (6) of the bracket and is used for measuring the angular acceleration and the angular velocity information of the monocycle, feeding the information back to the control module (12) in real time, and obtaining the accurate angle and the angular velocity information required by the balance control of the front and back directions (pitch angles) of the scooter after filtering and calculation processing.
2. The unicycle with high precision speed regulation and self-balancing in front and back of claim 1, wherein the speed of said unicycle is roughly regulated by turning right handle (with linear hall speed regulation inside), the balance in left and right direction is controlled by the balance ability of human body, the precision control of speed and the balance in front and back direction, the comprehensive control quantity u obtained by control module (12)DAnd (t) is realized by driving the hub motor (3) through the driving module (11).
3. The high-precision speed-regulating front-rear self-balancing independent machine as claimed in claim 1 or 2The wheel-driven scooter is characterized in that the comprehensive control quantity u obtained by the control module (12)D(t) controlling the quantity u by attitude balancebalAnd a traveling speed control amount uvIs formed by superposing the following formulas:
uD(t)=ubal(t)+uv(t)
attitude balance control amount ubalThe following can be obtained by the nonlinear PD algorithm:
<math> <mrow> <msub> <mi>u</mi> <mi>bal</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>PD</mi> <mi>bal</mi> </msub> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mi>K</mi> <mi>P</mi> <mi>bal</mi> </msubsup> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>K</mi> <mi>D</mi> <mi>bal</mi> </msubsup> <mrow> <mo>(</mo> <mfrac> <mi>d&theta;</mi> <mi>dt</mi> </mfrac> <mo>)</mo> </mrow> </mrow> </math>
wherein PD isbal(θ) is a pose-balanced nonlinear PD controller;is a non-linear scale parameter;is a nonlinear differential parameter;
speed control quantity uvThe PID positive feedback algorithm is adopted and obtained according to the following formula:
<math> <mrow> <msub> <mi>u</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>PID</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mi>v</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mi>K</mi> <mi>P</mi> <mi>v</mi> </msubsup> <msub> <mi>e</mi> <mi>v</mi> </msub> <mo>+</mo> <msubsup> <mi>K</mi> <mi>I</mi> <mi>v</mi> </msubsup> <msub> <mrow> <mo>&Integral;</mo> <mi>e</mi> </mrow> <mi>v</mi> </msub> <mi>dt</mi> <mo>+</mo> <msubsup> <mi>K</mi> <mi>D</mi> <mi>v</mi> </msubsup> <mfrac> <msub> <mi>de</mi> <mi>v</mi> </msub> <mi>dt</mi> </mfrac> </mrow> </math>
wherein,is the actual speedWith desired speed vDA difference of (d); PIDv(ev) Is a speed controller;in the form of a proportional term, the ratio,the feedback is positive feedback and is used for adjusting the advancing speed of the monocycle;in order to be an integral term, the integral term,the displacement potential energy formed by accumulating the displacement difference for positive feedback can not only eliminate the speed static difference, but also ensure the stability of the advancing speed when the wheelbarrow advances on a complex road surface (including a ramp), and ensure that the wheelbarrow has the capability of breaking through obstacles;In order to be a differential term, the differential term,the negative feedback is used for eliminating self-excitation and oscillation of the system;
in the speed controller PID of advancing of wheel barrowv(ev) Of which proportional term is dominant and integral term is subordinate, and therefore PIDv(ev) Is a positive feedback controller.
4. The self-balancing scooter before and after high-precision speed regulation according to claim 1, wherein the speed measurement module increases the resolution of the photoelectric code disc by a/b times and the speed measurement precision by nearly a/b times, wherein a and b are the number of teeth of the coaxial gear a (16) and the accelerating gear b (17), respectively.
CN201310129811.7A 2013-04-15 2013-04-15 High-precision speed-regulating front and rear self-balance one-wheel scooter Expired - Fee Related CN103183088B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310129811.7A CN103183088B (en) 2013-04-15 2013-04-15 High-precision speed-regulating front and rear self-balance one-wheel scooter

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310129811.7A CN103183088B (en) 2013-04-15 2013-04-15 High-precision speed-regulating front and rear self-balance one-wheel scooter

Publications (2)

Publication Number Publication Date
CN103183088A CN103183088A (en) 2013-07-03
CN103183088B true CN103183088B (en) 2015-03-25

Family

ID=48674602

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310129811.7A Expired - Fee Related CN103183088B (en) 2013-04-15 2013-04-15 High-precision speed-regulating front and rear self-balance one-wheel scooter

Country Status (1)

Country Link
CN (1) CN103183088B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103407528A (en) * 2013-07-24 2013-11-27 钟淑娣 Self-balancing electric unicycle with retractable handle
CN103407529B (en) * 2013-08-27 2016-08-10 左国刚 A kind of structure of electric unicycle
CN104590457A (en) * 2015-01-22 2015-05-06 宁波联拓思维电子科技有限公司 Control system of electric monocycle
CN104985985A (en) * 2015-06-25 2015-10-21 广州六维数控设备有限公司 AGV elastic support driving device with hub motor
CN105329399A (en) * 2015-10-28 2016-02-17 合肥工业大学 Control system and control method of scooter
CN106004298A (en) * 2016-06-30 2016-10-12 华南理工大学 AGV (automatic guided vehicle) elastic support driving device using hub motor and AGV
CN106275193B (en) * 2016-08-28 2018-09-04 江桂英 A kind of Segway Human Transporter
CN107505144A (en) * 2017-09-21 2017-12-22 石河子大学 A kind of four motorized wheels independent steering power driven mist blower Operation Van test platform
CN107943070B (en) * 2017-11-01 2020-07-28 杭州睿杰智能空中机器人科技有限公司 Method for controlling active disturbance rejection flight speed and attitude of unmanned helicopter

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102079348A (en) * 2010-12-03 2011-06-01 北京工业大学 Self-balance manned monocycle system and control method thereof
EP2409905A1 (en) * 2010-07-23 2012-01-25 Christian Verduron Powered unicycle
CN102642584A (en) * 2012-04-11 2012-08-22 浙江易力车业有限公司 Self-balancing electric manned monocycle
CN102815357A (en) * 2012-06-27 2012-12-12 北京工业大学 Self-balancing manned solowheel based on inertia balance wheel

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8219308B2 (en) * 2010-02-02 2012-07-10 Leeser Karl F Monowheel type vehicle

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2409905A1 (en) * 2010-07-23 2012-01-25 Christian Verduron Powered unicycle
CN102079348A (en) * 2010-12-03 2011-06-01 北京工业大学 Self-balance manned monocycle system and control method thereof
CN102642584A (en) * 2012-04-11 2012-08-22 浙江易力车业有限公司 Self-balancing electric manned monocycle
CN102815357A (en) * 2012-06-27 2012-12-12 北京工业大学 Self-balancing manned solowheel based on inertia balance wheel

Also Published As

Publication number Publication date
CN103183088A (en) 2013-07-03

Similar Documents

Publication Publication Date Title
CN103183088B (en) High-precision speed-regulating front and rear self-balance one-wheel scooter
CN202201103U (en) Electric two-wheeled balance car
CN203318585U (en) High-precision speed regulation front and back self-balancing device for single-wheel scooter
TWI607926B (en) Displacement equipment and power assist system
CN103529850A (en) Control method of two-wheeled self-balance vehicle
CN203244742U (en) Electric self-balancing double-wheel scooter
CN104477052A (en) Control method of self-balancing man-riding electric unicycle
CN103170962A (en) Desktop type double-wheel self-balancing robot
CN108177693A (en) Wheel hub drives the electronic differential control system of electric vehicle
CN102582738A (en) Variable-structure self-balancing two-wheeled vehicle
EP1955936A1 (en) Fall-prevention control device
CN104670359A (en) Double-wheel mini type motorcycle
CN103191558A (en) Electric Self Balancing Single Wheel Scooter
CN106379478A (en) Scooter speed control system based on gyroscope and realization method of scooter speed control system
CN101691127A (en) System for controlling motion balance of dual-wheel auto balancing electric vehicle
CN104635738A (en) Precise trace tracking optimal control method for uncertain rehabilitation walking training robot
CN106976462A (en) Heavy loading locomotive anti-skid control method based on asymmetric obstacle Li Yapu love functions
CN106080942A (en) A kind of Self-balancing electronic bicycle drive train system
CN106364368A (en) Control system of electric vehicle based on two hub motors
CN106515984A (en) Bicycle driving system and bicycle comprising same
CN205396339U (en) Self -balancing single wheel scooter
CN105799826B (en) A kind of self-balancing single-wheel scooter and its application
CN109484205A (en) Integrated digital unit-combination type In-wheel motor driving device
CN105128699B (en) A kind of control method of portable pocket-type intelligent electric motor car
CN204649442U (en) A kind of motor in electric automobile braking anti-lock performance experiment table

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150325

CF01 Termination of patent right due to non-payment of annual fee