CN106872990B - 一种三维空间目标精准定位和追踪方法 - Google Patents
一种三维空间目标精准定位和追踪方法 Download PDFInfo
- Publication number
- CN106872990B CN106872990B CN201710116296.7A CN201710116296A CN106872990B CN 106872990 B CN106872990 B CN 106872990B CN 201710116296 A CN201710116296 A CN 201710116296A CN 106872990 B CN106872990 B CN 106872990B
- Authority
- CN
- China
- Prior art keywords
- point
- inertial sensor
- camera
- tracing
- precise positioning
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
Landscapes
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种三维空间目标精准定位和追踪方法。本方法仅使用惯性传感器提供的三轴角度信息,不使用位置信息,避免了惯性传感器位置数据测定中累积误差越来越大的缺点;由于只使用一台摄像机,安装和移动方便灵活,而且不增加太多的成本。
Description
技术领域
本发明涉及三维空间目标定位、位置追踪、目标姿态测定技术领域,尤其涉及虚拟现实应用中的空间定位与追踪、运动捕捉、运动分析、康复医疗中的步态分析和目标姿态测定等方面的一种三维空间目标精准定位和追踪方法。
背景技术
空间目标三维位置和姿态测定常用的技术从原理上说可分为机械式、声学式、电磁式、惯性式、光学式。各种方式优缺点对比如下:
随着技术的发展,目前最常用是惯性式和光学式。本发明在惯性式中引入单台摄像机,利用一台摄像机辅助惯性传感器进行空间移动目标位置的精准测定,有效地解决了惯性式方法中位置数据测定中的积累误差越来越大的缺点。
发明内容
本发明的目的是:在惯性式中引入单台摄像机,利用一台摄像机辅助惯性传感器进行空间移动目标位置的精准测定,有效解决惯性式方法中位置数据测定中的积累误差越来越大的缺点。
本发明提供了一种三维空间目标精准定位和追踪方法,本方法在被测目标上设置两个标识点:第一标识点和第二标识点、惯性传感器、一台摄像机;所述第一标识点和第二标识点之间的距离L已知;所述惯性传感器通过三轴角加速度,获得三轴角度或能够描述三轴角度的四元数。
通过公式:以下计算的前提条件是,将摄像机置于惯性传感器相同的坐标系下;
和
得到第一标识点(4)的坐标(X1,Y1,Z1)和第二标识点(5)的坐标(X2,Y2,Z2);
上式中,
n=1或2;A,B,C是由惯性传感器所确定的三轴角度推算出的平面的法相量;∝x,∝y,u0,v0为摄像机内参数,是已知量,满足
优选的,惯性传感器所确定的三轴角度得到的平面的法相量(A,B,C)的过程如下:
平面方程如下AX+BY+CZ+d=0;
用于描述三轴角度的四元数的表达式为:
q=q0+i*qx+j*qy+k*qz;
设初始位置时q=1,对应的平面法矢量为
其四元数表示为r0=0+i*0+j*0+k*1;
任意位置时p=p0+i*px+j*py+k*pz,
对应的平面发矢量为
其四元数表示为r=0+i*A+j*B+k*C;
则r=pr0p*,
即(A,B,C)可由pr0p*算出;
其中,p*=p0-i*px-j*py-k*pz为p的共轭。
优选的,所述第一标识点和第二标识点是反光球、反光贴片、特殊的图案或具有一定特征性的图像。
优选的,所述摄像机是彩色摄像机、红外摄像机、深度扫描设备等能够识别目标上的标识点或特征的光学设备或从获得的光学图像上识别标识点的位置的设备。
有益效果:本方法仅使用惯性传感器提供的三轴角度信息,不使用位置信息,避免了惯性传感器位置数据测定中累积误差越来越大的缺点。由于只使用一台摄像机,安装和移动方便灵活,而且不增加太多的成本。
附图说明
图1为本发明实施例提供的三维空间目标精准定位和追踪方法原理图。
图2为本发明实施例中统一坐标系的说明图。
具体实施方式
为使本发明解决的技术问题、采用的技术方案和达到的技术效果更加清楚,下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部内容。
请参照图1,本方法的系统包括:被测目标1上的2个标识点(第一标识点4和第二标识点5)、惯性传感器2、一台摄像机3。
被测目标1:取一长方体作为被测目标1。
标识点:表面特殊材质,反射红外线的小球。
被测目标表面的2个标识点:固定于长方体表面的两个标识点。实测其距离为L。
惯性传感器2:可以提供自身的三轴旋转角,进而提供四元数,计算出自身平面的法相量。
摄像机3:红外摄像机,可以检测出其图像上两个标识点的平面坐标。
环境要求及准备:
无阳光直射的室内,增加红外线照明作为光源,这样红外线摄像机只能拍摄到标识点反射的红外光线,可以很容易的识别到图像上标识点的位置。
在长方体表面上固定2个标识点,并实测其间距为L。
统一坐标系:
将惯性传感器放置在摄像机正上方,使传感器的坐标系和相机坐标系重合,设置惯性传感器数据归零,则完成惯性传感器和摄像机的坐标系的统一。(见图2,其中3代表相机,2代表传感器)
使用方法:
统一坐标系后,将惯性传感器固定在长方体的表面,则可以根据惯性传感器的数据和红外摄像机捕捉到的标识点坐标利用本发明的计算方法,实时计算出长方体在空间的位置和姿态。完成对被测目标长方体的运动捕捉。
理论分析:
将摄像机置于惯性传感器相同的坐标系下(统一坐标系的方法有很多,这里不详述)
相机机的内参数为
设空间中任一标识点的三维坐标为(X,Y,Z),此标识点被相机捕捉到后,在摄像机图像上的坐标为(u,v),S为标识点到相机的距离,则有式
式(1)
展开后得到
即
式(2)
平面方程如下AX+BY+CZ+d=0,其中(A,B,C)是由目标上的惯性传感器所确定的三轴角度推算出的平面的法相量。
具体过程如下:惯性传感器所确定的三轴角度得到的平面的法相量(A,B,C)的过程如下:
平面方程如下AX+BY+CZ+d=0;
用于描述三轴角度的四元数的表达式为:
q=q0+i*qx+j*qy+k*qz;
设初始位置时q=1,对应的平面法矢量为
其四元数表示为r0=0+i*0+j*0+k*1;
任意位置时p=p0+i*px+j*py+k*pz,
对应的平面发矢量为
其四元数表示为r=0+i*A+j*B+k*C;
则r=pr0p*,
即(A,B,C)可由pr0p*算出;
其中,p*=p0-i*px-j*py-k*pz为p的共轭。
与式(2)联立得
式(3)
解方程得
式(4)X=-dmx,Y=-dmy,Z=-dmz
其中
对于目标表面上的两个标识点(X1,Y1,Z1)和(X2,Y2,Z2)
X1=-dmx1,Y1=-dmy1,Z1=-dmz1
X2=-dmx2,Y2=-dmy2,Z2=-dmz2
已知两个标识点的距离为L,则有
即得式(5)
式(5)代入式(4)得
和
得到两个标识点(X1,Y1,Z1)和(X2,Y2,Z2)后,即可分析被测目标1的其他位置点信息。
在虚拟现实应用中,可以把VR眼镜作为实施例中的长方体,这样可以实时测得VR眼镜的位置和姿态,用来控制VR眼镜内现实的内容。
在康复医疗的步态分析中,可以把大腿或小腿作为实施例中的长方体,可以检测出大腿或小腿的运动信息,用来判断疾病及康复情况。
在高尔夫球动作分析中,可以把髋关节作为实施例中的长方体,可以检测髋关节的位移和旋转,用来分析击球动作。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (4)
1.一种三维空间目标精准定位和追踪方法,其特征在于,在被测目标(1)上设置两个标识点:第一标识点(4)和第二标识点(5)、惯性传感器(2)、一台摄像机(3);所述第一标识点(4)和第二标识点(5)之间的距离L,已知;所述惯性传感器(2)通过三轴角加速度,获得三轴角度或能够描述三轴角度的四元数;
通过公式:以下计算的前提条件是,将摄像机置于惯性传感器相同的坐标系下;
和
得到第一标识点(4)的坐标(X1,Y1,Z1)和第二标识点(5)的坐标(X2,Y2,Z2);
上式中,
n=1或2;A,B,C是由惯性传感器所确定的三轴角度得到的平面的法相量,具体的:∝x,∝y,u0,v0为摄像机内参数,是已知量,满足其中,K为相机内参数。
2.根据权利要求1所述的一种三维空间目标精准定位和追踪方法,其特征在于,惯性传感器所确定的三轴角度得到的平面的法相量(A,B,C)的过程如下:
平面方程如下AX+BY+CZ+d=0;
用于描述三轴角度的四元数的表达式为:
q=q0+i*qx+j*qy+k*qz;
设初始位置时q=1,对应的平面法矢量为
其四元数表示为r0=0+i*0+j*0+k*1;
任意位置时p=p0+i*px+j*py+k*pz,
对应的平面发矢量为
其四元数表示为r=0+i*A+j*B+k*C;
则r=pr0p*,
即(A,B,C)可由pr0p*算出;
其中,p*=p0-i*px-j*py-k*pz为p的共轭。
3.根据权利要求1所述的一种三维空间目标精准定位和追踪方法,其特征在于,所述第一标识点(4)和第二标识点(5)是反光球、反光贴片或具有一定特征性的图像。
4.根据权利要求1所述的一种三维空间目标精准定位和追踪方法,其特征在于,所述摄像机(3)是彩色摄像机、红外摄像机、深度扫描设备能够识别目标上的标识点或特征的光学设备或从获得的光学图像上识别标识点的位置的设备。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710116296.7A CN106872990B (zh) | 2017-03-01 | 2017-03-01 | 一种三维空间目标精准定位和追踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710116296.7A CN106872990B (zh) | 2017-03-01 | 2017-03-01 | 一种三维空间目标精准定位和追踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106872990A CN106872990A (zh) | 2017-06-20 |
CN106872990B true CN106872990B (zh) | 2019-09-10 |
Family
ID=59169460
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710116296.7A Active CN106872990B (zh) | 2017-03-01 | 2017-03-01 | 一种三维空间目标精准定位和追踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106872990B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3682196A4 (en) * | 2017-09-13 | 2021-09-22 | Xiaochun Nie | SYSTEMS AND METHODS FOR CALIBRATION OF IMAGING AND SPATIAL ORIENTATION SENSORS |
CN107576998A (zh) * | 2017-10-25 | 2018-01-12 | 成都金麒麟云信息科技有限公司 | 应用于交互式数字展览的人体跟踪系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1458535A (zh) * | 2003-05-07 | 2003-11-26 | 天津大学 | 主动式激光扫描远距离坐标测量方法 |
CN101033940A (zh) * | 2007-03-30 | 2007-09-12 | 哈尔滨工业大学 | 用于空间物体三维检测与定位的光电式自准直显微测量仪 |
CN104280740A (zh) * | 2014-10-11 | 2015-01-14 | 三峡大学 | 一种基于摄像机与激光测距传感器联合定位爆破孔的装置及定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101644370B1 (ko) * | 2014-10-23 | 2016-08-01 | 현대모비스 주식회사 | 물체 검출 장치 및 그 동작 방법 |
-
2017
- 2017-03-01 CN CN201710116296.7A patent/CN106872990B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1458535A (zh) * | 2003-05-07 | 2003-11-26 | 天津大学 | 主动式激光扫描远距离坐标测量方法 |
CN101033940A (zh) * | 2007-03-30 | 2007-09-12 | 哈尔滨工业大学 | 用于空间物体三维检测与定位的光电式自准直显微测量仪 |
CN104280740A (zh) * | 2014-10-11 | 2015-01-14 | 三峡大学 | 一种基于摄像机与激光测距传感器联合定位爆破孔的装置及定位方法 |
Non-Patent Citations (1)
Title |
---|
IMU/DGPS辅助车载CCD及激光扫描仪三维数据采集与建模;陈允芳等;《测绘科学》;20060930;第31卷(第5期);第7、77、91-92页 |
Also Published As
Publication number | Publication date |
---|---|
CN106872990A (zh) | 2017-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643699B (zh) | 一种虚拟现实系统中的空间定位装置和定位方法 | |
CN113379822B (zh) | 一种基于采集设备位姿信息获取目标物3d信息的方法 | |
EP2718668B1 (en) | Sensor positioning for 3d scanning | |
JP4708752B2 (ja) | 情報処理方法および装置 | |
CN106681510B (zh) | 位姿识别装置、虚拟现实显示装置以及虚拟现实系统 | |
CN108700947A (zh) | 用于并发测距和建图的系统和方法 | |
CN103759716A (zh) | 基于机械臂末端单目视觉的动态目标位置和姿态测量方法 | |
CN111429523B (zh) | 一种在3d建模中远距离标定方法 | |
WO2004044522A1 (ja) | 3次元形状計測方法およびその装置 | |
CN105378794A (zh) | 3d拍摄装置、用于建立3d图像的方法和用于构建3d拍摄装置的方法 | |
CN111445529B (zh) | 一种基于多激光测距的标定设备及方法 | |
CN112492292B (zh) | 一种自由姿态的智能视觉3d信息采集设备 | |
CN112254670B (zh) | 一种基于光扫描和智能视觉融合的3d信息采集设备 | |
CN111811462A (zh) | 极端环境下大构件便携式视觉测距系统及方法 | |
CN111445528B (zh) | 一种在3d建模中多相机共同标定方法 | |
CN106872990B (zh) | 一种三维空间目标精准定位和追踪方法 | |
CN115120967A (zh) | 目标定位方法、装置、存储介质及终端 | |
Sun et al. | High-accuracy three-dimensional measurement based on multi-directional cooperative target with weighted SfM algorithm | |
Islam et al. | Full-body tracking using a sensor array system and laser-based sweeps | |
Aliakbarpour et al. | Three-dimensional reconstruction based on multiple virtual planes by using fusion-based camera network | |
JP4918675B2 (ja) | 3次元座標測定方法 | |
CN112304250B (zh) | 一种移动物体之间的三维匹配设备及方法 | |
CN110785792A (zh) | 3d建模方法、电子设备、存储介质及程序产品 | |
CN113421286A (zh) | 一种动作捕捉系统及方法 | |
CN208314856U (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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230609 Address after: Room 408, 57A4/F, Tongqing Street, Xigang District, Dalian City, Liaoning Province, 116011 Patentee after: DALIAN DOREAL SOFTWARE Co.,Ltd. Address before: 116023 East Area, Floor 1, No. 62, Southwest Road, Shahekou District, Dalian, Liaoning Patentee before: DA LIAN DYNASMART TECHNOLOGY CO.,LTD. |