CN106323279A - 运动物体无线姿态监测系统 - Google Patents
运动物体无线姿态监测系统 Download PDFInfo
- Publication number
- CN106323279A CN106323279A CN201610674631.0A CN201610674631A CN106323279A CN 106323279 A CN106323279 A CN 106323279A CN 201610674631 A CN201610674631 A CN 201610674631A CN 106323279 A CN106323279 A CN 106323279A
- Authority
- CN
- China
- Prior art keywords
- module
- wireless
- moving object
- inertial sensor
- monitoring system
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供了一种运动物体无线姿态监测系统,包括电源模块、惯性传感器模块、单片机模块、无线通信模块、远程显示模块。惯性传感器模块的信号输出端与单片机模块相连,单片机模块将处理所得的数据通过无线通信模块输出至远程显示模块,使系统的姿态角度信息直接显示在远程终端。可同时显示系统的横滚角、俯仰角、偏航角,使用户能实时监测系统的运动情况,调整运行方案。本发明可以用于系统倾角的远程无线动态监测,具有连续监测、快速数据采集、实时显示、精度较高等优点。
Description
技术领域
本发明涉及传感器数据融合领域,具体地,涉及运动物体无线姿态监测系统。
背景技术
加速度计用于测量系统的加速度并具有较高的准确性和较快的响应速度,陀螺仪测量运动物体的角速率,但存在一定的零点漂移,在进行角度积分时容易造成较大的误差积累,而利用以卡尔曼滤波算法为核心的传感器信息融合技术可以对两种传感器的输出进行互补运算。这不仅利用了两个传感器相互协同操作的优势,而且也综合处理了信息源的数据来提高整个传感器系统的智能化,提高测量精度。在这个过程中,卡尔曼滤波算法能有效克服数据处理的误差和不稳定性对信息融合过程产生的影响。综合两种传感器的优势,实现在动态、静态时都能准确地测量物体姿态角的传感器。目前,国内对于传感器数据融合的研究较多,但都尚未形成系统。西南大学的冯智勇等在《西南师范大学学报(自然科学版)》,2011(4):137-141中研究了一种四旋翼飞行器的姿态信息测量系统,利用卡尔曼滤波法对加速度计与陀螺仪的输出进行了融合,获取了飞行器的姿态信息,但精度较低,且应用范围较窄。复旦大学的苏菲等在《太赫兹科学与电子信息学报》,2014(2):183-189中研究了用于船帆姿态信息测量的惯性传感系统,通过采用改进后的加权卡尔曼滤波算法进行传感器数据融合,获取了船帆的运动姿态信息,且精度达到了1°,但该系统无法进行远程监控。南京航空航天大学的余彦霖在《电子测量技术》,2015(05):106-110中进行了基于卡尔曼滤波的无人直升机姿态信息测量,采用自适应的卡尔曼滤波方法,得到了稳定可靠的姿态信息,精度为2.5°以内,达到了小成本的无人直升机应用要求。
本发明设计研制了一整套的运动物体姿态监测系统,通过研究改进的卡尔曼滤波算法用于对加速度计与陀螺仪的数据融合,获取的系统姿态信息精度高,可达到俯仰角、横滚角0.5°,偏航角1°,提高了运动物体姿态信息的动态精度,再通过无线传输方式将系统的姿态数据远程传输至显示设备,就可以实现对运动物体运动姿态的远程实时监测,摆脱了电缆线的束缚,使产品的应用领域更加广泛。本系统在工程机械、智能电网、现代化港口、航海测量、旋翼直升机、农业机械、机器人控制等领域具有很大的实用价值。
发明内容
针对现有技术中的缺陷,本发明的目的是提供一种运动物体无线姿态监测系统。本发明的目的在于利用传感器数据融合技术的容错性、互补性、实时性、经济性等优势,设计基于该技术的运动物体无线姿态监测系统。本发明设计了完整的应用框架,涉及电源模块、惯性传感器模块、单片机模块、无线通信模块以及远程显示模块五个部分。
根据本发明提供的一种运动物体无线姿态监测系统,包括电源模块、惯性传感器模块、单片机模块、无线通信模块、远程显示模块;
所述电源模块,是用于提供电能给惯性传感器模块、单片机模块、无线通信模块的直流电源;
所述惯性传感器模块,用于根据单片机模块发出的测量命令,测量加速度、角速率及地磁量作为采集数据;
所述单片机模块,用于测量初始化、发出测量命令、保存和读取采集数据、对采集数据进行数据融合得到姿态信息;
所述无线通信模块,用于同远程显示模块进行远程通信,实时输出姿态信息;
所述远程显示模块,用于实时显示姿态信息。
优选地,所述惯性传感器模块包括:
三轴加速度计模块,用于测量各向加速度;
三轴陀螺仪模块,用于测量各向角速率;
三轴磁感应模块,用于测量各向地磁量。
优选地,所述单片机模块包括:
参数初始化模块,用于初始化串口输入控制字,设置采集速度;
数据保存和读取模块,用于读取与保存惯性传感器模块传输来的加速度、角速率及地磁量;
数据融合模块,用于将数据保存和读取模块读取和保存的加速度、角速率及地磁量进行数据融合,得到姿态信息;
启动停止模块,用于控制测量的启动和停止。
优选地,数据融合模块利用改进卡尔曼滤波算法进行数据融合。
优选地,所述电源模块包括两级三路电源;
两级三路电源的第一级电路采用DC-DC变换器;
两级三路电源的第二级电路分为三路输出,其中,三路输出中的两路输出采用低压差稳压器给所述单片机模块及所述无线通信模块供电,三路输出中的另外一路输出采用电压基准源为所述惯性传感器模块供电,其中,所述惯性传感器模块向所述单片机模块传输采集数据。
优选地,所述姿态信息包括俯仰角、横滚角、偏航角。
与现有技术相比,本发明具有如下的有益效果:
1、本发明设计了完整的运动物体无线姿态监测系统,从电源模块到单片机模块均为独立设计,实现了传感器数据融合技术在运动物体无线姿态检测领域的实际应用;
2、本发明的电源模块包括两级三路电源,第一级电路采用DC-DC变换器,转换效率可达90%,提高了电源的利用率;第二级电路分为三路输出,其中两路输出采用低压差稳压器给处理器及无线发射电路供电,另外一路采用电压基准源为传感器及ADC转换供电,确保了系统电源的稳定性和可靠性,而且确保了每个模块的正常工作而不相互影响;
3、本发明通过传感器数据融合技术,对加速度计输出数据与陀螺仪输出数据进行了卡尔曼滤波算法或改进卡尔曼滤波算法融合,大大提高了运动物体姿态信息测量的动态精度,可达到俯仰精度0.5°、横滚精度0.5°、偏航精度1°,较同类产品动态精度更高,同时具有实时性、经济性等优势;
4、本发明通过无线通信模块,实现了单片机模块与远程显示设备的无线连接,实现了远程监测,使使用者能够快速获取运动物体的姿态信息从而进行后续的远程控制,监测快速、方便、可靠。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明传感器数据融合技术的运动物体无线姿态系统的系统框图;
图2为本发明传感器数据融合技术的运动物体无线姿态系统的惯性传感器模块框图;
图3为本发明传感器数据融合技术的运动物体无线姿态系统的单片机模块框图。
图中:
1、电源模块;2、惯性传感器模块;3、单片机模块;4、无线通信模块;5、远程显示模块;
201、三轴加速度计模块;202、三轴陀螺仪模块;203、三轴磁感应模块;
301、参数初始化模块;302、数据保存与读取模块;303、数据融合模块;304、启动停止模块。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
本发明涉及一种传感器数据融合的运动物体无线姿态监测系统,该系统可以用于系统倾角的远程无线动态监测。所述系统主要包括五个部分:电源模块、惯性传感器模块、单片机模块、无线通信模块和远程显示模块。所述惯性传感器模块的信号输出端与单片机模块相连,单片机模块将处理所得的数据通过无线通信模块输出至远程显示模块,使系统的姿态角度信息直接显示在远程终端。可同时显示系统的横滚角、俯仰角、偏航角,使用户能实时监测系统的运动情况,调整运行方案。本发明设计实现了基于加速度计与陀螺仪数据融合技术的运动物体无线姿态监测系统。具有连续监测、快速数据采集、实时显示、精度较高等优点。
根据本发明提供的一种运动物体无线姿态监测系统,包括电源模块、惯性传感器模块、单片机模块、无线通信模块、远程显示模块;所述电源模块,是用于提供电能给惯性传感器模块、单片机模块、无线通信模块的直流电源;所述惯性传感器模块,用于根据单片机模块发出的测量命令,测量加速度、角速率及地磁量作为采集数据;惯性传感器的型号可以是LSM9DS0;所述单片机模块,用于测量初始化、发出测量命令、保存和读取采集数据、对采集数据进行数据融合得到姿态信息;单片机模块的型号可以为STM32F302RC;所述无线通信模块,用于同远程显示模块进行远程通信,实时输出姿态信息,包括蓝牙、Zigbee或wifi;所述远程显示模块,用于实时显示姿态信息。
所述惯性传感器模块包括:
三轴加速度计模块,用于测量各向加速度;
三轴陀螺仪模块,用于测量各向角速率;
三轴磁感应模块,用于测量各向地磁量。
所述单片机模块包括:
参数初始化模块,用于初始化串口输入控制字,设置采集速度;
数据保存和读取模块,用于读取与保存惯性传感器模块传输来的加速度、角速率及地磁量;
数据融合模块,用于将数据保存和读取模块读取和保存的加速度、角速率及地磁量进行数据融合,得到姿态信息;
启动停止模块,用于控制测量的启动和停止。
数据融合模块利用改进卡尔曼滤波算法进行数据融合;所述姿态信息包括俯仰角、横滚角、偏航角。
所述电源模块包括两级三路电源;两级三路电源的第一级电路采用DC-DC变换器;两级三路电源的第二级电路分为三路输出,其中,三路输出中的两路输出采用低压差稳压器给所述单片机模块及所述无线通信模块供电,三路输出中的另外一路输出采用电压基准源为所述惯性传感器模块供电,其中,所述惯性传感器模块向所述单片机模块传输采集数据。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变化或修改,这并不影响本发明的实质内容。在不冲突的情况下,本申请的实施例和实施例中的特征可以任意相互组合。
Claims (6)
1.一种运动物体无线姿态监测系统,其特征在于,包括电源模块、惯性传感器模块、单片机模块、无线通信模块、远程显示模块;
所述电源模块,是用于提供电能给惯性传感器模块、单片机模块、无线通信模块的直流电源;
所述惯性传感器模块,用于根据单片机模块发出的测量命令,测量加速度、角速率及地磁量作为采集数据;
所述单片机模块,用于测量初始化、发出测量命令、保存和读取采集数据、对采集数据进行数据融合得到姿态信息;
所述无线通信模块,用于同远程显示模块进行远程通信,实时输出姿态信息;
所述远程显示模块,用于实时显示姿态信息。
2.根据权利要求1所述的运动物体无线姿态监测系统,其特征在于,所述惯性传感器模块包括:
三轴加速度计模块,用于测量各向加速度;
三轴陀螺仪模块,用于测量各向角速率;
三轴磁感应模块,用于测量各向地磁量。
3.根据权利要求1所述的运动物体无线姿态监测系统,其特征在于,所述单片机模块包括:
参数初始化模块,用于初始化串口输入控制字,设置采集速度;
数据保存和读取模块,用于读取与保存惯性传感器模块传输来的加速度、角速率及地磁量;
数据融合模块,用于将数据保存和读取模块读取和保存的加速度、角速率及地磁量进行数据融合,得到姿态信息;
启动停止模块,用于控制测量的启动和停止。
4.根据权利要求3所述的运动物体无线姿态监测系统,其特征在于,数据融合模块利用改进卡尔曼滤波算法进行数据融合。
5.根据权利要求1所述的运动物体无线姿态监测系统,其特征在于,所述电源模块包括两级三路电源;
两级三路电源的第一级电路采用DC-DC变换器;
两级三路电源的第二级电路分为三路输出,其中,三路输出中的两路输出采用低压差稳压器给所述单片机模块及所述无线通信模块供电,三路输出中的另外一路输出采用电压基准源为所述惯性传感器模块供电,其中,所述惯性传感器模块向所述单片机模块传输采集数据。
6.根据权利要求1所述的运动物体无线姿态监测系统,其特征在于,所述姿态信息包括俯仰角、横滚角、偏航角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610674631.0A CN106323279A (zh) | 2016-08-16 | 2016-08-16 | 运动物体无线姿态监测系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610674631.0A CN106323279A (zh) | 2016-08-16 | 2016-08-16 | 运动物体无线姿态监测系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106323279A true CN106323279A (zh) | 2017-01-11 |
Family
ID=57739969
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610674631.0A Pending CN106323279A (zh) | 2016-08-16 | 2016-08-16 | 运动物体无线姿态监测系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106323279A (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108279593A (zh) * | 2018-01-16 | 2018-07-13 | 厦门大学 | 一种大型工程机械的位姿实时显示系统及方法 |
CN109530923A (zh) * | 2019-01-03 | 2019-03-29 | 国网山东省电力公司平邑县供电公司 | 激光除异物装置的激光头角度控制装置及激光除异物装置 |
CN111561926A (zh) * | 2020-06-04 | 2020-08-21 | 成都亿佰特电子科技有限公司 | 一种便携式姿态检测装置及物品姿态检测方法 |
CN112130580A (zh) * | 2020-11-22 | 2020-12-25 | 西北农林科技大学 | 基于LabVIEW的果园机器人姿态监控系统可视化方法 |
CN112284355A (zh) * | 2020-09-14 | 2021-01-29 | 北京致感致联科技有限公司 | 一种无源压电传感器及监测系统 |
CN112294347A (zh) * | 2020-09-16 | 2021-02-02 | 康达洲际医疗器械有限公司 | 一种c形臂x射线机位置检测系统 |
CN113607127A (zh) * | 2021-10-08 | 2021-11-05 | 中交第一公路勘察设计研究院有限公司 | 公路用雷视一体机安装装置、使用方法及组网安装方法 |
CN113607165A (zh) * | 2021-08-12 | 2021-11-05 | 长沙万英科技发展有限公司 | 一种姿态测量系统 |
CN114137880A (zh) * | 2021-11-30 | 2022-03-04 | 重庆长安新能源汽车科技有限公司 | 运动部件姿态测试系统 |
CN115218929A (zh) * | 2022-09-20 | 2022-10-21 | 河北美泰电子科技有限公司 | 一种惯性传感器标测装置及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102973249A (zh) * | 2012-10-31 | 2013-03-20 | 上海交通大学无锡研究院 | 一种牛只体征监测系统 |
CN103057712A (zh) * | 2012-12-31 | 2013-04-24 | 北京航空航天大学 | 微小型飞行机器人集成飞行控制系统 |
CN103267527A (zh) * | 2013-06-08 | 2013-08-28 | 重庆绿色智能技术研究院 | 一种实现杆塔稳固性监测和预警的系统及方法 |
CN104182614A (zh) * | 2014-07-25 | 2014-12-03 | 山东建筑大学 | 六自由度机械臂姿态监测系统及方法 |
CN105490383A (zh) * | 2015-12-09 | 2016-04-13 | 武汉龙安集团有限责任公司 | 基于现场总线管理的分布式供配电系统 |
-
2016
- 2016-08-16 CN CN201610674631.0A patent/CN106323279A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102973249A (zh) * | 2012-10-31 | 2013-03-20 | 上海交通大学无锡研究院 | 一种牛只体征监测系统 |
CN103057712A (zh) * | 2012-12-31 | 2013-04-24 | 北京航空航天大学 | 微小型飞行机器人集成飞行控制系统 |
CN103267527A (zh) * | 2013-06-08 | 2013-08-28 | 重庆绿色智能技术研究院 | 一种实现杆塔稳固性监测和预警的系统及方法 |
CN104182614A (zh) * | 2014-07-25 | 2014-12-03 | 山东建筑大学 | 六自由度机械臂姿态监测系统及方法 |
CN105490383A (zh) * | 2015-12-09 | 2016-04-13 | 武汉龙安集团有限责任公司 | 基于现场总线管理的分布式供配电系统 |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108279593A (zh) * | 2018-01-16 | 2018-07-13 | 厦门大学 | 一种大型工程机械的位姿实时显示系统及方法 |
CN109530923A (zh) * | 2019-01-03 | 2019-03-29 | 国网山东省电力公司平邑县供电公司 | 激光除异物装置的激光头角度控制装置及激光除异物装置 |
CN111561926A (zh) * | 2020-06-04 | 2020-08-21 | 成都亿佰特电子科技有限公司 | 一种便携式姿态检测装置及物品姿态检测方法 |
CN112284355B (zh) * | 2020-09-14 | 2022-07-26 | 北京致感致联科技有限公司 | 一种无源压电传感器及监测系统 |
CN112284355A (zh) * | 2020-09-14 | 2021-01-29 | 北京致感致联科技有限公司 | 一种无源压电传感器及监测系统 |
CN112294347A (zh) * | 2020-09-16 | 2021-02-02 | 康达洲际医疗器械有限公司 | 一种c形臂x射线机位置检测系统 |
CN112130580A (zh) * | 2020-11-22 | 2020-12-25 | 西北农林科技大学 | 基于LabVIEW的果园机器人姿态监控系统可视化方法 |
CN113607165A (zh) * | 2021-08-12 | 2021-11-05 | 长沙万英科技发展有限公司 | 一种姿态测量系统 |
CN113607165B (zh) * | 2021-08-12 | 2024-04-16 | 长沙万英科技发展有限公司 | 一种姿态测量系统 |
CN113607127A (zh) * | 2021-10-08 | 2021-11-05 | 中交第一公路勘察设计研究院有限公司 | 公路用雷视一体机安装装置、使用方法及组网安装方法 |
CN113607127B (zh) * | 2021-10-08 | 2022-01-25 | 中交第一公路勘察设计研究院有限公司 | 公路用雷视一体机安装装置、使用方法及组网安装方法 |
CN114137880A (zh) * | 2021-11-30 | 2022-03-04 | 重庆长安新能源汽车科技有限公司 | 运动部件姿态测试系统 |
CN114137880B (zh) * | 2021-11-30 | 2024-02-02 | 深蓝汽车科技有限公司 | 运动部件姿态测试系统 |
CN115218929A (zh) * | 2022-09-20 | 2022-10-21 | 河北美泰电子科技有限公司 | 一种惯性传感器标测装置及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106323279A (zh) | 运动物体无线姿态监测系统 | |
CN104898828B (zh) | 应用体感交互系统的体感交互方法 | |
CN103267524B (zh) | 一种穿戴式的人员步态检测室内定位系统及方法 | |
CN208383180U (zh) | 一种基于无人机性能监测的数据采集系统及无人飞行器 | |
CN104898829A (zh) | 体感交互系统 | |
CN105850773A (zh) | 一种基于微惯性传感器的生猪姿态监测装置及方法 | |
CN103598888B (zh) | 一种穿戴式人体运动状态数据监测系统及方法 | |
CN203982176U (zh) | 基于Cortex-M3无人机智能控制系统 | |
CN102830708A (zh) | 基于arm和fpga架构的固定翼无人机自动驾驶仪 | |
CN103529465A (zh) | 室内外人员无缝定位装置 | |
CN109471433A (zh) | 一种基于偏振罗盘的航向与姿态参考系统 | |
CN104898827A (zh) | 应用体感交互系统的体感交互方法 | |
CN104866789A (zh) | 利用体感控制装置防止智能电子设备丢失的警示方法 | |
CN107990871A (zh) | 一种基于多传感信息融合的相对位姿测量装置与方法 | |
CN110567493B (zh) | 一种磁力计校准数据采集方法、装置以及飞行器 | |
CN203467698U (zh) | 一种多参数多传感的智能服装 | |
CN109782782A (zh) | 多旋翼无人机飞行姿态控制系统 | |
CN205827677U (zh) | 一种基于物联网的新型车辆检测装置 | |
CN106919106A (zh) | 船舶运动姿态数据采集装置及传输方法 | |
CN207623749U (zh) | 一种变压器内部检测机器人控制系统 | |
CN107479537A (zh) | 用于机器人控制器设计的控制性能评估系统及其使用流程 | |
CN207601974U (zh) | 一种具有安全防盗功能的定型机 | |
CN206270980U (zh) | 一种用于手势识别的动作捕捉手套 | |
CN104848852B (zh) | 一种环形传感阵列的定位系统和方法 | |
CN202008367U (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170111 |