CN107883953A - Vr手柄静态检测算法、vr手柄及存储介质 - Google Patents

Vr手柄静态检测算法、vr手柄及存储介质 Download PDF

Info

Publication number
CN107883953A
CN107883953A CN201710884572.4A CN201710884572A CN107883953A CN 107883953 A CN107883953 A CN 107883953A CN 201710884572 A CN201710884572 A CN 201710884572A CN 107883953 A CN107883953 A CN 107883953A
Authority
CN
China
Prior art keywords
acceleration
magnetometer
acc
input value
handles
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
CN201710884572.4A
Other languages
English (en)
Other versions
CN107883953B (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 New Dimension Sense Information Technology Co Ltd
Original Assignee
Guangzhou New Dimension Sense Information 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 Guangzhou New Dimension Sense Information Technology Co Ltd filed Critical Guangzhou New Dimension Sense Information Technology Co Ltd
Priority to CN201710884572.4A priority Critical patent/CN107883953B/zh
Publication of CN107883953A publication Critical patent/CN107883953A/zh
Application granted granted Critical
Publication of CN107883953B publication Critical patent/CN107883953B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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
    • G01C21/165Navigation; 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 combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F3/00Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
    • G06F3/01Input arrangements or combined input and output arrangements for interaction between user and computer
    • G06F3/017Gesture based interaction, e.g. based on a set of recognized hand gestures

Abstract

本发明公开了VR手柄静态检测算法,包括如下步骤:将加速度和磁力计分别进行标定以得到初始姿态信息,对标定后的加速度和磁力计进行处理分别得到对应的参数,对这两个参数进行计算获取当前静止状态。本发明基于加速度和磁力计一阶微分值,判断当前手柄的移动状态,可以很好的识别手势是否运动,同时结合姿态初始化算法,能够实时对手柄姿态进行矫正,补充陀螺仪带来的手柄漂移问题。

Description

VR手柄静态检测算法、VR手柄及存储介质
技术领域
本发明涉及一种VR手柄静态检测算法、VR手柄及存储介质。
背景技术
目前,市面上普通的VR手柄设备的初始姿态一般采用(w,x,y,z)=(1,0,0,0)作为初始化姿态,用欧拉角表示为(yaw,pitch,roll)=[0,0,0],这种姿态初始化值,是继承于普通AHRS或IMU设备算法,通过一点时间的收敛可以到达一个稳定状态。传统方法对于传统产品,如无人机不存在任何问题,但是对于VR手柄来讲,初始化姿态漂移会导致在收敛过程中一直存在漂移。
但是,现有的技术存在以下缺陷:
(1)如果采用高灵敏算法去克服手柄姿态漂移的问题,又会导致在静止时刻存在数据抖动的问题,如果采用低灵敏度算法,那运动过程中会存在较大陀螺仪累积误差问题。,对于VR手柄九轴算法要想获得高精准度必须提高算法那灵敏度,否则用户体验较差,由于人体手持设备静止,不是完全静止,而是存在一定抖动情况。
发明内容
为了克服现有技术的不足,本发明的目的之一在于提供一种VR手柄静态检测算法,其能判断手柄当前手势判断是否运动,实施对手柄姿态进行校正。
本发明的目的之二在于提供一种VR手柄,其能判断手柄当前手势判断是否运动,实施对手柄姿态进行校正。
本发明的目的之三在于提供一种计算机可读存储介质,其能判断手柄当前手势判断是否运动,实施对手柄姿态进行校正。
本发明的目的之一采用如下技术方案实现:
VR手柄静态检测算法,包括如下步骤:
标定步骤:将加速度和磁力计分别通过公式进行标定以得到初始姿态信息,其中,Acc为加速度,Mag为磁力计,Acc′为加速度的标定,Mag′为磁力计的标定,Ca为加速度的标定参数,Cm为磁力计的标定参数;
加速度处理步骤:根据标定后的加速度通过公式g=ξacc(Acc'[n]-Acc'[n-k])进行处理得到参数g;其中,n为当前帧输入值,n-k为当前帧前的第k帧输入值,ξacc为比例系数;
磁力计处理步骤:根据标定后的磁力计通过公式处理得到参数θ,其中,n为当前帧输入值,n-1为当前帧的前一帧输入值;
计算步骤:根据参数g和参数θ结合公式获取当前静止状态,其中,Threg=0.05,Threθ=0.034。
进一步地,加速度处理步骤中,k=2,ξacc=0.85。
进一步地,标定步骤中,将加速度和磁力计分别进行滤波后再进行标定。
本发明的目的之二采用如下技术方案实现:
一种VR手柄,该手柄内设有处理器、存储器和存储在存储器中并可在处理器上运行的计算机程序,处理器执行所述计算机程序时实现以下步骤:
标定步骤:将加速度和磁力计分别通过公式进行标定以得到初始姿态信息,其中,Acc为加速度,Mag为磁力计,Acc′为加速度的标定,Mag′为磁力计的标定,Ca为加速度的标定参数,Cm为磁力计的标定参数;
加速度处理步骤:根据标定后的加速度通过公式g=ξacc(Acc'[n]-Acc'[n-k])进行处理得到参数g;其中,n为当前帧输入值,n-k为当前帧前的第k帧输入值,ξacc为比例系数;
磁力计处理步骤:根据标定后的磁力计通过公式处理得到参数θ,其中,n为当前帧输入值,n-1为当前帧的前一帧输入值;
计算步骤:根据参数g和参数θ结合公式获取当前静止状态,其中,Threg=0.05,Threθ=0.034。
进一步地,加速度处理步骤中,k=2,ξacc=0.85。
进一步地,将加速度和磁力计分别进行滤波后再进行标定。
本发明的目的之三采用如下技术方案:
一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被执行时实现如本发明目的之一所述的算法。
相比现有技术,本发明的有益效果在于:
(1)本发明基于加速度和磁力计一阶微分值,判断当前手柄的移动状态,可以很好的识别手势是否运动,同时结合姿态初始化算法,能够实时对手柄姿态进行矫正,补充陀螺仪带来的手柄漂移问题。
附图说明
图1为本发明的VR手柄静态检测算法的流程图。
具体实施方式
下面,结合附图以及具体实施方式,对本发明做进一步描述,需要说明的是,在不相冲突的前提下,以下描述的各实施例之间或各技术特征之间可以任意组合形成新的实施例。
如图1,本发明提供一种VR手柄静态检测算法,其包括如下步骤:
S1:将加速度和磁力计分别通过公式进行标定以得到初始姿态信息,其中,Acc为加速度,Mag为磁力计,Acc′为加速度的标定,Mag′为磁力计的标定,Ca为加速度的标定参数,Cm为磁力计的标定参数;
本步骤中,优选将加速度和磁力计分别进行滤波后再进行标定。
S2:根据标定后的加速度通过公式g=ξacc(Acc'[n]-Acc'[n-k])进行处理得到参数g;其中,n为当前帧输入值,n-k为当前帧前的第k帧输入值,ξacc为比例系数;通过本步骤可以计算出俯仰角和翻滚角的变化率;优选k=2,ξacc=0.85。
S3:根据标定后的磁力计通过公式处理得到参数θ,其中,n为当前帧输入值,n-1为当前帧的前一帧输入值;通过本步骤可以判断当前偏航角方向的变化率;
S4:根据参数g和参数θ结合公式获取当前静止状态,其中,Threg=0.05,Threθ=0.034。
在本步骤中,通过判断俯仰角、偏航角、翻滚角三个方向的变化率来识别静止状态。
通过该方法可以很好的识别手势是否运动,同时结合姿态初始化算法,能够实时对手柄姿态进行矫正,补充陀螺仪带来的手柄漂移问题。
本发明还提供一种VR手柄,其内设有处理器、存储器和存储在存储器中并可在处理器上运行的计算机程序,处理器执行所述计算机程序时实现以下步骤:
标定步骤:将加速度和磁力计分别通过公式进行标定以得到初始姿态信息,其中,Acc为加速度,Mag为磁力计,Acc′为加速度的标定,Mag′为磁力计的标定,Ca为加速度的标定参数,Cm为磁力计的标定参数;
加速度处理步骤:根据标定后的加速度通过公式g=ξacc(Acc'[n]-Acc'[n-k])进行处理得到参数g;其中,n为当前帧输入值,n-k为当前帧前的第k帧输入值,ξacc为比例系数;
磁力计处理步骤:根据标定后的磁力计通过公式处理得到参数θ,其中,n为当前帧输入值,n-1为当前帧的前一帧输入值;
计算步骤:根据参数g和参数θ结合公式获取当前静止状态,其中,Threg=0.05,Threθ=0.034。
另外,本发明还提供一种计算机可读存储介质,其存储有计算机程序,计算机程序可被处理器执行,在被执行时实现本发明的算法流程。
上述实施方式仅为本发明的优选实施方式,不能以此来限定本发明保护的范围,本领域的技术人员在本发明的基础上所做的任何非实质性的变化及替换均属于本发明所要求保护的范围。

Claims (7)

1.VR手柄静态检测算法,其特征在于,包括如下步骤:
标定步骤:将加速度和磁力计分别通过公式进行标定以得到初始姿态信息,其中,Acc为加速度,Mag为磁力计,Acc′为加速度的标定,Mag′为磁力计的标定,Ca为加速度的标定参数,Cm为磁力计的标定参数;
加速度处理步骤:根据标定后的加速度通过公式g=ξacc(Acc'[n]-Acc'[n-k])进行处理得到参数g;其中,n为当前帧输入值,n-k为当前帧前的第k帧输入值,ξacc为比例系数;
磁力计处理步骤:根据标定后的磁力计通过公式处理得到参数θ,其中,n为当前帧输入值,n-1为当前帧的前一帧输入值;
计算步骤:根据参数g和参数θ结合公式获取当前静止状态,其中,Threg=0.05,Threθ=0.034。
2.如权利要求1所述的VR手柄静态检测算法,其特征在于,加速度处理步骤中,k=2,ξacc=0.85。
3.如权利要求1所述的VR手柄静态检测算法,其特征在于,标定步骤中,将加速度和磁力计分别进行滤波后再进行标定。
4.一种VR手柄,该手柄内设有处理器、存储器和存储在存储器中并可在处理器上运行的计算机程序,其特征在于,处理器执行所述计算机程序时实现以下步骤:
标定步骤:将加速度和磁力计分别通过公式进行标定以得到初始姿态信息,其中,Acc为加速度,Mag为磁力计,Acc′为加速度的标定,Mag′为磁力计的标定,Ca为加速度的标定参数,Cm为磁力计的标定参数;
加速度处理步骤:根据标定后的加速度通过公式g=ξacc(Acc'[n]-Acc'[n-k])进行处理得到参数g;其中,n为当前帧输入值,n-k为当前帧前的第k帧输入值,ξacc为比例系数;
磁力计处理步骤:根据标定后的磁力计通过公式处理得到参数θ,其中,n为当前帧输入值,n-1为当前帧的前一帧输入值;
计算步骤:根据参数g和参数θ结合公式获取当前静止状态,其中,Threg=0.05,Threθ=0.034。
5.如权利要求4所述的VR手柄,其特征在于,加速度处理步骤中,k=2,ξacc=0.85。
6.如权利要求4所述的VR手柄,其特征在于,标定步骤中,将加速度和磁力计分别进行滤波后再进行标定。
7.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被执行时实现如权利要求1-3任一项所述的算法。
CN201710884572.4A 2017-09-26 2017-09-26 一种vr手柄静态检测算法、vr手柄及存储介质 Active CN107883953B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710884572.4A CN107883953B (zh) 2017-09-26 2017-09-26 一种vr手柄静态检测算法、vr手柄及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710884572.4A CN107883953B (zh) 2017-09-26 2017-09-26 一种vr手柄静态检测算法、vr手柄及存储介质

Publications (2)

Publication Number Publication Date
CN107883953A true CN107883953A (zh) 2018-04-06
CN107883953B CN107883953B (zh) 2021-05-25

Family

ID=61780825

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710884572.4A Active CN107883953B (zh) 2017-09-26 2017-09-26 一种vr手柄静态检测算法、vr手柄及存储介质

Country Status (1)

Country Link
CN (1) CN107883953B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111760270A (zh) * 2020-06-30 2020-10-13 歌尔科技有限公司 一种摇杆漂移处理方法、装置及相关组件

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090319181A1 (en) * 2008-06-20 2009-12-24 Microsoft Corporation Data services based on gesture and location information of device
CN102184549A (zh) * 2011-04-29 2011-09-14 韩铮 一种运动参数确定方法、装置和运动辅助设备
CN102681958A (zh) * 2011-01-28 2012-09-19 微软公司 使用物理姿势传输数据
CN103076884A (zh) * 2013-02-07 2013-05-01 韩铮 用于动作识别的数据采集方法和装置以及动作识别系统
CN103616030A (zh) * 2013-11-15 2014-03-05 哈尔滨工程大学 基于捷联惯导解算和零速校正的自主导航系统定位方法
CN104897158A (zh) * 2015-06-26 2015-09-09 中国科学院上海高等研究院 一种步行者室内双层定位方法及系统
CN107014388A (zh) * 2016-12-22 2017-08-04 威海北洋电气集团股份有限公司 一种基于磁干扰检测的步行者轨迹推算方法及装置

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090319181A1 (en) * 2008-06-20 2009-12-24 Microsoft Corporation Data services based on gesture and location information of device
CN102681958A (zh) * 2011-01-28 2012-09-19 微软公司 使用物理姿势传输数据
CN102184549A (zh) * 2011-04-29 2011-09-14 韩铮 一种运动参数确定方法、装置和运动辅助设备
CN103076884A (zh) * 2013-02-07 2013-05-01 韩铮 用于动作识别的数据采集方法和装置以及动作识别系统
CN103616030A (zh) * 2013-11-15 2014-03-05 哈尔滨工程大学 基于捷联惯导解算和零速校正的自主导航系统定位方法
CN104897158A (zh) * 2015-06-26 2015-09-09 中国科学院上海高等研究院 一种步行者室内双层定位方法及系统
CN107014388A (zh) * 2016-12-22 2017-08-04 威海北洋电气集团股份有限公司 一种基于磁干扰检测的步行者轨迹推算方法及装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111760270A (zh) * 2020-06-30 2020-10-13 歌尔科技有限公司 一种摇杆漂移处理方法、装置及相关组件

Also Published As

Publication number Publication date
CN107883953B (zh) 2021-05-25

Similar Documents

Publication Publication Date Title
US10747330B2 (en) Device and method for determination of angular position in three-dimensional space, and corresponding electronic apparatus
CN106525074B (zh) 一种云台漂移的补偿方法、装置、云台和无人机
CN109752003B (zh) 一种机器人视觉惯性点线特征定位方法及装置
CN103940425B (zh) 一种磁‑惯性组合捷联测量方法
US9031805B2 (en) Geomagnetic field measurement device, offset determination method, and computer readable recording medium therefor
CN109724602A (zh) 一种基于硬件fpu的姿态解算系统及其解算方法
CN107063262A (zh) 一种用于无人机姿态解算的互补滤波方法
CN110986928B (zh) 光电吊舱三轴陀螺仪漂移实时修正方法
US10852143B2 (en) Motion sensor with drift correction
CN107270940B (zh) 三轴磁强计的输出偏差估计方法
CN111791235B (zh) 一种机器人多相机视觉惯性点线特征定位方法及装置
US20180364048A1 (en) Methods, architectures, apparatuses, systems directed to device position tracking
WO2018107831A1 (zh) 一种测量物体姿态角的方法和装置
CN108592917A (zh) 一种基于失准角的卡尔曼滤波姿态估计方法
CN104819717B (zh) 一种基于mems惯性传感器组的多旋翼飞行器姿态检测方法
CN107883953A (zh) Vr手柄静态检测算法、vr手柄及存储介质
CN107389092B (zh) 一种基于磁传感器辅助的陀螺标定方法
CN106931965B (zh) 一种确定终端姿态的方法及装置
CN107907129A (zh) Vr手柄姿态初始算法、vr手柄及存储介质
CN108692727A (zh) 一种带有非线性补偿滤波器的捷联惯导系统
WO2020139093A1 (en) Magnetometerless detection of incorrect attachment and calibration of motion tracking system
CN114994352A (zh) 一种高速旋转制导炮弹转速测量方法
Park et al. An adaptive complementary filter for gyroscope/vision integrated attitude estimation
CN116774263B (zh) 面向组合导航系统的导航定位方法及装置
CN109186613B (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
GR01 Patent grant
GR01 Patent grant