CN103591925A - 基于三轴加速度传感器的移动平台旋转角度测量方法 - Google Patents
基于三轴加速度传感器的移动平台旋转角度测量方法 Download PDFInfo
- Publication number
- CN103591925A CN103591925A CN201310610615.1A CN201310610615A CN103591925A CN 103591925 A CN103591925 A CN 103591925A CN 201310610615 A CN201310610615 A CN 201310610615A CN 103591925 A CN103591925 A CN 103591925A
- Authority
- CN
- China
- Prior art keywords
- acceleration sensor
- axis acceleration
- accekeration
- axis
- mobile platform
- 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
Links
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于三轴加速度传感器的移动平台旋转角度测量方法;固定周期Δt读取三轴加速度传感器的值数据;第一步:根据加速度值ax(k)和加速度值ay(k),计算加速度值a(k);第二步:根据x加速度值ax(k)、加速度值ay(k)以及加速度值a(k),计算加速度的角度值θ(k);第三步:根据角度值θ(k)以及三轴加速度传感器距离左驱动轮和右驱动轮的轴线的距离L计算三轴加速度传感器的旋转半径R;第四步:根据三轴加速度传感器的旋转半径R和加速度值a(k)计算三轴加速度传感器的旋转角速度ω(k);第五步:根据三轴加速度传感器的旋转角速度ω(k)计算三轴加速度传感器的旋转角度β(k)。
Description
技术领域
本发明涉及传感器与测量领域,尤其是一种基于三轴加速度传感器的移动平台旋转角度测量方法。
背景技术
在描述移动平台位置的时候,需要三个参数进行描述,一个是x轴坐标,一个是y轴坐标,还有就是绕z轴的旋转角度。为了计算x轴坐标和y轴坐标,可安装三轴加速度传感器。加速度传感器测量x轴和y轴方向上的加速度,然后进行积分求得检测周期内x轴和y轴方向上的位移量,然后累计得到x轴坐标值和y轴坐标值。但是旋转角度的测量需要增加专业的角度传感器,这必然会增加系统成本以及系统的复杂度。因此,利用现有的三轴加速度传感器进行旋转角度测量,具有显著的实际应用意义。
发明内容
本发明要解决的技术问题是提供一种简单的基于三轴加速度传感器的移动平台旋转角度测量方法。
为了解决上述技术问题,本发明提供一种基于三轴加速度传感器的移动平台旋转角度测量方法,包括移动平台,所述移动平台上设置有进行运动方向和速度驱动的左驱动轮和右驱动轮,对移动平台起到支撑作用的万向轮,以及用来采集加速度值的三轴加速度传感器;其特征是:每隔固定周期Δt,读取三轴加速度传感器采集的加速度值数据,所述加速度值数据包括移动平台在x轴方向上的加速度值ax(k)和移动平台在y轴方向上的加速度值ay(k);再根据以上所述的加速度值ax(k)和加速度值ay(k)进行如下的计算:第一步:根据x轴方向上的加速度值ax(k)和y轴方向上的加速度值ay(k),计算加速度值a(k);第二步:根据x轴方向上的加速度值ax(k)、y轴方向上的加速度值ay(k)以及加速度值a(k),计算加速度的角度值θ(k);第三步:根据角度值θ(k)以及三轴加速度传感器距离左驱动轮和右驱动轮的轴线的距离L计算三轴加速度传感器的旋转半径R;第四步:根据三轴加速度传感器的旋转半径R和加速度值a(k)计算三轴加速度传感器的旋转角速度ω(k);第五步:根据三轴加速度传感器的旋转角速度ω(k)计算三轴加速度传感器的旋转角度β(k)。
作为对本发明所述的基于三轴加速度传感器的移动平台旋转角度测量方法的改进:所述加速度值a(k)的计算遵循三角形法则数学关系,由三角形计算法则得出
作为对本发明所述的基于三轴加速度传感器的移动平台旋转角度测量方法的进一步改进:所述加速度的角度值θ(k)的计算遵循三角形法则数学关系,由三角函数计算法则得出 再反解后得出
作为对本发明所述的基于三轴加速度传感器的移动平台旋转角度测量方法的进一步改进:所述三轴加速度传感器的旋转半径R的计算通过如下步骤获得:根据对三轴加速度传感器以及左驱动轮和右驱动轮之间的轴线进行测量后获得距离L;再根据三轴加速度传感器的旋转半径R和距离L的三角余弦关系得出
作为对本发明所述的基于三轴加速度传感器的移动平台旋转角度测量方法的进一步改进:所述移动平台的旋转角速度ω(k)的计算通过如下步骤获得:根据向心加速度的公式得出a(k)=R*ω(k)2,得到
作为对本发明所述的基于三轴加速度传感器的移动平台旋转角度测量方法的进一步改进:所述三轴加速度传感器的旋转角度β(k)为积累量,根据所述的固定周期Δt得出β(k)=β(k-1)+ω(k)*Δt。
本发明的基于三轴加速度传感器的移动平台旋转角度测量方法中,直接采用现有的三轴加速度传感器进行旋转角度测量,在进行移动平台旋转角度测量的时候,只需要使用三轴加速度传感器就可以,无需再使用额外的角度传感器进行测量,在不增加硬件的基础上,极大的节省了测量设备的成本。
再一个,由于本发明中的基于三轴加速度传感器的移动平台旋转角度测量方法大量的采用了简单的数学方式进行测量,在不进行复杂计算的基础上,极大的提高了数据的准确性,而本发明中的方法所使用的算法中,仅仅采用三轴加速度传感器采集,极大的降低了多传感器采集数据中容易出现的误差。
附图说明
下面结合附图对本发明的具体实施方式作进一步详细说明。
图1是本发明的移动平台5配置结构示意图;
图2是旋转角度β(k)的测量推导示意图。
具体实施方式
实施例1、图1~图2给出了一种基于三轴加速度传感器的移动平台旋转角度测量方法,包括移动平台5,移动平台5上设置有进行运动方向和速度驱动的左驱动轮1和右驱动轮2,对移动平台5起到支撑作用的万向轮3,以及用来采集加速度值的三轴加速度传感器4;具体的使用的时候,在移动平台5上设置专门用来计算的电子控制装置进行集中的控制,而电子控制装置分别与左驱动轮1、右驱动轮2和三轴加速度传感器4信号连接;通过电子控制装置对左驱动轮1和右驱动轮2进行行程控制,即可以对左驱动轮1和右驱动轮2的行动方向和左驱动轮1和右驱动轮2的加速度等进行控制;而通过电子控制装置还可以对三轴加速度传感器4获取的数据进行定时的读取,并对读取的数据进行相应的分析计算,得出移动平台5的旋转角度。以上所述的电子控制装置根据其性能,可以在市场上购买获得。
本发明的基于三轴加速度传感器的移动平台旋转角度测量方法主要如下:
1、每隔固定周期Δt,读取三轴加速度传感器4采集的加速度值数据;在本实施例中,通过在电子控制装置内设置定时读取的命令,而定时的固定周期为Δt;
2、如图1所示,通过电子控制装置控制左驱动轮1和右驱动轮2活动,最终得出移动平台5在x轴方向上的加速度值ax(k)和移动平台5在y轴方向上的加速度值ay(k);
3、根据x轴方向上的加速度值ax(k)和y轴方向上的加速度值ay(k),计算加速度值a(k);加速度值a(k)的计算遵循三角形法则数学关系,由三角形计算法则(具体为勾股定理)得出
4、根据x轴方向上的加速度值ax(k)、y轴方向上的加速度值ay(k)以及加速度值a(k),计算加速度的角度值θ(k);加速度的角度值θ(k)的计算遵循三角形法则数学关系,由三角函数计算法则得出 再反解后得出
5、根据角度值θ(k)以及三轴加速度传感器4跟左驱动轮1和右驱动轮2的轴线的距离L计算三轴加速度传感器4的旋转半径R;加速度传感器4的旋转半径R的计算通过如下步骤获得:
根据对三轴加速度传感器4以及左驱动轮1和右驱动轮2之间的轴线进行测量后获得距离L,由于三轴加速度传感器4以及左驱动轮1和右驱动轮2均为固定在移动平台5上的设置,所以三轴加速度传感器4以及左驱动轮1和右驱动轮2之间的轴线进行测量后获得的距离L的值为恒定值(且为已知量);再根据三轴加速度传感器4的旋转半径R和距离L的三角余弦关系得出
6、根据三轴加速度传感器4的旋转半径R和加速度值a(k)计算三轴加速度传感器4的旋转角速度ω(k);根据向心加速度的公式得出a(k)=R*ω(k)2,继而,根据以上步骤中计算所得到的数据进行计算,就可以得出
7、根据三轴加速度传感器4的旋转角速度ω(k)计算三轴加速度传感器4的旋转角度β(k);由于旋转角度是一个积累量,而根据本发明中采用固定周期Δt,则可以进行如下的计算:β(k)=β(k-1)+ω(k)*Δt。
8、由于三轴加速度传感器4设置在移动平台5上,所以最后得出的三轴加速度传感器4的旋转角度β(k)同样适用于移动平台5的旋转角度。
以上所述中,由于三轴加速度传感器4、左驱动轮1和右驱动轮2在移动平台5上均为刚性设置,所以三轴加速度传感器4跟左驱动轮1和右驱动轮2的轴线的距离L为定值,继而在计算出加速度的角度值θ(k)后,就可以根据三角形的定律,将L代入后计算R的值。
最后,还需要注意的是,以上列举的仅是本发明的一个具体实施例。显然,本发明不限于以上实施例,还可以有许多变形。本领域的普通技术人员能从本发明公开的内容直接导出或联想到的所有变形,均应认为是本发明的保护范围。
Claims (6)
1.基于三轴加速度传感器的移动平台旋转角度测量方法,包括移动平台(5),所述移动平台(5)上设置有进行运动方向和速度驱动的左驱动轮(1)和右驱动轮(2),对移动平台(5)起到支撑作用的万向轮(3),以及用来采集加速度值的三轴加速度传感器(4);其特征是:每隔固定周期Δt,读取三轴加速度传感器(4)采集的加速度值数据,所述加速度值数据包括移动平台(5)在x轴方向上的加速度值ax(k)和移动平台(5)在y轴方向上的加速度值ay(k);
再根据以上所述的加速度值ax(k)和加速度值ay(k)进行如下的计算:
第一步:根据x轴方向上的加速度值ax(k)和y轴方向上的加速度值ay(k),计算加速度值a(k);
第二步:根据x轴方向上的加速度值ax(k)、y轴方向上的加速度值ay(k)以及加速度值a(k),计算加速度的角度值θ(k);
第三步:根据角度值θ(k)以及三轴加速度传感器(4)距离左驱动轮(1)和右驱动轮(2)的轴线的距离L计算三轴加速度传感器(4)的旋转半径R;
第四步:根据三轴加速度传感器(4)的旋转半径R和加速度值a(k)计算三轴加速度传感器(4)的旋转角速度ω(k);
第五步:根据三轴加速度传感器(4)的旋转角速度ω(k)计算三轴加速度传感器(4)的旋转角度β(k)。
2.根据权利要求1所述的基于三轴加速度传感器的移动平台旋转角度测量方法,其特征是:所述加速度值a(k)的计算遵循三角形法则数学关系,由三角形计算法则得出
3.根据权利要求2所述的基于三轴加速度传感器的移动平台旋转角度测量方法,其特征是:所述加速度的角度值θ(k)的计算遵循三角形法则数学关系,由三角函数计算法则得出 再反解后得出
4.根据权利要求3所述的基于三轴加速度传感器的移动平台旋转角度测量方法,其特征是:所述三轴加速度传感器(4)的旋转半径R的计算通过如下步骤获得:
根据对三轴加速度传感器(4)以及左驱动轮(1)和右驱动轮(2)之间的轴线进行测量后获得距离L;
再根据三轴加速度传感器(4)的旋转半径R和距离L的三角余弦关系得出
5.根据权利要求4所述的基于三轴加速度传感器的移动平台旋转角度测量方法,其特征是:所述移动平台(5)的旋转角速度ω(k)的计算通过如下步骤获得:根据向心加速度的公式得出a(k)=R*ω(k)2,得到
6.根据权利要求5所述的基于三轴加速度传感器的移动平台旋转角度测量方法,其特征是:所述三轴加速度传感器(4)的旋转角度β(k)为积累量,根据所述的固定周期Δt得出β(k)=β(k-1)+ω(k)*Δt。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310610615.1A CN103591925B (zh) | 2013-11-26 | 2013-11-26 | 基于三轴加速度传感器的移动平台旋转角度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310610615.1A CN103591925B (zh) | 2013-11-26 | 2013-11-26 | 基于三轴加速度传感器的移动平台旋转角度测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103591925A true CN103591925A (zh) | 2014-02-19 |
CN103591925B CN103591925B (zh) | 2016-01-20 |
Family
ID=50082157
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310610615.1A Expired - Fee Related CN103591925B (zh) | 2013-11-26 | 2013-11-26 | 基于三轴加速度传感器的移动平台旋转角度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103591925B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017177582A1 (zh) * | 2016-04-11 | 2017-10-19 | 深圳市酷浪云计算有限公司 | 实现运动设备速度测量的方法和装置 |
CN110701640A (zh) * | 2019-10-16 | 2020-01-17 | 杨梅 | 智能旋钮及其开关状态获取方法 |
CN114834851A (zh) * | 2022-04-12 | 2022-08-02 | 三一重工股份有限公司 | 确定回转角度的方法、装置、可读存储介质和抓料机 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4592233A (en) * | 1983-09-02 | 1986-06-03 | Sundstrand Data Control, Inc. | Angular base sensor utilizing parallel vibrating accelerometers |
US5493909A (en) * | 1991-01-30 | 1996-02-27 | Mitsubishi Denki Kabushiki Kaisha | Method of and an apparatus for detecting control information |
CN1781660A (zh) * | 2004-11-30 | 2006-06-07 | 发那科株式会社 | 旋转轴控制装置 |
CN103383254A (zh) * | 2013-07-09 | 2013-11-06 | 中国人民解放军63698部队 | 船摇倾角测量仪 |
CN103389389A (zh) * | 2013-08-28 | 2013-11-13 | 魏巍 | 重力式流速传感器及明渠流速流量监测装置 |
-
2013
- 2013-11-26 CN CN201310610615.1A patent/CN103591925B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4592233A (en) * | 1983-09-02 | 1986-06-03 | Sundstrand Data Control, Inc. | Angular base sensor utilizing parallel vibrating accelerometers |
US5493909A (en) * | 1991-01-30 | 1996-02-27 | Mitsubishi Denki Kabushiki Kaisha | Method of and an apparatus for detecting control information |
CN1781660A (zh) * | 2004-11-30 | 2006-06-07 | 发那科株式会社 | 旋转轴控制装置 |
CN103383254A (zh) * | 2013-07-09 | 2013-11-06 | 中国人民解放军63698部队 | 船摇倾角测量仪 |
CN103389389A (zh) * | 2013-08-28 | 2013-11-13 | 魏巍 | 重力式流速传感器及明渠流速流量监测装置 |
Non-Patent Citations (3)
Title |
---|
侯文生等: "基于加速度传感器的前臂运动姿态检测", 《传感器与微系统》 * |
李文锋等: "基于加速度传感器的人体姿态跟踪角度算法", 《湖北工业大学学报》 * |
李智等: "一种基于三轴加速度传感器的倾角测量装置", 《仪表技术与传感器》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017177582A1 (zh) * | 2016-04-11 | 2017-10-19 | 深圳市酷浪云计算有限公司 | 实现运动设备速度测量的方法和装置 |
US10363471B2 (en) | 2016-04-11 | 2019-07-30 | Shenzhen Coollang Cloud Computing Co., Ltd | Method and device for measuring speed of moving device |
CN110701640A (zh) * | 2019-10-16 | 2020-01-17 | 杨梅 | 智能旋钮及其开关状态获取方法 |
CN110701640B (zh) * | 2019-10-16 | 2021-06-15 | 杨梅 | 智能旋钮及其开关状态获取方法 |
CN114834851A (zh) * | 2022-04-12 | 2022-08-02 | 三一重工股份有限公司 | 确定回转角度的方法、装置、可读存储介质和抓料机 |
Also Published As
Publication number | Publication date |
---|---|
CN103591925B (zh) | 2016-01-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102279084B (zh) | 基于微惯性测量组合的输电导线舞动定位方法 | |
CN110986988B (zh) | 融合多传感器数据的轨迹推算方法、介质、终端和装置 | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
CN103606206B (zh) | 一种使用汽车行驶状态感知装置的汽车行驶状态感知方法 | |
CN105371846A (zh) | 载体姿态检测方法及其系统 | |
CN102878989A (zh) | 一种利用星载线加速度计进行三轴角振动测量的方法 | |
CN103591925B (zh) | 基于三轴加速度传感器的移动平台旋转角度测量方法 | |
CN104197935A (zh) | 一种基于移动智能终端的室内定位方法 | |
CN103900566A (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 | |
CN106370178A (zh) | 移动终端设备的姿态测量方法及装置 | |
CN103033197B (zh) | 一种mems陀螺零位漂移的校正方法 | |
CN103115596B (zh) | 用于位移测量的无线传感器网络节点及测试方法 | |
CN103076023A (zh) | 一种步长计算方法和装置 | |
CN103412136B (zh) | 一种车辆横摆角速度测量方法 | |
CN102706310A (zh) | 一种臂架夹角检测方法、装置及带此装置的泵车 | |
CN203479311U (zh) | 一种车载组合导航设备 | |
CN103792382A (zh) | 转速测量的方法及装置 | |
CN105303201A (zh) | 一种基于动作感应进行手写识别的方法和系统 | |
CN104101345A (zh) | 基于互补重构技术的多传感器姿态融合方法 | |
CN103292810A (zh) | 一种旋转式惯导系统信号同步补偿方法 | |
CN104180807B (zh) | 一种组合导航系统的高精度定姿方法 | |
CN103673983B (zh) | 一种隧道三维线形测量系统及其测量方法 | |
CN204188173U (zh) | 一种姿态陀螺仪倾斜补偿四元数解算装置 | |
CN102519457B (zh) | 基于角速度的欧拉角傅里埃近似输出方法 | |
CN203464937U (zh) | 一种用于小型无人直升机的姿态航向参考系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160120 Termination date: 20161126 |
|
CF01 | Termination of patent right due to non-payment of annual fee |