CN103019093B - 两轮车用传感器融合角度的获得方法 - Google Patents
两轮车用传感器融合角度的获得方法 Download PDFInfo
- Publication number
- CN103019093B CN103019093B CN201110287318.9A CN201110287318A CN103019093B CN 103019093 B CN103019093 B CN 103019093B CN 201110287318 A CN201110287318 A CN 201110287318A CN 103019093 B CN103019093 B CN 103019093B
- Authority
- CN
- China
- Prior art keywords
- angle
- output
- value
- fusion
- wheeler
- 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.)
- Active
Links
Abstract
本发明公开了一种两轮车用传感器融合角度的获得方法,其包括两轮车上设置有作为零点电压的参考电源及模糊控制器,陀螺仪的输出电压及加速度传感器的输出电压与所述零点电压比较后产生差值通过内部模/数转换器读取后转化为数字量,然后将所得数据经利用kalman滤波器进行处理计算出输出的融合角度值,所述模糊控制器采集到输出的融合角度值并得到相应的估计值,kalman滤波器利用输出的融合角度值与相应估计值之差得到残差。所述模糊控制器模糊输入残差模值,进一步控制输出的融合角度值。本发明两轮车用传感器融合角度的获得方法利用kalman滤波器及kalman滤波器残差更为准确真实的计算出倒立摆偏转角度值。
Description
技术领域
本发明涉及一种信息处理领域,尤其是涉及一种两轮车用传感器融合角度的获得方法。
背景技术
陀螺仪技术经历了相当一段时间的发展,经典陀螺仪具有高速旋转的刚体转子,依靠自身的性能可以捕获自身的姿态。它最早是用于航海导航,后来在航空和航天事业中也得到广泛的应用。陀螺仪基本原理是运用物体高速旋转时,强大的角动量使旋转轴一直稳定指向一个方向的性质,所制造出来的定向仪器。
加速度传感器技术是惯性和力的检测综合体,目前在汽车电子和消费电子领域有较多的应用。加速度传感器通过实时采集运动件加速度信号,在器件处于相对稳定的状态下,通过分析传感器件自身重力加速度,得到目前器件的自身姿态。
但是在自平衡两轮车系统中,陀螺仪的输出是倒立摆偏转角速度信息,再计算出倒立摆的角度值;加速度传感器的输出是当前物体的加速度,再计算出倒立摆的偏转角。对于倒立摆偏转角确定而言,陀螺仪技术及加速度传感器技术都存在运动件自态与运动状态很难完全体现的不足。两轮车在自态不断变化的情况下,单独利用陀螺仪或加速度传感器进行偏转角确定存在真实性和稳定性问题。
发明内容
本发明是针对上述背景技术存在的缺陷提供一种两轮车用传感器融合角度的获得方法,使得倒立摆偏转角分析和处理的结果准确真实。
为实现上述目的,本发明公开了一种两轮车用传感器融合角度的获得方法,包括以下步骤:
(1)在两轮车上固定有陀螺仪和加速度传感器,两轮车上设置有参考电源,所述参考电源电压设定为零点电压;
(2)陀螺仪采集两轮车上角速度信号,加速度传感器采集两轮车上对应加速度信号;
(3)陀螺仪的输出电压及加速度传感器的输出电压通过与所述零点电压比较后产生差值,所述差值通过两轮车控制系统内部模/数转换器读取后转化为数字量,得到陀螺仪的输出与加速度传感器的输出;
(4)陀螺仪的输出通过积分处理可以计算出陀螺仪偏转角度,加速度传感器的输出通过与重力加速度的关系可计算出倒立摆偏转角,将所得数据经kalman滤波器进行处理计算出输出的融合角度值;
(5)所述两轮车控制系统内部设置有可对输出的融合角度值进行真实判断的模糊控制器,所述模糊控制器采集到输出的融合角度值并得到相应的估计值,kalman滤波器利用输出的融合角度值与相应估计值之差得到残差。所述模糊控制器模糊输入残差模值,进一步控制输出的融合角度值。
进一步地,所述陀螺仪及加速度传感器所采集的数据计算出融合角度值的公式是:
fused_angle=(1-kg)*(fused_angle+ anglerate *dt)+kg*A* arcsin(acc)
其中fused_angle为融合角度值的输出,anglerate为陀螺仪的输出,acc为加速度传感器的输出,A为系统参数, A* arcsin(acc)为倒立摆偏转角,kg为通过kalman滤波器计算出的调整因子;
进一步地,所述A取值为57.29。
综上所述,本发明两轮车用传感器融合角度的获得方法通过在两轮车上固定陀螺仪及加速度传感器,利用kalman滤波器将陀螺仪的输出数据和加速度传感器的输出数据进行融合,同时利用kalman滤波器残差更为准确真实的计算出倒立摆偏转角度值。
附图说明
图1为本发明模糊控制器及kalman滤波器算法步骤。
具体实施方式
为能进一步了解本发明的特征、技术手段以及所达到的具体目的、功能,下面结合附图与具体实施方式对本发明作进一步详细描述。
本发明两轮车用传感器融合角度的获得方法,通过如下步骤实现:
(1)在两轮车上固定有陀螺仪和加速度传感器,两轮车上设置有参考电源,所述参考电源电压设定为零点电压;
(2)陀螺仪采集两轮车上角速度信号,加速度传感器采集两轮车上对应加速度信号;
(3)陀螺仪的输出电压及加速度传感器的输出电压通过与所述零点电压比较后产生差值,所述差值通过两轮车控制系统内部模/数转换器(ADC)读取后转化为数字量,得到陀螺仪的输出anglerate与加速度传感器的输出acc。
(4)陀螺仪的输出anglerate通过积分处理可以计算出陀螺仪偏转角度gyro,进行必要的数据处理后,可以计算出陀螺仪偏转角度gyro:
gyro =anglerate*dt
当倒立摆静止时,其只受到重力加速度的影响,通过必要的数据处理后,可以计算出当前倒立摆的偏转角acc_angle:
acc_angle= A*arcsin(acc)
当倒立摆受到外力作用(如轮子)而具有X方向的加速度时,通过必要的数据处理后,可以计算出输出的融合角度值fused_angle:
fused_angle=(1-kg)*(fused_angle+ anglerate *dt)+kg*A* arcsin(acc)
其中A为系统参数,本实施例中其设定值为57.29,kg为调整因子,是通过kalman滤波器计算出的卡尔曼增益。
(5)所述两轮车控制系统内部设置有可对输出的融合角度值进行真实判断的模糊控制器,如图1所示,所述模糊控制器采集到输出的融合角度值并能精确、迅速地得到相应的估计值,kalman滤波器利用输出的融合角度值与相应估计值之差得到残差。所述模糊控制器基于残差将输出的融合角度值的异常数据进行处理,并调整相应估计值使得kalman滤波器输出残差趋近于零。所述残差模值越大,输出的融合角度值失真越严重。所述模糊控制器模糊输入残差模值,进而模糊调整kalman滤波器输出残差的方差,进一步控制输出的融合角度值。
综上所述,本发明两轮车用传感器融合角度的获得方法通过在两轮车上固定陀螺仪及加速度传感器,利用kalman滤波器将陀螺仪的输出数据和加速度传感器的输出数据进行融合,同时利用kalman滤波器残差更为准确真实的计算出倒立摆偏转角度值。
以上所述实施例仅表达了本发明的一种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明的保护范围应以所附权利要求为准。
Claims (2)
1.一种两轮车用传感器融合角度的获得方法,其特征在于,包括以下步骤:
(1)在两轮车上固定有陀螺仪和加速度传感器,两轮车上设置有参考电源,所述参考电源电压设定为零点电压;
(2)陀螺仪采集两轮车上角速度信号,加速度传感器采集两轮车上对应加速度信号;
(3)陀螺仪的输出电压及加速度传感器的输出电压通过与所述零点电压比较后产生差值,所述差值通过两轮车控制系统内部模/数转换器读取后转化为数字量,得到陀螺仪的输出与加速度传感器的输出;
(4)陀螺仪的输出通过积分处理可以计算出陀螺仪偏转角度,加速度传感器的输出通过与重力加速度的关系可计算出倒立摆偏转角,将所得数据经kalman滤波器进行处理计算出输出的融合角度值,所述融合角度值的计算公式是:
fused_angle=(1-kg)*(fused_angle+∫anglerate*dt)+kg*A*arcsin(acc)
其中fused_angle为融合角度值的输出,anglerate为陀螺仪的输出,acc为加速度传感器的输出,A为系统参数,A*arcsin(acc)为倒立摆偏转角,kg为通过kalman滤波器计算出的调整因子;
(5)所述两轮车控制系统内部设置有可对输出的融合角度值进行真实判断的模糊控制器,所述模糊控制器采集到输出的融合角度值并得到相应的估计值,kalman滤波器利用输出的融合角度值与相应估计值之差得到残差,所述模糊控制器模糊输入残差模值,进一步控制输出的融合角度值。
2.根据权利要求1所述的两轮车用传感器融合角度的获得方法,其特征在于:所述A取值为57.29。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110287318.9A CN103019093B (zh) | 2011-09-26 | 2011-09-26 | 两轮车用传感器融合角度的获得方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110287318.9A CN103019093B (zh) | 2011-09-26 | 2011-09-26 | 两轮车用传感器融合角度的获得方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103019093A CN103019093A (zh) | 2013-04-03 |
CN103019093B true CN103019093B (zh) | 2015-10-07 |
Family
ID=47967813
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110287318.9A Active CN103019093B (zh) | 2011-09-26 | 2011-09-26 | 两轮车用传感器融合角度的获得方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103019093B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103792946B (zh) * | 2014-02-14 | 2016-08-24 | 上海创绘机器人科技有限公司 | 运动型倒立摆系统控制的信号处理方法及智能自平衡车信号控制系统 |
CN103983996A (zh) * | 2014-05-09 | 2014-08-13 | 北京航空航天大学 | 一种抗gps野值的紧组合自适应滤波方法 |
CN104298113A (zh) * | 2014-10-22 | 2015-01-21 | 五邑大学 | 两轮机器人自适应模糊平衡控制器 |
CN107942676A (zh) * | 2017-12-14 | 2018-04-20 | 长春工业大学 | 一种采用模糊算法的平衡车控制方法 |
CN112874315B (zh) * | 2021-01-13 | 2022-11-04 | 深圳市奇虎智能科技有限公司 | 平衡车的运动控制方法、装置、设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4254465A (en) * | 1978-08-03 | 1981-03-03 | Dynamic Sciences International, Inc. | Strap-down attitude and heading reference system |
CN1664506A (zh) * | 2004-03-05 | 2005-09-07 | 清华大学 | 一种载体姿态测量方法及其系统 |
CN101100059A (zh) * | 2007-07-27 | 2008-01-09 | 北京工业大学 | 柔性两轮自平衡机器人的姿态检测方法 |
CN101823485A (zh) * | 2010-03-25 | 2010-09-08 | 武汉若比特机器人有限公司 | 一种轮式倒立摆的传感器处理与平衡控制算法 |
CN101846734A (zh) * | 2009-03-26 | 2010-09-29 | 中国农业大学 | 农用机械导航定位方法、系统及农用机械工控机 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100552688B1 (ko) * | 2003-09-08 | 2006-02-20 | 삼성전자주식회사 | 관성 항법 시스템의 자세 보상 방법 및 장치, 이를 이용한관성 항법 시스템의 위치 계산 방법 및 장치 |
-
2011
- 2011-09-26 CN CN201110287318.9A patent/CN103019093B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4254465A (en) * | 1978-08-03 | 1981-03-03 | Dynamic Sciences International, Inc. | Strap-down attitude and heading reference system |
CN1664506A (zh) * | 2004-03-05 | 2005-09-07 | 清华大学 | 一种载体姿态测量方法及其系统 |
CN101100059A (zh) * | 2007-07-27 | 2008-01-09 | 北京工业大学 | 柔性两轮自平衡机器人的姿态检测方法 |
CN101846734A (zh) * | 2009-03-26 | 2010-09-29 | 中国农业大学 | 农用机械导航定位方法、系统及农用机械工控机 |
CN101823485A (zh) * | 2010-03-25 | 2010-09-08 | 武汉若比特机器人有限公司 | 一种轮式倒立摆的传感器处理与平衡控制算法 |
Also Published As
Publication number | Publication date |
---|---|
CN103019093A (zh) | 2013-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105300379B (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 | |
CN101661048B (zh) | 速度计算装置、速度计算方法和导航装置 | |
US8649978B2 (en) | Velocity calculating device, velocity calculation method, and navigation device | |
CN103019093B (zh) | 两轮车用传感器融合角度的获得方法 | |
EP2517941B1 (en) | Roll angle estimation device and transport equipment | |
CN104898681B (zh) | 一种采用三阶近似毕卡四元数的四旋翼飞行器姿态获取方法 | |
US8473208B2 (en) | Velocity calculating device, velocity calculating method, and navigation device | |
CN105371846B (zh) | 载体姿态检测方法及其系统 | |
JP4854778B2 (ja) | 車両用推定航法装置、車両用推定航法及び車両用推定航法のプログラム | |
CN104515519A (zh) | 加速度、陀螺仪和磁场九轴传感器的空间轨迹定位系统 | |
CN202885834U (zh) | 车辆运动状态检测装置 | |
CN103712598A (zh) | 一种小型无人机姿态确定系统与确定方法 | |
CN107255474A (zh) | 一种融合电子罗盘和陀螺仪的pdr航向角确定方法 | |
CN102072729A (zh) | 用于测量旋转飞行器姿态的测量装置及其测量方法 | |
CN105680736A (zh) | 一种基于偏航角的双电机速度同步及平衡控制方法 | |
CN104682789A (zh) | 一种应用于双轮机器人的pid 控制器 | |
CN104748734B (zh) | 一种带倾角补偿的车载电子海拔罗盘仪 | |
CN111207758A (zh) | 一种基于加速度感应与磁感应的移动轨迹精确测量方法及其装置 | |
CN101619978B (zh) | 基于陀螺仪和加速度传感器的定位方法 | |
CN104515522A (zh) | 一种水下磁场及六轴惯性联合定位系统 | |
CN110954103B (zh) | 基于mems传感器的车体动态姿态估计的方法及系统 | |
CN110567456B (zh) | 基于抗差卡尔曼滤波的bds/ins组合列车定位方法 | |
EP3429910A1 (en) | Control of a two-wheeled self-balancing vehicle | |
CN110104102A (zh) | 自平衡自行车驱动车轮纵向滑移状态的估计方法 | |
CN101949702B (zh) | 使用mems加速度计的gnss pvt质量快速自检方法 |
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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20191225 Address after: 333124 Lin Hu Xiang Mu Li Xin Cun 110, Poyang County, Shangrao City, Jiangxi Province Patentee after: Zhang Mingming Address before: Science and technology Songshan Lake Science and Technology Industrial Park in Guangdong province Dongguan City nine road 523808 No. 1 Patentee before: Dongguan Robstep Robot Co., Ltd. |
|
TR01 | Transfer of patent right |