CN105059446A - 两轮平衡车的控制方法 - Google Patents

两轮平衡车的控制方法 Download PDF

Info

Publication number
CN105059446A
CN105059446A CN201510497783.3A CN201510497783A CN105059446A CN 105059446 A CN105059446 A CN 105059446A CN 201510497783 A CN201510497783 A CN 201510497783A CN 105059446 A CN105059446 A CN 105059446A
Authority
CN
China
Prior art keywords
pwm
angle
controller
speed
current
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.)
Granted
Application number
CN201510497783.3A
Other languages
English (en)
Other versions
CN105059446B (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.)
Guangzhou Coayu Robot Co Ltd
Original Assignee
Shenzhen Bona Robot 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 Shenzhen Bona Robot Technology Co ltd filed Critical Shenzhen Bona Robot Technology Co ltd
Priority to CN201510497783.3A priority Critical patent/CN105059446B/zh
Publication of CN105059446A publication Critical patent/CN105059446A/zh
Application granted granted Critical
Publication of CN105059446B publication Critical patent/CN105059446B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/72—Electric energy management in electromobility

Landscapes

  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明提供一种两轮平衡车的控制方法，包括步骤：S1:控制器、定时器和传感器进入初始化；S2:传感器将采集的信号发送至控制器；S3:控制器处理采集的信号，得到车体当前的俯仰角度、俯仰角速度、车把转向角采样值及相比时间间隔T0前时的俯仰角度差、俯仰角速度差；S4:控制器执行公式（1）；S5：控制器执行公式（2）；S6:控制器执行公式（3）和（4）；S7:控制器将得出当前的左电机输出转速输出至左电机、右电机输出转速输出至右电机。本发明的有益效果是：采用其步骤，即能够保证平衡车转向的灵活性，亦能够保证平衡车行驶的稳定性。

Description

两轮平衡车的控制方法
技术领域
本发明涉及两轮平衡车技术领域，特别是一种两轮平衡车的控制方法。
背景技术
平衡车，又叫体感车、思维车、摄位车等。市场上主要有独轮和两轮两类。其运作原理主要是建立在一种被称为“动态稳定”(DynamicStabilization)的基本原理上，利用车体内部的陀螺仪和加速度传感器，来检测车体姿态的变化，并利用伺服控制系统，精确地驱动电机进行相应的调整，以保持系统的平衡。
现有的两轮平衡车，亟待提高其行驶的平衡性与稳定性。
发明内容
为了解决上述现有的技术问题，本发明提供一种两轮平衡车的控制方法，采用其步骤，即能够保证平衡车转向的灵活性，亦能够保证平衡车行驶的稳定性。
本发明解决上述现有的技术问题，提供一种两轮平衡车的控制方法，包括以下步骤：
S1:控制器、定时器和传感器进入初始化；
S2:传感器将采集的信号发送至控制器；
S3:控制器处理采集的信号，得到车体当前的俯仰角度angle、俯仰角速度palastance、车把转向角采样值angle_AD及相比时间间隔T0前时的俯仰角度差angle_dif、俯仰角速度差palstance_dif；
S4:控制器执行公式(1)
pwm_add＝A·angle_dif+B·palstance_dif
其中，pwm_add为当前的速度增量；A、B为控制参数；angle_dif为俯仰角度差；palstance_dif为俯仰角速度差；
S5：控制器执行公式(2)
pwm＝pwm0+pwm_add
其中，pwm为当前的直行转速，pwm0为时间间隔T0前时对应的直行转速；pwm_add为当前的速度增量；
S6:控制器执行公式(3)和(4)
pwm_L＝pwm+C·angle_AD
pwm_R＝pwm-C·angle_AD
其中，pwm_L为左电机输出转速；pwm_R为右电机输出转速；pwm为当前的直行转速；C为变量，车体左转向时，C为负值；车体右转时，C为正值；angle_AD为当前车把转向角采样值；
S7:控制器将得出当前的左电机输出转速pwm_L输出至左电机、右电机输出转速pwm_R输出至右电机。
本发明更进一步的改进如下所述。
S7之后跳至步骤S3，执行下一个循环。
所述传感器包括加速度计和陀螺仪。
相较于现有技术，本发明的有益效果是：采用其步骤，即能够保证平衡车转向的灵活性，亦能够保证平衡车行驶的稳定性。
附图说明
图1为本发明两轮平衡车的控制方法流程图。
具体实施方式
下面结合附图说明及具体实施方式对本发明进一步说明。
如图1所示，一种两轮平衡车的控制方法，包括以下步骤：
S1:控制器、定时器和传感器进入初始化；
S2:传感器将采集的信号发送至控制器；
S3:控制器处理采集的信号，得到车体当前的俯仰角度angle、俯仰角速度palastance、车把转向角采样值angle_AD及相比时间间隔T0前时的俯仰角度差angle_dif、俯仰角速度差palstance_dif；
S4:控制器执行公式(1)
pwm_add＝A·angle_dif+B·palstance_dif
其中，pwm_add为当前的速度增量；A、B为控制参数；angle_dif为俯仰角度差；palstance_dif为俯仰角速度差；
S5：控制器执行公式(2)
pwm＝pwm0+pwm_add
其中，pwm为当前的直行转速，pwm0为时间间隔T0前时对应的直行转速；pwm_add为当前的速度增量；
S6:控制器执行公式(3)和(4)
pwm_L＝pwm+C·angle_AD
pwm_R＝pwm-C·angle_AD
其中，pwm_L为左电机输出转速；pwm_R为右电机输出转速；pwm为当前的直行转速；C为变量，车体左转向时，C为负值；车体右转时，C为正值；angle_AD为当前车把转向角采样值；
S7:控制器将得出当前的左电机输出转速pwm_L输出至左电机、右电机输出转速pwm_R输出至右电机。
采用上述步骤，即能够保证平衡车转向的灵活性，亦能够保证平衡车行驶的稳定性。
其中，参数A、B、C的取值范围分别为：500≧A≧250；12≧B≧5；5≧C≧1；本发明将俯仰角度和俯仰角速度结合起来，根据俯仰角度差和俯仰角速度差的大小分段选用不同的控制参数A和B。当俯仰角度和俯仰角速度变化幅度较小时，参数A和B相对较小，可保证车辆行驶的平稳性；当俯仰角度和俯仰角速度变化幅度相对较大时，选用数值较大的参数A和B，以使得车辆具有较快的速度响应特性，以保证车辆能在较短时间内实现自动平衡。
为了兼顾车辆转向的灵活性和行驶的稳定性，参数C根据当前直行转速pwm的大小分段取值。当pwm较小时，C取大值，以增加平衡车低速转速的灵活性；当pwm相对较大时，C取小值，以保证平衡车高速转速的稳定性。
本发明S7之后跳至步骤S3，执行下一个循环，其中的T0可选为1～5毫秒。
本发明的传感器包括加速度计和陀螺仪。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明，不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干简单推演或替换，都应当视为属于本发明的保护范围。

Claims (3)

1.一种两轮平衡车的控制方法，其特征在于，包括以下步骤：
S1:控制器、定时器和传感器进入初始化；
S2:传感器将采集的信号发送至控制器；
S3:控制器处理采集的信号，得到车体当前的俯仰角度angle、俯仰角速度palastance、车把转向角采样值angle_AD及相比时间间隔T0前时的俯仰角度差angle_dif、俯仰角速度差palstance_dif；
S4:控制器执行公式(1)
pwm_add＝A·angle_dif+B·palstance_dif
其中，pwm_add为当前的速度增量；A、B为控制参数；angle_dif为俯仰角度差；palstance_dif为俯仰角速度差；
S5：控制器执行公式(2)
pwm＝pwm0+pwm_add
其中，pwm为当前的直行转速，pwm0为时间间隔T0前时对应的直行转速；pwm_add为当前的速度增量；
S6:控制器执行公式(3)和(4)
pwm_L＝pwm+C·angle_AD
pwm_R＝pwm-C·angle_AD
其中，pwm_L为左电机输出转速；pwm_R为右电机输出转速；pwm为当前的直行转速；C为变量，车体左转向时，C为负值；车体右转时，C为正值；angle_AD为当前车把转向角采样值；
S7:控制器将得出当前的左电机输出转速pwm_L输出至左电机、右电机输出转速pwm_R输出至右电机。
2.根据权利要求1所述的两轮平衡车的控制方法，其特征在于：S7之后跳至步骤S3，执行下一个循环。
3.根据权利要求1或2所述的两轮平衡车的控制方法，其特征在于：所述传感器包括加速度计和陀螺仪。
CN201510497783.3A 2015-08-14 2015-08-14 两轮平衡车的控制方法 Active CN105059446B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510497783.3A CN105059446B (zh) 2015-08-14 2015-08-14 两轮平衡车的控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510497783.3A CN105059446B (zh) 2015-08-14 2015-08-14 两轮平衡车的控制方法

Publications (2)

Publication Number Publication Date
CN105059446A true CN105059446A (zh) 2015-11-18
CN105059446B CN105059446B (zh) 2018-04-06

Family

ID=54489046

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510497783.3A Active CN105059446B (zh) 2015-08-14 2015-08-14 两轮平衡车的控制方法

Country Status (1)

Country Link
CN (1) CN105059446B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105644674A (zh) * 2016-03-21 2016-06-08 杭州骑客智能科技有限公司 人机互动运动车的主控板及人机互动运动车的控制系统
CN108068938A (zh) * 2016-11-11 2018-05-25 广东高标电子科技有限公司 一种双轮车速度控制方法及系统
CN108909918A (zh) * 2018-05-29 2018-11-30 沈江 一种平衡车的控制电路及其控制方法
CN111169579A (zh) * 2016-01-27 2020-05-19 陈城 两轮电动平衡车

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004135428A (ja) * 2002-10-10 2004-04-30 Toyota Industries Corp 電気式産業車両の走行制御装置及び走行制御方法
CN1502513A (zh) * 2002-11-20 2004-06-09 中国科学技术大学 自平衡两轮电动车
JP2006001384A (ja) * 2004-06-16 2006-01-05 Sony Corp 不安定走行装置
US20080208409A1 (en) * 2003-02-10 2008-08-28 Nissan Motor Co., Ltd. Vehicle dynamics control apparatus
CN101691127A (zh) * 2009-08-20 2010-04-07 天津锦泰勤业精密电子有限公司 双轮自动平衡电动车运动平衡控制系统
CN101772436A (zh) * 2007-08-07 2010-07-07 爱考斯研究株式会社 车辆
CN101823485A (zh) * 2010-03-25 2010-09-08 武汉若比特机器人有限公司 一种轮式倒立摆的传感器处理与平衡控制算法
JP2011207277A (ja) * 2010-03-29 2011-10-20 Toyota Motor Corp 倒立二輪車、その姿勢制御方法及びプログラム
CN103770872A (zh) * 2014-02-20 2014-05-07 深圳乐行天下科技有限公司 一种两轮平衡车的转向控制方法
CN104765942A (zh) * 2014-01-02 2015-07-08 深圳乐行天下科技有限公司 一种两轮平衡车的速度融合方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004135428A (ja) * 2002-10-10 2004-04-30 Toyota Industries Corp 電気式産業車両の走行制御装置及び走行制御方法
CN1502513A (zh) * 2002-11-20 2004-06-09 中国科学技术大学 自平衡两轮电动车
US20080208409A1 (en) * 2003-02-10 2008-08-28 Nissan Motor Co., Ltd. Vehicle dynamics control apparatus
JP2006001384A (ja) * 2004-06-16 2006-01-05 Sony Corp 不安定走行装置
CN101772436A (zh) * 2007-08-07 2010-07-07 爱考斯研究株式会社 车辆
CN101691127A (zh) * 2009-08-20 2010-04-07 天津锦泰勤业精密电子有限公司 双轮自动平衡电动车运动平衡控制系统
CN101823485A (zh) * 2010-03-25 2010-09-08 武汉若比特机器人有限公司 一种轮式倒立摆的传感器处理与平衡控制算法
JP2011207277A (ja) * 2010-03-29 2011-10-20 Toyota Motor Corp 倒立二輪車、その姿勢制御方法及びプログラム
CN104765942A (zh) * 2014-01-02 2015-07-08 深圳乐行天下科技有限公司 一种两轮平衡车的速度融合方法
CN103770872A (zh) * 2014-02-20 2014-05-07 深圳乐行天下科技有限公司 一种两轮平衡车的转向控制方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111169579A (zh) * 2016-01-27 2020-05-19 陈城 两轮电动平衡车
CN105644674A (zh) * 2016-03-21 2016-06-08 杭州骑客智能科技有限公司 人机互动运动车的主控板及人机互动运动车的控制系统
CN105644674B (zh) * 2016-03-21 2019-03-15 杭州骑客智能科技有限公司 人机互动运动车的主控板及人机互动运动车的控制系统
CN108068938A (zh) * 2016-11-11 2018-05-25 广东高标电子科技有限公司 一种双轮车速度控制方法及系统
CN108909918A (zh) * 2018-05-29 2018-11-30 沈江 一种平衡车的控制电路及其控制方法

