亚星游戏官网-www.yaxin868.com

专利名称：移动状态检测装置的制作方法
技术领域：
本发明涉及一种移动状态检测装置，该移动状态检测装置设置在移动体上，检测该移动体的速度或俯仰角等移动状态。
背景技术：
当前，正在设计各种导航装置，该导航装置安装在汽车等移动体上，检测该移动体的位置、行驶速度及行驶方位，并显示对向目的地的行驶进行援助的信息。并且，在这样的导航装置中，基于来自GPS卫星等定位卫星的定位信号检测自装置位置，且利用移动体原有的速度信息如汽车的车速脉冲或通过陀螺传感器等得到的方位信息一直检测移动体的移动状态。不过，最近，也正在设计各种与事先设置在上述那样的移动体上、能取得移动体的速度信息等的导航装置不同，能通过导航装置自机取得速度信息等来执行导航的因比较小型而能携带的个人导航装置。然后，通过在移动体上设置这样的个人导航装置，即使原来在移动体上没有安装导航装置，也能利用导航系统。利用这样的个人导航装置时，因为向移动体的安装角度即个人导航装置内的加速度传感器的向移动体的安装角度，有时不能准确地取得移动体的行驶速度或行驶方位，而难以准确地执行导航。因此，设置如专利文献1、2所示的安装角度算出装置，算出加速度传感器的安装角度，来一直校正加速度。[现有技术文献][专利文献][专利文献1]日本特开2007-107951号公报[专利文献2]日本特开2009-14732号公报[发明概要][发明要解决的课题]但是，在上述的专利文献1，2示出的安装角度算出装置中，并非只通过加速度传感器的输出值检测安装角度，还利用来自陀螺传感器或角速度传感器的角速度或从上述的移动体得到的车速脉冲等。此外，从/向加速度传感器输出的加速度含有偏置成分或噪音成分等无用成分但并没有考虑这些。从而，因为利用含有偏置成分或噪音成分所引起的误差的加速度来算出安装角度，所以不能高精度地算出安装角度。因此，不能高精度地校正来自加速度传感器的加速度，难以准确地取得移动体的行驶速度或行驶方位。

