CN110941280A - 一种激光追踪平衡车控制方法 - Google Patents
一种激光追踪平衡车控制方法 Download PDFInfo
- Publication number
- CN110941280A CN110941280A CN201911288253.2A CN201911288253A CN110941280A CN 110941280 A CN110941280 A CN 110941280A CN 201911288253 A CN201911288253 A CN 201911288253A CN 110941280 A CN110941280 A CN 110941280A
- Authority
- CN
- China
- Prior art keywords
- balance car
- balance
- parameter
- module
- car
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 230000001133 acceleration Effects 0.000 claims description 14
- 230000003068 static effect Effects 0.000 claims description 6
- 238000013016 damping Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 description 7
- 230000004069 differentiation Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- FFGPTBGBLSHEPO-UHFFFAOYSA-N carbamazepine Chemical compound C1=CC2=CC=CC=C2N(C(=O)N)C2=CC=CC=C21 FFGPTBGBLSHEPO-UHFFFAOYSA-N 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000009699 differential effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Motorcycle And Bicycle Frame (AREA)
Abstract
本发明公开了一种激光追踪平衡车控制方法,属于技术领域,所述移动终端无线连接所述蓝牙模块,所述蓝牙模块与所述微控芯片导线连接,所述微控芯片通过导线与所述直流电机驱动模块、六轴运动处理模块和视觉模块导线连接,本发明能在静止时也保持平衡车处于平衡状态。
Description
技术领域
本发明涉及一种控制方法,特别涉及一种激光追踪平衡车控制方法,属于激光追踪平衡车技术领域。
背景技术
电动平衡车,又叫体感车、思维车、摄位车等。市场上主要有独轮和双轮两类。其运作原理主要是建立在一种被称为动态稳定的基本原理上,利用车体内部的陀螺仪和加速度传感器,来检测车体姿态的变化,并利用伺服控制***,精确地驱动电机进行相应的调整,以保持***的平衡,是现代人用来作为代步工具、休闲娱乐的一种新型的绿色环保的产物。
而现有技术中的激光追踪平衡车皆是采用利用车体内部的陀螺仪和加速度传感器,来检测车体姿态的变化此种方式会出现陀螺仪与加速器时间轴之差的问题,其次用于激光追踪的摄模块并不容易处理机器视觉算法中处理复杂的输出,并且现有的平衡车只能在平衡车运动时保持平衡,由于在运动过程中,操作者对平衡车具有一定的平衡力,但是平衡车在直立时无法实现平衡,为此设计一种激光追踪平衡车控制***及其控制方法来解决上述问题。
发明内容
本发明的主要目的是为了提供一种激光追踪平衡车控制方法,能使得平衡车在静止时也处于平衡状态,且能根据激光对平衡车的移动。
本发明的目的可以通过采用如下技术方案达到:
本发明一种激光追踪平衡车控制方法,包括如下步骤:
步骤1:通过移动终端接收使用者操作;
步骤2:通过移动终端发送控制指令至蓝牙模块;
步骤3:通过蓝牙模块将控制信息发送至微控芯片;
步骤4:视觉模块采集激光信号并生成运动轨迹发送给微控芯片;
步骤5:微控芯片检测平衡车是否处于静止状态,若是,则通过六轴处理模块获取平衡车姿态角度偏差,然后根据PI算法确定风轮调整参数使得平衡车处于平衡状态;若不是,则通过六轴处理模块获取平衡车车体姿态的空间数据,然后根据PID算法确定直流电机驱动模块调整参数使得平衡车处于平衡状态并按照运动轨迹移动。
优选的,根据PI算法确定风轮调整参数使得平衡车处于平衡状态具体包括:六轴处理模块获取平衡车姿态角度以及速度信息,然后对姿态角度进行微分处理得到姿态角速度,对速度信息进行积分处理得到速度值,然后根据公式得到风轮调整参数a,其中k、p和d为角度调节参数,和为速度调节参数,为速度信息,B为姿态角度,为姿态角速度;
根据确定风轮调整参数对风轮的电机瞬间转动需要的电压值进行调整,风轮的电机在瞬时加速下带动风轮加速产生离心加速度将小车往反方向上施力使得平衡车处于平衡状态。
优选的,
步骤5中根据PID算法确定直流电机驱动模块调整参数使得平衡车处于平衡状态具体包括:
51:比例参数相当于所述平衡车倒下的回复力,该参数要大于重力加速度,当逐步增大比例参数时,所述平衡车开始能够保持直立,微分参数相当于阻尼力,调节微分参数用于抑制车模的摆动;
52:调节比例参数P、微分参数D这两个参数时遵循先比例后微分的顺序,先调整比例参数使得所述追踪平衡车能够保持直立并且开始来回摆动,然后逐步增加微分参数,所述追踪平衡车逐步直立稳定,进一步增大微分参数直到两轮自平衡车开始共振,至此确定微分参数的最大值;
53.减小微分参数,然后逐步增大比例参数,直到所述平衡车又开始震荡,至此确定比例参数的最大值,根据调节的比例参数、微分参数最终输出直流电机模块电机速度调整参数值。。
本发明的有益技术效果:
本发明提供的一种激光追踪平衡车控制方法,通过视觉模块对激光进行检测确定平衡车运动移动轨迹,然后根据移动终端与微控芯片相连实现平衡车的控制,操作简单,并且根据平衡车在静止时采用PI算法对风轮模块进行控制使得平衡车处于平衡状态,而在运动时采用PID算法对直流电机模块进行控制使得平衡处于平衡状态,从而使得平衡车处于静止状态时也能处于平衡状态,同时在静止时采用PI算法,由于直立平衡必然会影响到小车的前进,小车在直立控制的作用下,小车会前倾获取加速度,所以车轮会向后运动,这时小车的速度会被减慢,但是由于是负反馈作用,速度减慢之后,速度控制的偏差会增大,小车前倾的角度会增大,如此作用,小车便不能保持直立平衡,所以一般的单负反馈***在直立控制的影响下会起到正反馈的作用,所以不能采用一般的单负反馈***,要使用串级负反馈***,在串级负反馈***中,使用微分的效果不明显,所以这里采用的是PI算法控制,使得控制效果更好。
附图说明
图1为按照本发明的一种激光追踪平衡车控制方法对应控制***的一优选实施例的***图;
图2为按照本发明的一种激光追踪平衡车控制方法的一优选实施例的流程图。
具体实施方式
为使本领域技术人员更加清楚和明确本发明的技术方案,下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
如图1和2所示,一种激光追踪平衡车控制方法,其中追踪平衡车包括蓝牙模块、直流电机驱动模块、微控芯片、风轮模块、六轴运动处理模块、视觉模块和移动终端,包括如下步骤:
步骤1:通过移动终端接收使用者操作;
步骤2:通过移动终端发送控制指令至蓝牙模块;
步骤3:通过蓝牙模块将控制信息发送至微控芯片;
步骤4:视觉模块采集激光信号并生成运动轨迹发送给微控芯片;
步骤5:微控芯片检测平衡车是否处于静止状态,若是,则通过六轴处理模块获取平衡车姿态角度偏差,然后根据PI算法确定风轮调整参数使得平衡车处于平衡状态;若不是,则通过六轴处理模块获取平衡车车体姿态的空间数据,然后根据PID算法确定直流电机驱动模块调整参数使得平衡车处于平衡状态并按照运动轨迹移动。
在本实施例中,所述六轴运动处理模块采用型号为MPU-6000(6050)六轴运动处理模块。
在本实施例中,所述蓝牙模块采用型号为CY-BT-04蓝牙模块,所述CY-BT-04蓝牙模块的芯片采用Blu eCore4-Ext芯片,遵循V2.1+EDR蓝牙规范,CY-BT-04蓝牙模块支持UART,USB,SPI,PCM,SPDIF接口,并支持SPP蓝牙串口协议。
在本实施例中,所述直流电机驱动模块采用型号为TB6612FNG直流电机驱动模块,采用大电流MOSFET-H桥结构,双通道电路输出,PWM支持频率高达100kHz,待机状态TB6612FNG直流电机驱动模块内置低压检测电路与热停机保护电路。
在本实施例中,所述微控芯片采用型号为STM32F系列中低端的32位ARM微控制器,其内核是Cortex-M3,该STM32FARM微控制器按片内Flash的大小可分为三大类:小容量(16K和32K)、中容量(64K和128K)、大容量(256K、384K和512K),程序存储器容量是64KB,电压2V~3.6V,工作温度为-40°C~85°C,数据转换器A/D10x12b,振荡器位于内部。
在本实施例中,所述视觉模块采用OpenMV摄像头,该OpenMV摄像头程序的编写通过高级语言Python脚本,可以完全控制OpenMV,包括IO引脚,Differencing帧差分算法,ColorTracking颜色追踪,MarkerTracking标记跟踪,OpticalFlow光流算法。
本实施例中,根据PI算法确定风轮调整参数使得平衡车处于平衡状态具体包括:六轴处理模块获取平衡车姿态角度以及速度信息,然后对姿态角度进行微分处理得到姿态角速度,对速度信息进行积分处理得到速度值,然后根据公式得到风轮调整参数a,其中k、p和d为角度调节参数,和为速度调节参数,为速度信息,B为姿态角度,为姿态角速度;
根据确定风轮调整参数对风轮的电机瞬间转动需要的电压值进行调整,风轮的电机在瞬时加速下带动风轮加速产生离心加速度将小车往反方向上施力使得平衡车处于平衡状态。
本实施例中,步骤5中根据PID算法确定直流电机驱动模块调整参数使得平衡车处于平衡状态具体包括:
51:比例参数相当于所述平衡车倒下的回复力,该参数要大于重力加速度,当逐步增大比例参数时,所述平衡车开始能够保持直立,微分参数相当于阻尼力,调节微分参数用于抑制车模的摆动;
52:调节比例参数P、微分参数D这两个参数时遵循先比例后微分的顺序,先调整比例参数使得所述追踪平衡车能够保持直立并且开始来回摆动,然后逐步增加微分参数,所述追踪平衡车逐步直立稳定,进一步增大微分参数直到两轮自平衡车开始共振,至此确定微分参数的最大值;
53.减小微分参数,然后逐步增大比例参数,直到所述平衡车又开始震荡,至此确定比例参数的最大值,根据调节的比例参数、微分参数最终输出直流电机模块电机速度调整参数值,具体地根据PID公式通过对平衡车速度以及姿态角度信息进行检测然后确定直流电机模块电机速度调整参数(如电机速度的电压值)使得直流电机模块电机瞬间加速从而产生一定反作用力使得其处于平衡状态从而控制平衡车处于平衡状态。
以上,由于直立平衡必然会影响到小车的前进,小车在直立控制的作用下,小车会前倾获取加速度,所以车轮会向后运动,这时小车的速度会被减慢,但是由于是负反馈作用,速度减慢之后,速度控制的偏差会增大,小车前倾的角度会增大,如此作用,小车便不能保持直立平衡,所以一般的单负反馈***在直立控制的影响下会起到正反馈的作用,所以不能采用一般的单负反馈***,要使用串级负反馈***,在串级负反馈***中,使用微分的效果不明显,所以这里采用的是PI算法控制,使得控制效果更好,且由于风轮的电机瞬间电压使得风轮产生瞬间加速从而产生李欣加速度将小车往反方向产生作用力从而处于平衡状态。
以上所述,仅为本发明进一步的实施例,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明所公开的范围内,根据本发明的技术方案及其构思加以等同替换或改变,都属于本发明的保护范围。
Claims (3)
1.一种激光追踪平衡车控制方法,其特征在于:追踪平衡车包括蓝牙模块、直流电机驱动模块、微控芯片、风轮模块、六轴运动处理模块、视觉模块和移动终端,方法包括如下步骤:
步骤1:通过移动终端接收使用者操作;
步骤2:通过移动终端发送控制指令至蓝牙模块;
步骤3:通过蓝牙模块将控制信息发送至微控芯片;
步骤4:视觉模块采集激光信号并生成运动轨迹发送给微控芯片;
步骤5:微控芯片检测平衡车是否处于静止状态,若是,则通过六轴处理模块获取平衡车姿态角度偏差,然后根据PI算法确定风轮调整参数使得平衡车处于平衡状态;若不是,则通过六轴处理模块获取平衡车车体姿态的空间数据,然后根据PID算法确定直流电机驱动模块调整参数使得平衡车处于平衡状态并按照运动轨迹移动。
3.根据权利要求1所述的一种激光追踪平衡车控制方法,其特征在于:步骤5中根据PID算法确定直流电机驱动模块调整参数使得平衡车处于平衡状态具体包括:
51:比例参数相当于所述平衡车倒下的回复力,该参数要大于重力加速度,当逐步增大比例参数时,所述平衡车开始能够保持直立,微分参数相当于阻尼力,调节微分参数用于抑制车模的摆动;
52:调节比例参数P、微分参数D这两个参数时遵循先比例后微分的顺序,先调整比例参数使得所述追踪平衡车能够保持直立并且开始来回摆动,然后逐步增加微分参数,所述追踪平衡车逐步直立稳定,进一步增大微分参数直到两轮自平衡车开始共振,至此确定微分参数的最大值;
减小微分参数,然后逐步增大比例参数,直到所述平衡车又开始震荡,至此确定比例参数的最大值,根据调节的比例参数、微分参数最终输出直流电机模块电机速度调整参数值。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911288253.2A CN110941280A (zh) | 2019-12-16 | 2019-12-16 | 一种激光追踪平衡车控制方法 |
PCT/CN2020/116240 WO2021120739A1 (zh) | 2019-12-16 | 2020-09-18 | 一种激光追踪平衡车控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911288253.2A CN110941280A (zh) | 2019-12-16 | 2019-12-16 | 一种激光追踪平衡车控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110941280A true CN110941280A (zh) | 2020-03-31 |
Family
ID=69911470
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911288253.2A Pending CN110941280A (zh) | 2019-12-16 | 2019-12-16 | 一种激光追踪平衡车控制方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110941280A (zh) |
WO (1) | WO2021120739A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021120739A1 (zh) * | 2019-12-16 | 2021-06-24 | 华南理工大学广州学院 | 一种激光追踪平衡车控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103010360A (zh) * | 2011-09-26 | 2013-04-03 | 东莞易步机器人有限公司 | 一种自平衡两轮车的运动控制方法 |
US20130310981A1 (en) * | 2012-05-15 | 2013-11-21 | Hyundai Motor Company | System and method of controlling ankles of walking robot |
CN105751230A (zh) * | 2016-03-31 | 2016-07-13 | 纳恩博(北京)科技有限公司 | 一种路径控制方法、路径规划方法、第一设备及第二设备 |
CN105807689A (zh) * | 2016-04-29 | 2016-07-27 | 上海海洋大学 | 一种两轮自平衡车控制*** |
CN206162197U (zh) * | 2016-10-31 | 2017-05-10 | 新疆大学 | 一种两轮自平衡蓝牙智能小车 |
CN109352658A (zh) * | 2018-12-04 | 2019-02-19 | 中冶赛迪工程技术股份有限公司 | 工业机器人定位操控方法、***及计算机可读存储介质 |
CN109507871A (zh) * | 2018-12-11 | 2019-03-22 | 广东工业大学 | 用于两轮平衡车车身平衡控制的pid参数整定方法及产品 |
CN110134136A (zh) * | 2019-05-29 | 2019-08-16 | 清华大学 | 无人驾驶摩托车视觉导航*** |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109955215B (zh) * | 2017-12-14 | 2021-04-20 | 河北汇金集团股份有限公司 | 两轮自平衡机器人用激光雷达自适应调整装置及调整方法 |
CN112292647A (zh) * | 2018-03-07 | 2021-01-29 | Lit汽车公司 | 使用控制力矩陀螺仪和线控驱动转向***来平衡两轮车的集成控制方法 |
CN110941281A (zh) * | 2019-12-16 | 2020-03-31 | 华南理工大学广州学院 | 一种激光追踪平衡车控制*** |
CN110764524A (zh) * | 2019-12-16 | 2020-02-07 | 华南理工大学广州学院 | 一种激光追踪平衡车控制电路 |
CN110941280A (zh) * | 2019-12-16 | 2020-03-31 | 华南理工大学广州学院 | 一种激光追踪平衡车控制方法 |
-
2019
- 2019-12-16 CN CN201911288253.2A patent/CN110941280A/zh active Pending
-
2020
- 2020-09-18 WO PCT/CN2020/116240 patent/WO2021120739A1/zh active Application Filing
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103010360A (zh) * | 2011-09-26 | 2013-04-03 | 东莞易步机器人有限公司 | 一种自平衡两轮车的运动控制方法 |
US20130310981A1 (en) * | 2012-05-15 | 2013-11-21 | Hyundai Motor Company | System and method of controlling ankles of walking robot |
CN105751230A (zh) * | 2016-03-31 | 2016-07-13 | 纳恩博(北京)科技有限公司 | 一种路径控制方法、路径规划方法、第一设备及第二设备 |
CN105807689A (zh) * | 2016-04-29 | 2016-07-27 | 上海海洋大学 | 一种两轮自平衡车控制*** |
CN206162197U (zh) * | 2016-10-31 | 2017-05-10 | 新疆大学 | 一种两轮自平衡蓝牙智能小车 |
CN109352658A (zh) * | 2018-12-04 | 2019-02-19 | 中冶赛迪工程技术股份有限公司 | 工业机器人定位操控方法、***及计算机可读存储介质 |
CN109507871A (zh) * | 2018-12-11 | 2019-03-22 | 广东工业大学 | 用于两轮平衡车车身平衡控制的pid参数整定方法及产品 |
CN110134136A (zh) * | 2019-05-29 | 2019-08-16 | 清华大学 | 无人驾驶摩托车视觉导航*** |
Non-Patent Citations (2)
Title |
---|
李亚文 等: "一种基于ARM-STM32的两轮自平衡小车的设计与实现", 《计算机与数字工程》 * |
谢成祥: "《自动控制原理》", 31 December 2018, 东南大学出版社 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021120739A1 (zh) * | 2019-12-16 | 2021-06-24 | 华南理工大学广州学院 | 一种激光追踪平衡车控制方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2021120739A1 (zh) | 2021-06-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107728635B (zh) | 一种摩托车型机器人的自动平衡装置及方法 | |
CN105353762B (zh) | 基于双余度姿态传感器的六旋翼无人机的控制方法 | |
WO2018176597A1 (zh) | 一种基于速率陀螺仪的无人自行车平衡控制方法 | |
CN106627894A (zh) | 一种纵向两轮自平衡机器人及控制*** | |
CN208654640U (zh) | 两轮平衡机器人控制*** | |
CN108488572A (zh) | 一种主动式防抖云台及其控制方法 | |
CN202548681U (zh) | 一种智能自稳定摄像***控制单元 | |
CN104908869A (zh) | 电动平衡车的电控*** | |
CN110109354A (zh) | 一种反作用轮平衡自行车机器人自适应滑模控制方法 | |
CN110941280A (zh) | 一种激光追踪平衡车控制方法 | |
Feng et al. | Modeling and implementation of two-wheel self-balancing robot equipped with supporting arms | |
CN110941281A (zh) | 一种激光追踪平衡车控制*** | |
CN107972036B (zh) | 基于TensorFlow的工业机器人动力学控制***及方法 | |
CN116069019A (zh) | 多功能智能平衡小车的控制***及其模糊自适应pid方法 | |
CN206664791U (zh) | 一种纵向两轮自平衡机器人及控制*** | |
CN104682789A (zh) | 一种应用于双轮机器人的pid 控制器 | |
CN105292344A (zh) | 一种基于陀螺仪稳定器的自平衡电动独轮车 | |
CN110109353B (zh) | 一种反作用轮平衡自行车机器人模糊自适应滑模控制*** | |
CN205098368U (zh) | 一种基于陀螺仪稳定器的自平衡电动独轮车 | |
CN110162068A (zh) | 一种自平衡机器人的控制方法 | |
Jie et al. | Design of upright intelligent vehicle based on camera | |
CN204674738U (zh) | 电动平衡车的电控*** | |
CN203443592U (zh) | 一种基于动态图像识别的车载人工智能*** | |
CN207860351U (zh) | 一种基于myRIO平台的自平衡小车控制*** | |
CN109835432A (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 |