Also Published As

Publication number Publication date
CN105059446B (zh) 2018-04-06

Similar Documents

Publication Publication Date Title
TWI644830B (zh) Bicycle control device
JP6761696B2 (ja) 自転車用制御装置および自転車の制御方法
CN106080941B (zh) 一种实现变速平衡控制的无人驾驶自行车
CN105059446B (zh) 两轮平衡车的控制方法
US20150353151A1 (en) Method and device for the driving stabilization of a motorized two-wheeled vehicle using a double-gyroscope device
JP5996572B2 (ja) 車体のロール角推定装置
EP3053799B1 (en) Evaluation program, recording medium, evaluation method, evaluation device, and vehicle
WO2016158904A1 (ja) サスペンション振動情報推定装置
JP6776998B2 (ja) 自動運転システム
CN202201103U (zh) 一种电动两轮平衡车
CN104071031A (zh) 一种纯电动汽车起步抖动的抑制方法
JP2014159269A (ja) 四輪操舵車両の制御方法
CN103676650A (zh) 两轮自平衡智能车的带死区的pid优化控制方法
CN104442830A (zh) 四轮转向/驱动车辆的速度估计和摩擦辨识方法
CN103287435B (zh) 车辆姿态控制装置
CN108501768A (zh) 一种基于z轴陀螺仪及轮速差的两轮速度控制方法
CN113226881B (zh) 车辆运动状态推断装置、车辆运动状态推断方法以及车辆
CN103786816A (zh) 一种两轮平衡车的行驶控制方法
CN102232030A (zh) 动力转向装置
JP5251177B2 (ja) 車両走行状態推定装置
CN106078744B (zh) 一种两轮自平衡机器人滑模自适应控制系统
CN101973313A (zh) 基于自治体技术的车辆转向稳定控制装置及方法
JP5012604B2 (ja) 車両用制御装置
JP5137792B2 (ja) 車両横力外乱推定装置
JP2010089577A (ja) 車両のスタビリティファクタ推定装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information

Address after: 518104, Shenzhen, Guangdong, Baoan District Province, manhole Road, No. 438, block two or three

Applicant after: GUANGDONG BONA ROBOT Corp.,Ltd.

Address before: 518104, Shenzhen, Guangdong province Baoan District manhole town Wanfeng Wan community 132 Wan An Road, new mansion, 10 floor

Applicant before: SHENZHEN BAOLE ROBOT TECHNOLOGY CO.,LTD.

COR Change of bibliographic data
GR01 Patent grant
GR01 Patent grant
CP02 Change in the address of a patent holder

Address after: 510000 No.30 haogang Avenue, Dagang Town, Nansha District, Guangzhou City, Guangdong Province (plant a, B, c)

Patentee after: GUANGDONG BONA ROBOT Corp.,Ltd.

Address before: 518104, Shenzhen, Guangdong, Baoan District Province, manhole Road, No. 438, block two or three

Patentee before: GUANGDONG BONA ROBOT Corp.,Ltd.

CP02 Change in the address of a patent holder
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20200923

Address after: 510000 No.30 haogang Avenue, Dagang Town, Nansha District, Guangzhou City, Guangdong Province

Patentee after: GUANGZHOU COAYU ROBOT Co.,Ltd.

Address before: 510000 No.30 haogang Avenue, Dagang Town, Nansha District, Guangzhou City, Guangdong Province (plant a, B, c)

Patentee before: GUANGDONG BONA ROBOT Corp.,Ltd.

PE01 Entry into force of the registration of the contract for pledge of patent right
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: Control method of two wheel balance vehicle

Effective date of registration: 20211223

Granted publication date: 20180406

Pledgee: Shanghai Pudong Development Bank Limited by Share Ltd. Guangzhou branch

Pledgor: GUANGZHOU COAYU ROBOT Co.,Ltd.

Registration number: Y2021440000397

PP01 Preservation of patent right
PP01 Preservation of patent right

Effective date of registration: 20230320

Granted publication date: 20180406

PD01 Discharge of preservation of patent
PD01 Discharge of preservation of patent

Date of cancellation: 20250421

Granted publication date: 20180406