发明内容
本发明的目的在于实现一种移动状态检测装置，该移动状态检测装置能除去从加速度传感器输出的加速度所含的偏置成分或噪音成分等无用成分引起的影响，能高精度地算出加速度传感器的安装角度，能高精度地校正来自该加速度传感器的加速度。[解决课题的手段]
本发明的移动状态检测装置具备加速度传感器与加速度校正部。加速度传感器设置在移动体上，检测该移动体的加速度。加速度校正部按照频带分解从该加速度传感器得到的加速度，基于由规定频带成分组成的重力频率成分及运动加速度频率成分推算所述加速度传感器的安装角度，并基于该安装角度校正加速度。更具体而言，本发明的移动状态检测装置具备加速度传感器与加速度校正部。加速度传感器设置在移动体上，检测该移动体的加速度。加速度校正部从低频侧依次按照频带将从加速度传感器得到的加速度分解成偏置频率成分、重力频率成分、运动加速度频率成分及噪音频率成分，基于重力频率成分及运动加速度频率成分推算加速度传感器的安装角度，并基于该安装角度校正加速度。在该构成中，按照频率成分分解通过加速度传感器得到的加速度。在此，偏置频率成分是与移动体的移动状态无关而大致稳定地输出的成分，由极低频组成。噪音频率成分是与移动体的移动状态无关而随机持续变化的成分，由高频组成。然后，与这些相别，重力频率成分及运动加速度频率成分依存于移动体的移动状态，因为与偏置频率成分相比变化大，所以与偏置频率成分相比为高频率成分，因为没有噪音频率成分那样的随机性，所以与噪音频率成分相比为低频率成分。因此，通过按照频率成分分解加速度，能除去不依存于移动体的移动状态的、含有偏置频率成分或噪音频率成分的无用成分。据此，能取得只由依存于移动体的移动状态的重力频率成分及运动加速度频率成分组成的准确的加速度。此外，本发明的移动状态检测装置的加速度校正部通过小波变换对所述加速度进行频率分解。在该构成中，为取得加速度的各频率成分采用小波变换，所以不仅能得到在频率轴上展开的各频率成分，也能直观地取得各频率成分在时间轴上的变化状态等。此外，本发明的移动状态检测装置的加速度传感器按照分别正交的前后方向加速度成分、横方向加速度成分及上下方向加速度成分检测加速度成分。加速度校正部执行以下推算中的至少一个通过前后方向加速度成分与横方向加速度成分推算方位方向安装角度，通过前后方向加速度成分与上下方向加速度成分推算俯仰方向安装角度，通过前后方向加速度成分、横方向加速度成分及上下方向加速度成分与俯仰方向安装角度推算横滚方向安装角度。此外，本发明的移动状态检测装置的加速度传感器按照分别正交的前后方向加速度成分、横方向加速度成分及上下方向加速度成分检测加速度成分。加速度校正部通过前后方向加速度成分与横方向加速度成分推算方位方向安装角度，通过前后方向加速度成分与上下方向加速度成分推算俯仰方向安装角度，通过前后方向加速度成分、横方向加速度成分及上下方向加速度成分与俯仰方向安装角度推算横滚方向安装角度。在这些构成中，示出具体地取得正交的3轴的加速度成分来推算算出加速度传感器的立体的安装角度的情况。此外，横方向加速度成分不足规定阈值时，本发明的移动状态检测装置的加速度校正部推算方位方向安装角度、俯仰方向安装角度中的至少一个。此外，横方向加速度成分不足规定阈值时，本发明的移动状态检测装置的加速度校正部推算方位方向安装角度及俯仰方向安装角度。此外，横方向加速度成分是规定阈值以上时，本发明的移动状态检测装置的加速度校正部推算横滚方向安装角度。在这些构成中，示出了安装角度算出的具体的方法，根据基于横方向加速度成分的移动体的移动状态的变化，推算方位方向安装角度、俯仰方向安装角度、横滚方向安装角度。此外，本发明的移动状态检测装置的加速度校正部依次存储推算的安装角度，且通过时间平均处理算出安装角度。此时，本次推算的安装角度相对于紧前推算的安装角度变化规定角度以上时，加速度校正部降低时间平均处理中的过去的安装角度的权重。在该构成中，通过执行时间平均处理，抑制推算的安装角度的误差成分。比如，若是在普通的城镇地面等行驶的车辆，大部分的行驶路径是平坦地面，所以通过时间平均处理抑制上坡或下坡时推算的受倾斜角的影响的安装角度引起的误差成分。据此，能更高精度地计算安装角度。此外，因用户强制地变更安装角度的情况等，若安装角度变化大，则能抑制过去推算出的安装角度的影响。此外，本发明的移动状态检测装置具备速度/行驶角算出部，该速度/行驶角算出部基于通过加速度校正部校正的加速度，计算移动体的速度、上下方向倾斜角即行驶俯仰角中的至少一个。在该构成中，示出了移动状态检测装置的具体的构成例，根据如上述高精度地取得的移动体的加速度，能高精度地算出移动体的速度或行驶角。此外，本发明的移动状态检测装置的速度/行驶角算出部算出行驶俯仰角时，算出用重力频率成分除以重力加速度而得到的值，通过该值校正算出了的行驶俯仰角。在该构成中，采用上述的时间平均处理时，有可能产生该时间平均处理引起的累计误差。因此，通过以只根据加速度传感器的加速度的重力频率成分与重力加速度得到的行驶俯仰角，校正根据时间平均处理得到的行驶俯仰角，能抑制上述的累计误差，持续地算出高精度的行驶俯仰角。此外，本发明的移动状态检测装置具备停止检测部，噪音频率成分被算出时，该停止检测部检测出运动加速度频率成分及噪音频率成分的和不足规定阈值来检测到移动体的停止。在该构成中，作为上述的移动体的移动状态的一状态能准确地检测停止状态。此外，本发明的一种导航装置，具备上述的移动状态检测装置，基于该移动状态检测装置算出的与所述移动体的移动相关的信息执行自装置的位置或导航处理。在该构成中，因能如上述通过移动状态检测装置取得高精度的加速度或速度、行驶俯仰角，利用它们能执行准确的导航处理。[发明的效果]根据本发明，通过按照频率成分来分解，能高精度地取得加速度，所以能高精度地算出加速度传感器的安装角度，高精度地校正加速度。据此，能高精度地检测移动体的速度或行驶角。


[图1]是表示第1实施方式的移动状态检测装置1的主要构成的框图。[图2]是说明加速度传感器20相对于移动体的安装角度的图。
60040][图3]是表示本实施方式的构成与以往的构成引起的上下方向的加速度的变化的坐标图。[图4]是表示第2实施方式的移动状态检测装置1’的主要构成的框图。[图5]是表示第3实施方式的移动状态检测装置100的主要构成的框图。
具体实施例方式对照

本发明的第1实施方式所涉及的移动状态检测装置。本实施方式所涉及的移动状态检测装置利用在车载用导航装置或PND(PerSOnal Navigation Device)等各种导航装置上。图1是表示本实施方式的移动状态检测装置1的主要构成的框图。如图1所示，移动状态检测装置1具备加速度传感器20、加速度校正部10、速度/ 行驶角算出部30，固定设置在车辆等移动体上。另外，本实施方式的移动状态检测装置1检测移动体的速度及行驶角(行驶俯仰角、行驶横滚角、行驶方位角(偏航角))，但例如，若是只输出移动体的加速度，则可省略速度/行驶角算出部30。加速度传感器20在自身的坐标系(传感器坐标系)中，检测由与移动体的前后方向即χ轴方向对应的加速度成分<、与移动体的横方向即y轴方向对应的加速度成分<、与移动体的上下方向即ζ轴方向对应的加速度成分<组成的传感器坐标系加速度
r bbb-.。在此，设为相对于移动体，按照由方位方向安装角度△ Ψ、俯仰方向安装角度 Δ θ、横滚方向安装角度Δ φ构成的安装角度[Δ Ψ, Δ θ , Δ Φ]来安装加速度传感器20。 而且，安装角度[Δ ψ，Δ θ，Δ φ]以图2所示的坐标系为基准。图2是说明移动体的坐标系的图。如图2所示，移动体的坐标系是由以移动体的前后方向为轴方向的χ轴、以移动体的横方向为轴方向的y轴、以移动体的上下方向为轴方向的ζ轴构成的正交3轴的坐标系。 而且，将以χ轴为中心轴进行转动的方向设为横滚角(Φ)方向，将以y轴为中心轴进行转动的方向设为俯仰角(θ)方向，将以ζ轴为中心轴进行转动的方向设为方位角(ν)方向。如此，相对于移动体按照安装角度[Δ ψ，Δ θ，Δ φ]来安装加速度传感器20，所以从加速度传感器20输出的传感器坐标系加速度[<，a； m丨]的各成分与移动体坐标系加速度[<，a；, a〖]的各成分之间，产生与基于安装角度[Δ ψ，Δ θ，Δ φ]的立体角相应的差。加速度校正部10具备频率解析部11、安装角度推算部12、校正演算部13。频率解析部11通过小波变换将传感器坐标系加速度[<，a；，变换成频率轴上的加速度成分组。更具体而言，频率解析部11例如每1秒取得传感器坐标系加速度 [<，a；, a〖]，并存储64秒量，基于这64秒量的数据执行小波变换。于是，频率解析部11 取得与64秒的采样期间对应的大致稳定成分(DC成分)、与32秒的采样期间对应的变化成分(AC成分)、与16秒的采样期间对应的变化成分(AC成分)、与8秒的采样期间对应的变化成分(AC成分)、与4秒的采样期间对应的变化成分(AC成分)、与2秒的采样期间对应的变化成分(AC成分)、与1秒的采样期间对应的变化成分(AC成分)。
频率解析部11设定取得的极低频带频率的64秒宽DC成分为偏置频率成分，设定中频带频率的32秒宽AC成分及16秒宽AC成分为重力频率成分，设定中频带频率的8秒宽AC成分、4秒宽AC成分及2秒宽AC成分为运动加速度频率成分，设定1秒宽AC成分为噪音频率成分。通过下面所示原理能设定这些。首先，因为在64秒宽得到的DC成分能看做是不依存于移动体的移动状态的、加速度传感器20大致稳定地输出的成分。接着，在32秒宽或16秒宽得到的AC成分虽依存于移动体的移动状态，但影响较低，能看做是与移动体的运动加速度相比易依存于在移动体上所产生的重力的成分。接着，在8秒宽、4秒宽及2秒宽得到的AC成分是易带给移动体的移动状态大影响的成分，能看做是与稳定地一直产生的重力加速度相比易依存于移动体的运动加速度的成分。接着，在1秒宽得到的AC成分能看做是与移动体的运动加速度相比包含更多随机性的成分。频率解析部11将通过小波变换得到的重力频率成分与运动加速度频率成分的和
作为检测用加速度[
安装角度推算部12根据检测用加速度[
X(AG)
y(AG) ‘ ^z(AG)
]，向安装角度推算部12及校正演算部13输出。
]推算出安装角度
X(AG)
y(AG)， ^z(AG)。该安装角度的推算可根据上述的传感器坐标系加速度的取得定时，例如可按照每1秒来进行。此外，可边缓冲传感器坐标系加速度的各频率成分，边按照适当地设定的定时进行。在此，就安装角度[Δ ψ，Δ θ，Δ φ]的推算算出原理加以说明。设定传感器坐标系加速度[<，<，、移动体坐标系加速度[<，a；, <]、安装角度[Δ ψ，Δ θ，Δ φ]
的情况下，下式成立。[数式1]
(1)C〖是将移动体坐标系变换成加速度传感器坐标系的旋转矩阵，利用安装角度 [Δ ψ, Δ θ , Δ φ]能用下式表示。[数式2]
权利要求
1.一种移动状态检测装置，具备，加速度传感器，该加速度传感器设置在移动体上；加速度校正部，该加速度校正部按照频带分解从该加速度传感器得到的加速度，基于由规定频带成分组成的重力频率成分及运动加速度频率成分推算所述加速度传感器的安装角度，并基于该安装角度校正所述加速度。
2.如权利要求1所述的移动状态检测装置，所述加速度校正部将从该加速度传感器得到的加速度按照频带分解成偏置频率成分、 所述重力频率成分、所述运动加速度频率成分及噪音频率成分，基于所述重力频率成分及所述运动加速度频率成分推算所述加速度传感器的安装角度，并基于该安装角度校正所述加速度。
3.如权利要求1或2所述的移动状态检测装置，所述加速度校正部通过小波变换对所述加速度进行频率分解。
4.如权利要求1或3所述的移动状态检测装置，所述加速度传感器按照分别正交的前后方向加速度成分、横方向加速度成分及上下方向加速度成分检测加速度成分；所述加速度校正部执行以下推算中的至少一个通过所述前后方向加速度成分与所述横方向加速度成分推算方位方向安装角度，通过所述前后方向加速度成分与所述上下方向加速度成分推算俯仰方向安装角度，通过所述前后方向加速度成分、所述横方向加速度成分及所述上下方向加速度成分与所述俯仰方向安装角度推算横滚方向安装角度。
5.如权利要求1 3中任一项所述的移动状态检测装置，所述加速度传感器按照分别正交的前后方向加速度成分、横方向加速度成分及上下方向加速度成分检测加速度成分；所述加速度校正部通过所述前后方向加速度成分与所述横方向加速度成分推算方位方向安装角度，通过所述前后方向加速度成分与所述上下方向加速度成分推算俯仰方向安装角度，通过所述前后方向加速度成分、所述横方向加速度成分及所述上下方向加速度成分与所述俯仰方向安装角度推算横滚方向安装角度。
6.如权利要求4所述的移动状态检测装置，所述横方向加速度成分不足规定阈值时，所述加速度校正部推算所述方位方向安装角度、所述俯仰方向安装角度中的至少一个。
7.如权利要求5所述的移动状态检测装置，所述横方向加速度成分不足规定阈值时，所述加速度校正部推算所述方位方向安装角度及所述俯仰方向安装角度。
8.如权利要求4 7中任一项所述的移动状态检测装置，所述横方向加速度成分是所述规定阈值以上时，所述加速度校正部推算所述横滚方向安装角度。
9.如权利要求1 8中任一项所述的移动状态检测装置，所述加速度校正部依次存储推算的所述安装角度，且通过时间平均处理算出所述安装角度；本次推算的安装角度相对于紧前推算的安装角度变化规定角度以上时，降低所述时间平均处理中的过去的安装角度的权重。
10.如权利要求1 9中任一项所述的移动状态检测装置，具备速度/行驶角算出部，该速度/行驶角算出部基于通过所述加速度校正部校正的加速度，算出所述移动体的速度、上下方向倾斜角即行驶俯仰角中的至少一个。
11.如权利要求10所述的移动状态检测装置，所述速度/行驶角算出部算出所述行驶俯仰角时，算出用所述重力频率成分除以重力加速度而得到的值，通过该值校正算出了的行驶俯仰角。
12.如权利要求2 11中任一项所述的移动状态检测装置，具备停止检测部，所述噪音频率成分被算出时，该停止检测部检测出所述运动加速度频率成分及所述噪音频率成分的和不足规定阈值来检测到所述移动体的停止。
13.一种导航装置，具备权利要求1 权利要求12的任一项所述的移动状态检测装置， 该导航装置基于该移动状态检测装置算出的与所述移动体的移动相关的信息执行自装置的位置或导航处理。
全文摘要
高精度地算出加速度传感器的安装角度，并高精度地校正来自该加速度传感器的加速度。加速度校正部(10)的频率解析部(11)对来自加速度传感器(20)的传感器坐标系加速度进行小波变换，分解成偏置频率成分、重力频率成分、运动加速度频率成分及噪音频率成分。频率解析部(11)只将重力频率成分与运动加速度频率成分的和成分输出给安装角度推算部(12)及校正演算部(13)。安装角度推算部(12)基于只由重力频率成分与运动加速度频率成分的和成分组成的加速度，推算出加速度传感器(20)的安装角度输出给校正演算部(13)。校正演算部(13)通过用推算出的安装角度校正只由重力频率成分与运动加速度频率成分的和成分组成的加速度，算出并输出移动体坐标系加速度。
文档编号G01P21/00GK102422166SQ201080020698
公开日2012年4月18日 申请日期2010年4月19日 优先权日2009年5月19日
发明者吉武剑, 户田裕行 申请人:古野电气株式会社