CN107264276B - 两轮差速控制无级平衡标定方法 - Google Patents

两轮差速控制无级平衡标定方法 Download PDF

Info

Publication number
CN107264276B
CN107264276B CN201710469592.5A CN201710469592A CN107264276B CN 107264276 B CN107264276 B CN 107264276B CN 201710469592 A CN201710469592 A CN 201710469592A CN 107264276 B CN107264276 B CN 107264276B
Authority
CN
China
Prior art keywords
deviation
control
calibration method
value
wheel differential
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
CN201710469592.5A
Other languages
English (en)
Other versions
CN107264276A (zh
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 Zoominbot Automobile Technology Co ltd
Original Assignee
Beijing Zoominbot Automobile Technology Co ltd
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 Zoominbot Automobile Technology Co ltd filed Critical Beijing Zoominbot Automobile Technology Co ltd
Priority to CN201710469592.5A priority Critical patent/CN107264276B/zh
Publication of CN107264276A publication Critical patent/CN107264276A/zh
Application granted granted Critical
Publication of CN107264276B publication Critical patent/CN107264276B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
    • B60K17/00—Arrangement or mounting of transmissions in vehicles
    • B60K17/04—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing
    • B60K17/12—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing of electric gearing
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
    • B60K17/00—Arrangement or mounting of transmissions in vehicles
    • B60K17/04—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing
    • B60K17/16—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing of differential gearing
    • B60K17/20—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing of differential gearing in which the differential movement is limited

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Toys (AREA)

Abstract

本发明涉及一种两轮差速控制无级平衡标定方法，通过对两轮之间的误差进行补偿，累计每一个控制周期中无法执行的控制精度偏差，当这种累计的偏差达到可控制精度时，进行补偿，以实现将系统偏差控制在数据可以表达的精度内。采用本发明所述的两轮差速控制无级平衡标定方法，可以提高车辆直线运动精度，改善基于车辆模型进行智能控制的效果。

Description

两轮差速控制无级平衡标定方法
技术领域
本发明涉及两轮差速控制技术领域，具体涉及一种两轮差速控制无级平衡标定方法。
背景技术
两轮差速控制有很多实际应用场景，如移动机器人、电动小车、平衡车等等。两轮差速 控制系统结构简单，既不需要专门的转向机构，也不需要为车轮和车轴预留太多空间。因此， 两轮差速控制系统简单廉价实用，拥有非常广阔的市场。
两轮差速控制一般使用直流电动机，采用直流电机H桥式电机驱动电路，通过脉冲宽度 调制(PWM)调速。为了提高控制精度，需要对电动机进行闭环控制，所以一般有刷电动机需 要加装旋转正交编码器。
如图1所示的H桥式电机驱动电路包括4个三极管和一个电机，因其外形酷似字母“H”， 所以称作H桥驱动电路。要使电机M运转，必须使对角线上的一对三极管导通。例如图2和 图3所示，当Q1管和Q4管导通时，电流就从电源正极经Q1从左至右穿过电机，然后再经Q4回到电源负极，电机顺时针转动；当三极管Q2和Q3导通时，电流将从右至左流过电机， 驱动电机逆时针方向转动。如图4所示，完整的晶体管H桥驱动电路，PWM1、PWM2为电机方 向控制输入端，PWM1＝1，PWM2＝0时正转，PWM1＝0、PWM2＝1时电机反转。PWM1、PWM2同时也 是电机调速的脉宽输入端。
晶体管是最为廉价的控制方法，但在晶体管上有明显的压降，会产生功率的损耗，效率 不高，适宜应用在低电压、小功率的场合。如图5所示的场效应管组成的H桥驱动电路，该 电路的功能：S1闭合，电机正转；S1断开，电机反转；S2闭合，电机转；S2断开，电机停。 场效应管是效率最高的控制方式，但价格较高，通常应用在大功率电机驱动场合。
发明内容
现实使用中，两轮差速控制系统存在生产安装不可能完全一致的问题，因此两个车轮在 实际使用时会有些许偏差。两轮之间的不同偏差程度会产生不同运动状态，这种结果会严重 影响基于车辆模型进行智能控制的精度。鉴于此，本发明提供了一种两轮差速控制无级平衡 标定方法，通过对两轮之间的旋转速度误差进行补偿，来提高车辆直线运动的精度，进而改 善基于车辆差速驱动运动学模型进行智能控制的效果。
在现有技术中，即使相同的生产线生产的两个设备，也不可能完全相同；再加上安装设 备、轮毂尺寸、轮胎尺寸和变形等，都会导致两个车轮在实际使用时会有些许偏差，两轮之 间的不同偏差程度会产生不同运动状态，这种结果会严重影响基于车辆模型进行智能控制的 精度。通过对两轮之间的误差进行补偿，以提高车辆直线运动的精度，通过采用本发明所述 的两轮差速控制无级平衡标定方法，可以明显提高车辆直线运动精度，进而改善基于车辆模 型进行智能控制的效果。
为了实现上述目的，本发明采用如下技术方案。
一种两轮差速控制无级平衡标定方法，应用于两轮差速控制系统，所述两轮差速控制无 级平衡标定方法通过对两轮之间的旋转速度误差进行补偿，来提高车辆直线运动的精度，进 而改善基于车辆差速驱动运动学模型进行智能控制的效果。所述两轮之间的旋转速度误差补 偿，是通过累计每一个控制周期中无法执行的控制精度偏差，当这种累计的偏差达到可控制 精度时，进行补偿，以实现将系统偏差控制在数据可以表达的精度内。
优选的是，所述两轮之间的旋转速度误差补偿，采用的无级平衡补偿计算式：
deviation0＝0；
realValue＝refValue*ratio；
value＝[realValue+deviationi-1]；
deviationi＝realValue-value；
其中，deviation表示偏差；
deviation0表示初始偏差；
realValue表示期望值；
refValue表示参考值；
ratio表示比例系数；
value表示输出值；
[realValue+deviationi-1]表示将期望值和累计到目前的偏差相加，然后取整；
deviationoi表示累计到目前的偏差。
在上述任一技术方案中优选的是，所述累计的偏差还包括且不限于四舍五入、向上取整、 向下取整的方式，且结果类似。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术 描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一 些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这 些附图获得其他的附图。
图1为现有技术中H桥式电机驱动电路结构示意图；
图2为现有技术中H桥电路驱动电机顺时针转动示意图；
图3为现有技术中H桥电路驱动电机逆时针转动示意图；
图4为现有技术中晶体管H桥驱动电路结构示意图；
图5为现有技术中场效应管组成的H桥驱动电路结构示意图；
图6为现有技术中车辆差速驱动运动学模型示意图；
图7为按照本发明的两轮差速控制无级平衡标定方法的一优选实施例的固定补偿和无级 平衡的比较示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描 述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明 中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例， 都属于本发明保护的范围。
为了克服两轮差速控制系统在现有技术中所存在的两轮偏差影响基于车辆模型进行智能 控制的精度问题，本发明实施例提出一种两轮差速控制无级平衡标定方法，通过对两轮之间 的误差进行补偿，以提高车辆直线运动的精度，进而改善基于车辆模型进行智能控制的效果。
如图6所示的车辆差速驱动运动学模型，其差速驱动运动常用量如表1所述，
Figure BDA0001326715460000041
表1
则
(1)左右轮线速度：
Figure BDA0001326715460000042
Figure BDA0001326715460000043
(2)左右轮旋转距离：
sl＝vl*t，
sr＝vr*t，
Figure BDA0001326715460000044
Figure BDA0001326715460000045
(3)车速：
Figure BDA0001326715460000046
Figure BDA0001326715460000051
Figure RE-GDA0001374548030000051
(4)旋转角速度：
Figure BDA0001326715460000053
Figure RE-GDA0001374548030000053
(5)旋转角度：
Figure BDA0001326715460000055
Figure BDA0001326715460000056
Figure BDA0001326715460000057
Figure BDA0001326715460000058
Figure RE-GDA0001374548030000058
由此可见，两轮差速驱动运动的位姿和运动信息都可以通过编码器和时间计算得到。因 此，只要精确控制产生编码器信息的电动机，即可实现对车辆位姿和运动的精确控制。
为了保证两轮差速运动系统直线运动，从上述车辆差速驱动运动学模型可知，只需要保 证两轮旋转速度相同即可，也就是编码器的值以相同速度变化。但是因为误差的存在，使得 两轮即使旋转速度相同，在行驶距离达到20米后，误差已经比较大，以至于无法获取准确的 位姿信息，从而无法进行精确控制。
两轮差速控制无级平衡标定方法就是通过对两轮之间的误差进行补偿，以提高车辆直线 运动的精度，也是进行曲线运动控制的基础。
从理论上来说，只需要以一个电动机为参考，调整另一个电动机的速度即可。但是，通 过编码器值进行闭环控制时，编码器是离散值，如果只是以变换控制周期进行固定补偿，虽 然能够减小整体的固定偏差，但是随着时间的延长，这种固定偏差还是会累积。而为了获得 较高的控制精度，随着控制频率的提高和控制周期的累积，这种固定偏差无疑会产生比较大 的系统偏差。
本发明实施例的两轮差速控制无级平衡标定方法，通过累计每一个控制周期中无法执行 的控制精度偏差，当这种累计的偏差达到可控制精度时，进行补偿，以实现将系统偏差控制 在数据可以表达的精度内。
本发明实施例的两轮差速控制无级平衡标定方法，一般来说，数据采用单精度或双精度 浮点数即可。
本发明实施例的两轮差速控制无级平衡标定方法，所采用的无级平衡补偿计算方法包括：
deviation0＝0；
realValue＝refValue*ratio；
value＝[realValue+deviationi-1]；
deviationi＝realValue-value；
其中，deviation表示偏差；
deviation0表示初始偏差；
realValue表示期望值；
refValue表示参考值；
ratio表示比例系数；
value表示输出值；
[realValue+deviationi-1]表示将期望值和累计到目前的偏差相加，然后取整；
deviationi表示累计到目前的偏差。
固定补偿和无级平衡的比较如表2和图7所示，采用四舍五入方式取整。累计偏差可以 控制在取整时的偏差范围以内。也可以用其它方式取整，例如向上取整，向下取整，结果类 似。采用固定补偿时，累计偏差等于一个周期中的偏差乘以周期数。因此，12个周期后，固 定补偿的累计偏差为(11-10.7)*12＝3.6；而采用无级平衡后,参考表中的数据可知累 计偏差为0.4，且该偏差不会根据时间累积，最大为0.5。
Figure BDA0001326715460000071
表2
采用本发明实施例的两轮差速控制无级平衡标定方法，对两轮之间的误差进行补偿，通 过累计每一个控制周期中无法执行的控制精度偏差，当这种累计的偏差达到可控制精度时， 进行补偿，以实现将系统偏差控制在数据可以表达的精度内。通过上述具体实施方法可以看 出，采用两轮差速控制无级平衡标定方法，可以明显提高车辆直线运动精度，进而改善基于 车辆模型进行智能控制的效果。一般在未标定的情况下，控制车辆向前行驶20米，横向误差 可达2米，转向误差可达10°。通过无级平衡标定后，20米横向误差可控制在0.5米以内， 转向误差可控制在2°以内。
以上所述仅是对本发明的优选实施方式进行描述，并非是对本发明的范围进行限定；以 上所述仅为本发明的具体实施方式而已，并不用于限定本发明的保护范围；在不脱离本发明 设计精神的前提下，本领域普通工程技术人员对本发明的技术方案作出的任何修改、等同替 换、改进等，均应落入本发明的权利要求书确定的保护范围内。

Claims (3)

1.一种两轮差速控制无级平衡标定方法，应用于两轮差速控制系统，其特征在于：通过对两轮之间的累计旋转速度偏差采用通过计算的方式进行控制补偿，来提高车辆直线运动的精度，进而改善基于车辆差速驱动运动学模型进行智能控制的效果；通过累计每一个控制周期中无法执行的控制精度偏差，当这种累计的偏差达到可控制精度时，进行补偿，以实现将系统偏差控制在数据可以表达的精度内。
2.如权利要求1所述的两轮差速控制无级平衡标定方法，其特征在于：所述两轮之间的旋转速度误差补偿，采用的无级平衡补偿计算式：
deviation0＝0；
realValue＝refValue*ratio；
value＝[realValue+deviationi-1]；
deviationi＝realValue-value；
其中，deviation表示偏差；
deviation0表示初始偏差；
realValue表示期望值；
refValue表示参考值；
ratio表示比例系数；
value表示输出值；
Figure FDA0002476990200000011
表示将期望值和累计到目前的偏差相加，然后取整；
deviationi表示累计到目前的偏差。
3.如权利要求1所述的两轮差速控制无级平衡标定方法，其特征在于：所述累计的偏差还包括且不限于四舍五入、向上取整、向下取整的方式，且结果类似。
CN201710469592.5A 2017-06-20 2017-06-20 两轮差速控制无级平衡标定方法 Expired - Fee Related CN107264276B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710469592.5A CN107264276B (zh) 2017-06-20 2017-06-20 两轮差速控制无级平衡标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710469592.5A CN107264276B (zh) 2017-06-20 2017-06-20 两轮差速控制无级平衡标定方法

Publications (2)

Publication Number Publication Date
CN107264276A CN107264276A (zh) 2017-10-20
CN107264276B true CN107264276B (zh) 2020-08-21

Family

ID=60067815

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710469592.5A Expired - Fee Related CN107264276B (zh) 2017-06-20 2017-06-20 两轮差速控制无级平衡标定方法

Country Status (1)

Country Link
CN (1) CN107264276B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107831019A (zh) * 2017-10-25 2018-03-23 上海玖锶自动化技术有限公司 一种agv运行参数标定装置及方法
CN108214507A (zh) * 2017-12-28 2018-06-29 安徽三联机器人科技有限公司 一种磁导航护理床出入库系统及出入库方法
CN109571467B (zh) * 2018-11-23 2020-09-18 北京控制工程研究所 双轮差速机器人运动模型标定方法、装置及里程计系统
CN109976352B (zh) * 2019-04-22 2023-03-28 北京华力兴科技发展有限责任公司 行走控制方法、行走控制设备和计算机可读存储介质

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100371122C (zh) * 2004-03-24 2008-02-27 湘潭大学 电子差速式自动跟踪焊接小车的驱动控制装置
US7023154B1 (en) * 2004-08-26 2006-04-04 Lionel L.L.C. Train speed control using current and velocity sensing
CN101229781B (zh) * 2008-02-04 2010-09-01 徐小康 双轮驱动电动车辆的差速控制系统
CN104590050A (zh) * 2013-10-31 2015-05-06 沈阳工业大学 四轮全驱电动汽车步进电机驱动及细分控制方法
US10020759B2 (en) * 2015-08-04 2018-07-10 The Boeing Company Parallel modular converter architecture for efficient ground electric vehicles

Also Published As

Publication number Publication date
CN107264276A (zh) 2017-10-20

Similar Documents

Publication Publication Date Title
CN107264276B (zh) 两轮差速控制无级平衡标定方法
US8080957B2 (en) Motor control device and motor-driven power steering system using the same
CN100551736C (zh) 电动驱动控制装置与电动驱动控制方法
CN101981805B (zh) 电机控制装置和电动动力转向装置
EP2110941B1 (en) Motor control apparatus and electric power steering system
CN102780442B (zh) 电动机装置及其控制方法
CN104417605A (zh) 车辆的动力转向装置
CN104467494A (zh) 电力转换设备以及具有电力转换设备的电动转向设备
CN103223940B (zh) 一种电动汽车协调控制系统
CN107836080B (zh) 电动助力转向装置
CN105790676A (zh) 旋转电机控制装置
JP2011194914A (ja) 電動パワーステアリング装置およびこれに用いられる電動機駆動制御装置
CN109768740A (zh) 永磁同步马达驱动中的功率管理
CN104052344A (zh) 旋转电机控制装置和电动助力转向设备
CN103762924A (zh) 一种永磁同步电机扭矩输出控制系统
US11066095B2 (en) Controller for steering system and method for controlling steering system
WO2007094107A1 (ja) 電磁サスペンション装置
CN106685302B (zh) 一种霍尔式位置传感器解码算法及eps控制器
CN103625542A (zh) 电动动力转向装置
CN103391034A (zh) 电动汽车轮毂用盘式无铁心永磁同步电机控制器及方法
CN107181439A (zh) 一种永磁同步电机控制方法及系统
CN108710380A (zh) 一种双轮自平衡小车的控制系统
CN117104332A (zh) 一种永磁同步电机线控转向系统复合扰动抑制方法
CN103997260A (zh) 一种直流电机多边独立驱动行走机构变速及差速控制系统
CN113972876A (zh) 一种具有转矩估测功能的永磁同步电机控制器及驾驶设备

Legal Events

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

Granted publication date: 20200821