CN105874352B - 使用旋转半径确定设备与船只之间的错位的方法和装置 - Google Patents
使用旋转半径确定设备与船只之间的错位的方法和装置 Download PDFInfo
- Publication number
- CN105874352B CN105874352B CN201480062288.3A CN201480062288A CN105874352B CN 105874352 B CN105874352 B CN 105874352B CN 201480062288 A CN201480062288 A CN 201480062288A CN 105874352 B CN105874352 B CN 105874352B
- Authority
- CN
- China
- Prior art keywords
- equipment
- turn
- radius
- platform
- dislocation
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
-
- 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
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B5/00—Measuring arrangements characterised by the use of mechanical techniques
- G01B5/24—Measuring arrangements characterised by the use of mechanical techniques for measuring angles or tapers; for testing the alignment of axes
-
- 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
- G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本公开涉及一种使用设备的旋转半径的,用于确定设备和平台(诸如例如船只或车辆)之间错位的方法和装置,其中该设备的移动性可以被约束或非约束在平台中。该设备可以在平台内移动或向任何方向倾斜,且仍然提供无缝导航解决方案而不降低此导航解决方案的性能。此方法可以利用来自传感器(诸如例如,加速度计、陀螺仪等)的测量(读数),不论导航信息的更新(诸如例如,全球导航卫星***(GNSS)或WiFi定位)存在或缺失。
Description
相关申请
本申请要求2013年9月16日提交的美国临时专利申请No.61/878,336的权益,该专利申请的公开内容通过引用整体结合于此。
技术领域
本公开涉及一种用于确定设备和平台(诸如例如船只或车辆)之间错位的方法和装置,其中该设备的移动性可以被约束或非约束在平台中。
背景技术
平台的惯性导航是基于比力(specific force)和角速度的集成,该力和角速度由惯性传感器(例如,加速度计、陀螺仪)和包含该传感器的设备所测量。一般地,该设备被置于平台内部,并通常捆绑至该平台。来自设备的此种测量可以用来确定该设备和/或平台的位置、速度和姿态。
该平台可以是可能临时静止的能够运动的平台。一些平台的示例可以是任何类型的车辆或船只。该船只可以是基于陆地上的、海上的或空中的。
平台内的惯性传感器的对齐(与该平台的前向、横向和垂直轴)对惯性导航是关键的。如果惯性传感器(如加速度计和陀螺仪)没有与该平台完全对齐,使用惯性传感器的读数所计算的位置和姿态将不能代表平台。因而,修理平台内的惯性传感器是提供高精准导航解决方案的导航***的要求。
对于捆绑***,用于确保最优导航解决方案的一个已知手段是利用在平台内惯性传感器的仔细的手动安装。然而,便携式导航设备(或具有导航能力的设备)能够移动,不论是在平台中(诸如例如在船只或车辆)被约束或非约束,所以仔细安装绝非良策。
现有便携式导航设备(或具有导航能力的设备)不能获得平台的准确姿态和位置,除非已知下列三个条件中的至少一个:
1)设备和平台的绝对姿态角;
2)设备的绝对姿态角以及设备与平台之间的错位;或
3)平台的绝对姿态角、以及设备与平台之间的错位。
上述第一选择至少需要两个传感器组件,一个在设备上和一个在平台上,因而错位的了解是在没有先前提到的约束的情况下启用便携式导航设备的关键因素。
对于导航,手机/智能电话,由于配备了辅助全球定位***(AGPS)芯片组,变得十分流行,该芯片组(在通过利用网络连接,显著提高启动性能的基础上)也进一步使用高灵敏度能力来提供平台的绝对位置,即便在一些对于卫星信号不能保证清晰视线的环境中。深户内或挑战的户外(不能利用AGPS解决方案的地方)导航或定位包括蜂窝塔架ID或(如果可能的话)用于定位的塔架三边测量。尽管这两种已经出现在很多移动设备的定位方法中,但准确的室内定位仍提出挑战并且未能满足当今的基于位置的服务(LBS)的准确度要求。此外,这些方法仅可提供平台的绝对航向(heading)而没有关于设备的航向的任何信息。
许多移动设备(诸如,移动电话)配备有主要用于屏幕控制和娱乐应用的微机电***(MEMS)传感器。这些传感器,由于非常高的噪声、大的随机漂移率和相对于承载平台的频繁改变的取向,目前还没有被广泛用于导航目的。
在很多移动设备内也可以找到磁力计。在某些情况下,已表明如果用户足够小心保持设备相对于其身体的特定取向(诸如当在校准磁力计之后小心保持在用户前面时),使用加速度计和磁力计的导航解决方案也许是可能的。
因此,存在能够精准地利用来自平台内的设备的测量的导航解决方案的需求,以确定设备/平台的导航状态,而没有平台上的约束(即,室内或室外环境)或设备的移动。平台的位置和姿态的估计必须独立于设备的使用(例如,导航期间在平台内放置或移动设备的方式)。在上面的场景中,设备可以在平台内移动或向任何方向倾斜,即便在如此场景中需要设备提供无缝导航。这再次强调了设备和平台之间错位的关键的重要性,让设备能在相对于平台的任何方向中使用。
因此,对于使用设备的导航,要求缓解此问题的方法,其中设备的移动可以约束或非约束于平台内部,并且其中设备可以在平台内移动或向任何方向倾斜。
除了上面提到的便携式设备的应用(该应用包括完整的导航解决方案,包括位置、速度和姿态、或位置和姿态)之外,还有其它应用(其可包括估计完整的导航解决方案,或仅姿态解决方案或姿态和速度解决方案),其中对于增强用户体验和可用性,需要缓解上述问题的方法,并且可应用于多个场景。
发明内容
本公开涉及一种使用设备的旋转半径的,用于确定设备和平台(诸如例如船只或车辆)之间错位的方法和装置,其中该设备的移动性可以被约束或非约束在平台中。该设备可以在平台内移动或向任何方向倾斜,且仍然提供无缝导航解决方案而不降低此导航解决方案的性能。传感器具有用于传感器轴的对应坐标系。设备和平台之间的错位对应于设备中的传感器组件的坐标系与平台的坐标系之间的错位。此方法可以利用来自传感器(诸如例如加速度计、陀螺仪等)的测量(读数),不论导航信息的更新(诸如,例如,全球导航卫星***(GNSS)或WiFi定位)存在或缺失。
本方法和装置可被用于计算覆盖整个错位空间的连续错位角度,而不只是此角度的离散值或预定值。进一步,本方法可以和相对于平台的不同设备使用和方向工作。
所述方法包括下列步骤:
a)计算设备的旋转半径。这个可以通过使用陀螺仪和加速度计读数,或其平滑、平均或滤波的版本来达成。该计算的旋转半径也可以或可以不用经受平滑、平均或滤波。
b)通过检查如下所列,检查小的旋转半径:(i)旋转半径,(ii)旋转半径的缓冲历史,(iii)平滑、平均或滤波版本的旋转半径,或(iv)平滑、平均或滤波版本的旋转半径的缓冲历史。
c)使用来自b)的信息来识别和辨别设备航向中的改变是否是因为平台或船只内的设备自身的转向,还是因为包括该设备的平台或船只的转向。来自b)的信息可以为了此识别而单独使用,或者其可以用于与其他传感器的读数或从其获取的数量的结合,诸如例如陀螺仪读数的大小。
d)如果设备航向改变是因为平台或船只内的设备自身的转向,依据c)中的识别调整错位。此情况中设备航向改变为错位改变。
在某些实施例中,可以使用可选例程来再次检查通过以上方法检测出的错位改变是否为合理的改变,而不是噪声或(来自已经检测的改变的)多余的检测,并且防范此类情况。
在某些实施例中,可以使用可选例程,其对由本文的方法提供的错位和用于确定设备与平台或船只之间的错位的一个或更多其他方法进行结合。
可使用这些可选例程中的任一个或任何组合。
概括地说,在某些实施例中,使用设备的旋转半径来确定设备和平台之间错位的方法和设备,其中该设备包括能够提供传感器读数的传感器,和计算设备航向角度的装置,该方法包括以下步骤:a)从传感器读数计算设备的旋转半径;b)确定该旋转半径是否为小的旋转半径;c)通过使用旋转半径是否为小的旋转半径的确定,识别设备航向角度中的改变是否由平台内的设备的转向引起,还是由包括设备的平台的转向引起;和d)如果设备航向角度的改变是因为平台内的设备的转向,调整错位,在所述的情况中设备航向角度中的改变是用于调整错位的检测到的错位改变。
附图说明
图1示出了设备的灵敏轴(a),以及设备和平台之间的错位的一个实施例的描绘,其中该平台为车辆(b);和
图2是本方法的一个实施例的流程图。
具体实施方式
本公开涉及一种使用设备的旋转半径的,用于确定设备和平台(诸如例如船只或车辆)之间错位的方法和装置,其中该设备的移动性可以被约束或非约束在平台中。该设备可以在平台内移动或向任何方向倾斜,且仍然提供无缝导航解决方案而不降低此导航解决方案的性能。传感器具有传感器的轴的对应坐标系。设备和平台之间的错位对应于设备中的传感器组件的坐标系与平台的坐标系之间的错位。此方法可以利用来自传感器(诸如例如加速度计、陀螺仪等)的测量(读数),不论导航信息的更新(诸如,例如,全球导航卫星***(GNSS)或WiFi定位)存在或缺失。
该平台是可能临时静止的能够运动的平台。一些平台的示例可以是任何类型的车辆或船只。该船只可以是基于陆地上的、海上的或空中的。
绝对导航信息是与导航和/或定位有关的信息,并且由“基于参考”的***所提供,该“基于参考”的***依赖于诸如例如全球导航卫星***(GNSS)之类的外部信息源。另一方面,自包含的导航信息是与导航和/或定位有关的信息,并由设备/平台内的自包含和/或“非基于参考”的***来提供,并且因而不必依赖于可能中断或阻塞的外部信息源。自包含信息的示例是来自运动传感器(如加速度计和陀螺仪)的读数。
本方法和装置可被用于计算覆盖整个错位空间的连续错位角度,而不只是此角度的离散值或预定值。进一步,本方法可以和相对于平台的不同设备使用和方向工作。
应当注意,本方法可以用于各种应用,该应用包括但不限制于包含导航解决方案的如下应用:
●位置、速度和姿态,或
●仅位置和姿态,
或部分导航解决方案,包括:
·仅姿态和速度,或
·仅姿态。
在正常使用期间,设备(例如,便携式电话)的姿态自由地改变。事实上,此设备通常经历沿着其任何主轴(即,x轴、y轴和z轴)的旋转运动。在图1中定义这样的轴,其中设备的前向轴被定义为x轴,垂直或z轴向下指向,并且横向轴或y轴以完成右手坐标系的方式进行定义。
平台内设备的方向不代表平台的方向。该设备可经历相对于平台,沿其任何主轴的任何数量的旋转运动。设备的这些旋转运动不表明平台正在经历相同的取向变化。例如,平台可在水平化的2D平面上移动,而设备可能正在经历任意数量的可能的横摇角和俯仰角。图1示出了非捆绑设备和示例平台(机动车辆)之间的可能的关系。
设备包括能够提供传感器读数的传感器和可使用来处理本方法的处理器。典型的设备包括三轴加速度计,其用于测量沿着每一个灵敏轴(即,x轴、y轴和z轴)的加速度或比力。该设备可包含其它传感器,诸如例如,陀螺仪、磁力计、气压计以及其它。
横摇被定义为设备沿着前向x轴的旋转,而俯仰是沿着横向y轴的旋转。因为设备用户根据需要自由旋转该设备,所以设备可具有相对于平台的横摇、俯仰和方位(航向)的若干变化。
本方法用来确定设备和平台之间的错位角度,包括下列步骤:
a)计算设备的旋转半径。这个可以通过使用陀螺仪和加速度计读数,或其平滑、平均或滤波的版本来达成。陀螺仪和加速度计读数可以或可以不用被补偿其误差,诸如偏差,如果此误差值在诸如例如从导航解决方案的其他中可用。该计算的旋转半径也可以或可以不用经受平滑、平均或滤波。
b)通过检查如下所列,检查小的旋转半径:(i)旋转半径,(ii)旋转半径的缓冲历史,(iii)平滑、平均或滤波版本的旋转半径,或(iv)平滑、平均或滤波版本的旋转半径的缓冲历史。
c)使用来自b)的信息来识别和辨别设备航向中的改变是否是因为平台或船只内的设备自身的转向,还是因为包括该设备的平台或船只的转向。来自b)的信息可以为了此识别而单独使用,或者其可以用于与其他传感器的读数或从其推导出的数量的结合,诸如例如陀螺仪读数的大小。
d)如果设备航向改变是因为平台或船只内的设备自身的转向,依据c)中的识别调整错位值。此情况意味着设备航向改变为错位改变。在某些实施例中,设备航向的缓冲历史用来计算错位改变。
在某些实施例中,可以使用可选例程来再次检查,通过以上方法检测出的错位改变是否为合理的改变,而不是噪声或(来自已经检测的改变的)多余的检测,并且防范此类情况。在某些实施例中,保护是通过旋转半径的缓冲历史和检测的错位改变的缓冲历史。在这些实施例的另一组中,保护是通过使用(在合理的改变后的)时间阈值的基于时间的保护,来避免多余的检测。
在某些实施例中,可以使用可选例程,其对由本文的方法提供的错位和用于确定设备与平台或船只之间的错位的一个或更多其他方法进行结合。在某些实施例中,来自不同方法所计算的错位的结合可以通过使用任何平均、平滑或滤波技术来实现;可以使用的滤波技术的一个示例是卡尔曼(Kalman)滤波。
可使用这些可选例程中的任一个或任何组合。
在图2中示出了本专利中所描述的方法的一个实施例的流程图。可选的部分用虚线和虚线框标记。
本文呈现的方法和装置可以和任何导航解决方案(独立于本导航解决方案中使用的情形估计和滤波技术的类型)结合。情形估计技术可以是线性的、非线性的或其组合。导航解决方案中使用的不同示例可以依赖于卡尔曼滤波器、扩展的卡尔曼滤波器、诸如粒子滤波器等的非线性滤波器,或诸如神经网络或模糊***的人工智能技术。导航解决方案中使用的情形估计技术可以使用任何类型的***和/或测量模型。导航解决方案可以遵循用于集成不同传感器和***的任何模式,诸如例如松耦合集成模式或紧耦合集成模式等等。导航解决方案可以利用建模(使用线性或非线性、短存储器长度或长存储器长度)和/或针对所使用的惯性传感器和/或其他传感器的误差的自动校准。
本方法可以与运输技术的模式和模式检测技术结合,来建立运输模式。这让诸如例如步行和驾驶等等可能模式的不同场景的能够辨别。
构想的实施例
本公开描述了身体坐标系是x前向、y朝身体的右侧为正,且z轴向下为正。可以构想,任何身体坐标系定义可被用于本文中所描述的方法和装置的应用。
构想了以上呈现的方法可以与导航解决方案一起使用,该导航解决方案可以选择性地利用自动零速度期间或静止期间检测,用其可能的更新和惯性传感器偏置重新计算、非完整更新模块、惯性传感器误差的高级建模和/或校准、从GNSS中(在适当时)推导出惯性传感器误差的可能测量更新、GNSS解决方案质量的自动评估以及检测降级的性能、在松和紧耦合集成模式之间自动切换、每一可见GNSS卫星的评估(在处于紧耦合模式时)、并最终可能可与具有任何类型的后向平滑技术的后向平滑模块一起使用,并且在任务后或在同一任务内的缓冲数据上的后台中运行。
进一步构想了以上呈现的方法也可与以下导航解决方案一起使用:该导航解决方案被进一步编程以在后台运行例程来模拟绝对导航信息的人工中断,并估计用于本导航模块中的解决方案的情形估计技术的另一实例的参数以优化该解决方案的精确性和一致性。精确性和一致性通过将模拟中断期间的临时后台解决方案与基准解决方案进行比较来评估。基准解决方案可以是以下示例之一:绝对导航信息(例如,GNSS)、集成可用传感器与绝对导航信息(例如,GNNS)并且可能具有可任选的速率或速度读数的设备中的向前集成导航解决方案、集成可用传感器与绝对导航信息(例如,GNNS)并且可能具有可任选的速率或速度读数的向后平滑集成导航解决方案。后台处理可以在与前向解决方案处理相同的处理器上运行,或在可与第一处理器通信并可从共享位置读取保存数据的另一处理器上运行。后台处理解决方案的结果可以使实时导航解决方案在其将来运行中获益(即,在后台例程已完成运行之后的实时运行),例如,具有用于本模块导航的前向情形估计技术的参数的改进的值。
进一步构想了以上呈现的方法也可与导航解决方案一起使用,该导航解决方案进一步与地图(诸如街道地图、室内地图或模型,或任何其他环境地图或模型,在具有这样的地图或模型可用的应用的情况下)以及地图匹配或模型匹配例程集成。地图匹配或模型匹配可在绝对导航信息(诸如GNNS)降级或中断期间进一步增强导航解决方案。在模型匹配的情况下,获取与环境有关的信息的传感器或传感器群可被使用,诸如例如激光测距器、相机以及视觉***或声纳***。这些新***可被用作额外帮助来在绝对导航信息问题(降级或缺失)期间增强导航解决方案的精准性,或者在一些应用中,它们可以完全替代绝对导航信息。
进一步构想了以上呈现的方法也可与导航解决方案一起使用,该导航解决方案,在按紧耦合模式或混合松/紧耦合选项工作时,不必被限于利用伪距测量(它们是根据代码而非载波相位来计算的,因而它们被称为基于代码的伪距)和多普勒(Doppler)测量(用来获得伪距速率)。GNSS接收器的载波相位测量也可被使用,例如:(i)作为替换方式来计算距离以代替基于代码的伪距,或(ii)通过合并来自基于代码的伪距和载波相位的测量来增强距离计算;这样的增强是载波平滑的伪距。
进一步构想了以上呈现的方法也可与导航解决方案一起使用,该导航解决方案依赖于GNSS接收器与其他传感器的读数之间的超紧密集成模式。
进一步构想,以上所呈现的方法和装置还可与以下导航解决方案一起使用,该导航解决方案使用也可被用于定位和导航的各种无线通信***作为附加辅助(其在GNSS不可用时将是更有益的)或作为GNSS信息的替代(例如,对于GNSS不适用的应用)。用于定位的这些无线通信***的示例是诸如由蜂窝电话塔和信号、无线电信号、数字电视机信号、WiFi或Wimax提供的那些***。例如,对于基于蜂窝电话的应用,来自蜂窝电话塔的绝对坐标和室内用户与塔之间的距离可被用于定位,藉此可通过不同的方法来估计距离,在这些方法中计算到达时间或最接近蜂窝电话定位坐标的到达时间差。称为增强观察时间戳(E-OTD)的方法可被用来获得已知的坐标和距离。距离测量的标准差可依赖于蜂窝电话中使用的振荡器的类型以及蜂窝塔定时装备和传输损失。WiFi定位可以按各种方式来完成,包括但不限于到达时间、到达时间差、到达角、收到信号强度、以及指纹技术,以及其他;所有这些方法提供不同程度的准确度。用于定位的无线通信***可以使用不同技术来对测距、角度、或信号强度中的误差进行建模,并且可以使用不同的多路径减轻技术。所有上述概念以及其他也可按类似的方式来应用于基于无线通信***的其他无线定位技术。
进一步构想,以上所呈现的方法还可与利用来自其它移动设备的辅助信息的导航解决方案一起使用。这一辅助信息可被用作附加辅助(在GNSS不可用时将更有益处)或作为GNSS信息的替换(例如,对于基于GNSS的定位不适用的应用)。来自其他设备的辅助信息的一个示例可以依赖于不同设备之间的无线通信***。底层概念是具有更好定位或导航解决方案的设备(例如,具有带良好可用性和精准度的GNSS)可帮助具有降级的或不可用的GNSS的设备获的改进的定位或导航解决方案。这一帮助依赖于辅助设备的公知位置以及用于定位具有降级的或不可用GNSS的设备的无线通信***。这一所构想的变型涉及以下情况之一或两者:(i)具有降级的或不可用GNSS的设备利用本文描述的方法并获得来自其他设备和通信***的辅助,(ii)具有可用GNSS并且因而具有良好导航解决方案的辅助设备利用本文描述的方法。用于定位的无线通信***可依赖于不同通信协议,并且它可依赖于不同方法,诸如例如到达时间、到达时间差、到达角和收到信号强度等等。用于定位的无线通信***可以使用不同技术来对来自无线信号的测距和/或角度中的误差进行建模,并且可以使用不同的多径缓解技术。
构想了以上呈现的方法也可与本文描述的作为示例描述的基于MEMS的传感器之外的各种类型的惯性传感器一起使用。
不对上述描述作出任何限制,以上呈现的实施例通过以下示例进一步演示。
示例
这个示例是为了展示可能的技术来计算目标的旋转半径“r”,已知其角速度“ω”,角加速度平移加速度“A”;角速度和角加速度二者都可以从陀螺仪传感器的读数获得,而平移加速度可以从加速度计传感器的读数移除重力分量后获得。
可选择地,陀螺仪和加速度计读数可以为平滑的、平均的或滤波的,诸如例如在使用陀螺仪读数历史之前将其平滑或平均,来计算角加速度。
可选择地,陀螺仪和加速度计读数可以或可以不用被补偿误差,诸如偏差,如果此误差值在诸如例如从导航解决方案的其他中可用。
等式(1)示出目标的平移速度“V”和旋转速度“ω”之间的关系
V=ω×R (1)
其中:
V:平移速度向量
ω:角速度向量
R:旋转向量的半径
将等式(1)微分,
其中:
A:平移加速度向量
角加速度向量
I:单位矩阵
且
然后,在等式(2)两边从左都乘以已知目标的旋转半径可以因此被计算,如下等式所示
且
其中:Rx、Ry和Rz是向量R分别在x轴、y轴和z轴方向的三个分量。上述实施例和技术可以在软件中被实施为各种互连的功能块或不同的软件模块。然而,这不是必须的,并且可以存在以下情况:这些功能块或模块等同地聚集进入成具有不清晰边界的单个逻辑器件、程序或操作。在任何情况下,实现上述各实施例或接口的各特征的功能块和软件模块可由它们本身来实现,或结合其他硬件或软件操作来实现,被完全实现在设备内或结合该设备以及与该设备通信的其他启用处理器的设备(如服务器)来实现。
虽然已经示出并描述了几个实施例,但本领域技术人员将明白,可对这些实施例作出各种改变和修改而不改变或背离它们的范围、意图或功能。在上述说明书中使用的术语和表达在本文中用作描述而非限制的术语,并且使用这些术语和表达不旨在排除所示出并描述的特征或其各部分的等效方案,要认识到,本发明只有所附权利要求书来定义和限定。
Claims (21)
1.一种使用设备的旋转半径来确定设备和平台之间错位的方法,其特征在于,所述设备包括能够提供传感器读数的传感器,和计算所述设备航向角度的装置,所述方法包括以下步骤:
a)从所述传感器读数计算所述设备的所述旋转半径;
b)确定所述旋转半径是否为小的旋转半径;
c)通过使用所述旋转半径是否为小的旋转半径的所述确定,识别设备航向角度中的改变是否由所述平台内的所述设备的转向引起,还是由包括所述设备的所述平台的转向引起;且
d)如果所述设备航向角度的改变是因为所述平台内的设备的转向,调整所述错位,并且如果设备航向角度的改变是因为所述平台内的设备的转向,所述设备航向角度中的改变是检测到的错位改变,所述错位改变用于调整错位。
2.如权利要求1所述的方法,其特征在于,所述方法在缺失绝对导航信息中可用。
3.如权利要求1所述的方法,其特征在于,所述方法在绝对导航信息可获得时可用。
4.如权利要求1所述的方法,其特征在于,所述设备包括陀螺仪和加速度计。
5.如权利要求4所述的方法,其特征在于,所述旋转半径的计算使用来自所述陀螺仪和加速度计的读数。
6.如权利要求4所述的方法,其特征在于,所述旋转半径的计算使用来自所述陀螺仪和加速度计的读数的平滑的版本来达成。
7.如权利要求6所述的方法,其特征在于,所述来自所述陀螺仪和加速度计的读数的平滑的版本通过下列技术之一来获得:(i)平均技术,或(ii)滤波技术。
8.如权利要求1所述的方法,其特征在于,进一步包括平滑所计算的旋转半径。
9.如权利要求8所述的方法,其特征在于,平滑所计算的旋转半径通过下列技术之一来获得:(i)平均技术,或(ii)滤波技术。
10.如权利要求1所述的方法,其特征在于,所述旋转半径是否为小的旋转半径的确定使用下列之一:(i)所述旋转半径的计算的值,(ii)所述旋转半径的缓冲历史,(iii)所述旋转半径的平滑版本,或(iv)所述旋转半径的缓冲历史的平滑版本。
11.如权利要求1所述的方法,其特征在于,所述设备航向角度中的所述改变是否由所述平台内的设备的转向引起,还是由包括所述设备的所述平台的转向引起的确定使用下列信息之一:(i)单独的所述旋转半径,或(ii)所述旋转半径和从所述传感器读数获得的其他信息。
12.如权利要求4所述的方法,其特征在于,所述设备航向角度中的所述改变是否由所述平台内的设备的转向引起,还是由包括所述设备的所述平台的转向引起的确定使用下列信息之一:(i)单独的所述旋转半径,或(ii)所述旋转半径和所述陀螺仪读数的大小。
13.如权利要求1、5、6、8、10、11或12所述的方法,其特征在于,所述方法进一步包括确定所检测的错位改变是否为合理的。
14.如权利要求13所述的方法,其特征在于,所述方法进一步包括确定所检测的错位改变是否为噪声,并且防范此检测的错位改变。
15.如权利要求13所述的方法,其特征在于,所述方法进一步包括确定所检测的错位改变是否为来自先前检测的错位改变的多余的检测,并且防范此检测的错位改变。
16.如权利要求1、5、6、8、10、11、或12所述的方法,其特征在于,所述方法进一步包括将根据所述方法确定的错位与用来确定所述设备和所述平台之间的错位的一种或更多种其他方法结合。
17.如权利要求13所述的方法,其特征在于,所述方法进一步包括将根据所述方法确定的错位与用来确定所述设备和所述平台之间的错位的一种或更多种其他方法结合。
18.一种拥有在平台内约束或非约束移动性的设备,所述设备包括:
a.能够提供传感器读数的传感器;和
b.至少一个处理器,所述处理器被耦合成接收来自所述传感器的读数,并且可操作以确定所述设备和所述平台之间的错位,其中所述处理器可操作以:
i)从所述传感器读数计算所述设备的旋转半径;
ii)确定所述旋转半径是否为小的旋转半径;
iii)使用所述旋转半径是否为小的半径的所述确定来识别设备航向角度中的改变是否由所述平台内的所述设备的转向引起,还是由包括所述设备的所述平台的转向引起;且
iv)如果所述设备航向角度的改变是因为所述平台内的设备的转向,调整所述错位,并且如果设备航向角度的改变是因为所述平台内的设备的转向,所述设备航向角度中的改变是检测到的错位改变,所述错位改变用于调整错位。
19.如权利要求18所述的设备,其特征在于,所述处理器在缺失绝对导航信息中操作。
20.如权利要求18所述的设备,其特征在于,所述处理器在绝对导航信息可获得时操作。
21.如权利要求18所述的设备,其特征在于,所述设备包括陀螺仪和加速度计。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US201361878336P | 2013-09-16 | 2013-09-16 | |
US61/878,336 | 2013-09-16 | ||
PCT/CA2014/000670 WO2015035497A1 (en) | 2013-09-16 | 2014-09-08 | Method and apparatus for determination of misalignment between device and vessel using radius of rotation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105874352A CN105874352A (zh) | 2016-08-17 |
CN105874352B true CN105874352B (zh) | 2018-12-14 |
Family
ID=52664868
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201480062288.3A Active CN105874352B (zh) | 2013-09-16 | 2014-09-08 | 使用旋转半径确定设备与船只之间的错位的方法和装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US10274317B2 (zh) |
EP (1) | EP3047303A4 (zh) |
CN (1) | CN105874352B (zh) |
WO (1) | WO2015035497A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015039215A1 (en) * | 2013-09-17 | 2015-03-26 | Invensense, Inc. | Method and apparatus for determination of misalignment between device and pedestrian using vision |
US10652696B2 (en) * | 2014-07-30 | 2020-05-12 | Trusted Positioning, Inc. | Method and apparatus for categorizing device use case for on foot motion using motion sensor data |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101711364A (zh) * | 2007-04-13 | 2010-05-19 | 领航网络有限公司 | 确定移动物体的旋转半径的力传感设备和方法 |
WO2013037034A1 (en) * | 2011-09-14 | 2013-03-21 | Trusted Positioning Inc. | Method and apparatus for navigation with nonlinear models |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3432856A (en) * | 1967-07-17 | 1969-03-11 | Singer General Precision | Doppler inertial navigation system |
US3936947A (en) * | 1972-10-24 | 1976-02-10 | Lear Siegler, Inc. | Rotating arm aiming device system |
US4070674A (en) * | 1973-10-17 | 1978-01-24 | The Singer Company | Doppler heading attitude reference system |
US6697736B2 (en) * | 2002-02-06 | 2004-02-24 | American Gnc Corporation | Positioning and navigation method and system thereof |
US7206716B2 (en) * | 2003-06-11 | 2007-04-17 | Snap-On Incorporated | Wheel alignment with surface-oriented runout determination |
US7756670B2 (en) * | 2003-10-31 | 2010-07-13 | Pirelli Pneumatici S.P.A. | Method and a system for determining the roughness of a tyre rolling surface |
US8086405B2 (en) * | 2007-06-28 | 2011-12-27 | Sirf Technology Holdings, Inc. | Compensation for mounting misalignment of a navigation device |
US20100318257A1 (en) * | 2009-06-15 | 2010-12-16 | Deep Kalinadhabhotla | Method and system for automatically calibrating a three-axis accelerometer device |
US8781737B2 (en) * | 2009-11-20 | 2014-07-15 | Qualcomm Incorporated | Spatial alignment determination for an inertial measurement unit (IMU) |
US8843290B2 (en) * | 2010-07-22 | 2014-09-23 | Qualcomm Incorporated | Apparatus and methods for calibrating dynamic parameters of a vehicle navigation system |
JP6094026B2 (ja) * | 2011-03-02 | 2017-03-15 | セイコーエプソン株式会社 | 姿勢判定方法、位置算出方法及び姿勢判定装置 |
CA2769788C (en) * | 2011-03-23 | 2019-08-13 | Trusted Positioning Inc. | Methods of attitude and misalignment estimation for constraint free portable navigation |
US8917203B2 (en) * | 2011-06-21 | 2014-12-23 | Honeywell International Inc. | Motion-based adaptive frequency estimation of a doppler velocity sensor |
US9151613B2 (en) * | 2011-08-12 | 2015-10-06 | Qualcomm Incorporated | Methods and apparatus for detecting, measuring, and mitigating effects of moving an inertial navigation device's cradle |
WO2014065693A1 (en) * | 2012-10-26 | 2014-05-01 | Nagornov Vladimir Vladimirovich | Method and system for determining vehicle wheel alignment |
US9714955B2 (en) * | 2012-11-02 | 2017-07-25 | Qualcomm Incorporated | Method for aligning a mobile device surface with the coordinate system of a sensor |
-
2014
- 2014-09-08 US US14/917,730 patent/US10274317B2/en active Active
- 2014-09-08 EP EP14843897.1A patent/EP3047303A4/en not_active Withdrawn
- 2014-09-08 WO PCT/CA2014/000670 patent/WO2015035497A1/en active Application Filing
- 2014-09-08 CN CN201480062288.3A patent/CN105874352B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101711364A (zh) * | 2007-04-13 | 2010-05-19 | 领航网络有限公司 | 确定移动物体的旋转半径的力传感设备和方法 |
WO2013037034A1 (en) * | 2011-09-14 | 2013-03-21 | Trusted Positioning Inc. | Method and apparatus for navigation with nonlinear models |
Also Published As
Publication number | Publication date |
---|---|
EP3047303A1 (en) | 2016-07-27 |
CN105874352A (zh) | 2016-08-17 |
US20160216112A1 (en) | 2016-07-28 |
US10274317B2 (en) | 2019-04-30 |
EP3047303A4 (en) | 2017-05-03 |
WO2015035497A1 (en) | 2015-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105723240B (zh) | 用加速度/减速度确定设备和船只间的错位的方法和装置 | |
US20230041831A1 (en) | Methods of attitude and misalignment estimation for constraint free portable navigation | |
US10788830B2 (en) | Systems and methods for determining a vehicle position | |
JP7133903B2 (ja) | マルチパス平滑化のための方法およびシステム | |
US10228252B2 (en) | Method and apparatus for using multiple filters for enhanced portable navigation | |
CN104729506A (zh) | 一种视觉信息辅助的无人机自主导航定位方法 | |
US11875519B2 (en) | Method and system for positioning using optical sensor and motion sensors | |
WO2013037034A1 (en) | Method and apparatus for navigation with nonlinear models | |
US10054442B2 (en) | Method and apparatus for handling vertical orientations of devices for constraint free portable navigation | |
US10132915B2 (en) | System and method for integrated navigation with wireless dynamic online models | |
Mu et al. | A GNSS/INS-integrated system for an arbitrarily mounted land vehicle navigation device | |
WO2015035501A1 (en) | System and method for enhanced integrated navigation with wireless angle of arrival | |
CN105874352B (zh) | 使用旋转半径确定设备与船只之间的错位的方法和装置 | |
EP3211371B1 (en) | Method and system for multiple pass smoothing | |
US20230115602A1 (en) | Methods and Systems for Determining a Position and an Acceleration of a Vehicle | |
Syed et al. | Trusted portable navigator for environment and user independent positioning | |
CN116625359A (zh) | 一种自适应融合单频rtk的视觉惯性定位方法和设备 | |
EP4196747A1 (en) | Method and system for positioning using optical sensor and motion sensors |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |