CN101443628B - 具有倾斜角推定机构的移动体 - Google Patents
具有倾斜角推定机构的移动体 Download PDFInfo
- Publication number
- CN101443628B CN101443628B CN2007800175536A CN200780017553A CN101443628B CN 101443628 B CN101443628 B CN 101443628B CN 2007800175536 A CN2007800175536 A CN 2007800175536A CN 200780017553 A CN200780017553 A CN 200780017553A CN 101443628 B CN101443628 B CN 101443628B
- Authority
- CN
- China
- Prior art keywords
- tilt angle
- estimating
- acceleration
- mrow
- sensor
- 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.)
- Expired - Fee Related
Links
- 230000001133 acceleration Effects 0.000 claims abstract description 63
- 238000000034 method Methods 0.000 description 12
- 238000010586 diagram Methods 0.000 description 3
- 230000005484 gravity Effects 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000002542 deteriorative effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant 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
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
- G01C9/02—Details
- G01C9/06—Electric or photoelectric indication or reading means
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Motorcycle And Bicycle Frame (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供一种具有能够高精度地推定出车身倾斜角度的倾斜角推定机构的移动体。本发明的移动体包括:加速度传感器,检测二轴方向上的加速度;陀螺传感器,检测车身的角速度;以及倾斜角推定机构,推定车身的倾斜角。该倾斜角推定机构具有:根据加速度传感器检测出的加速度来推定与加速度传感器相应的倾斜角的单元;根据所述陀螺传感器检测出的角速度来推定第二倾斜角的单元;以及根据通过加速度传感器得到的倾斜角和通过陀螺传感器得到的倾斜角,将移动体的线性模型方程作为观察器来推定倾斜角的单元。
Description
技术领域
本发明涉及具有倾斜角推定机构的移动体,特别涉及具有倾斜角推定机构的倒立两轮型车辆。
背景技术
在倒立两轮型车辆这样的移动体中,为了维持倒立姿势而需要高精度地推定出倾斜角度。这不仅限于两轮型车辆,即使在步行型移动体或履带驱动的移动体中,也要求高精度地推定出倾斜角度。
以往,作为推定倾斜角的机构而有使用陀螺(角速度)传感器的方式或使用加速度传感器的方式。在使用陀螺传感器的方式中,可以通过对陀螺传感器的输出信号进行积分而求出倾斜角度,但是在陀螺传感器的输出信号上原本就重叠有偏移噪声(offset noise),因此存在着相对于真值偏差逐渐变大的问题。
在使用加速度传感器的方式中,使用通过二轴以上的加速度传感器得到的几何学关系来计算倾斜角度。根据该方式,由于根据二轴重力加速度的值来计算倾斜角度,因此存在着如果不是静止的状态则推定精度会变差的问题。特别是在移动体进行了加减速的情况下,由于加减速而产生的成分会作为噪声而重叠在二轴加速度传感器上。
另外,还提出了使用陀螺传感器和三轴加速度传感器并通过自动惯性导航(INS,惯性导航系统)来推定倾斜角度的方式。但是,无法解决上述陀螺传感器中的偏移噪声的问题和加速度传感器中的由于加减速而产生的噪声的问题。
另外,专利文献1公开了按照每个频带切换使用陀螺传感器和加速度计的技术,但这不是与具有倾斜角推定机构的移动体相关的技术。
专利文献1:日本专利文献特开平4—346021号公报。
发明内容
发明所要解决的问题
如上所述,虽然能够通过使用陀螺传感器和加速度传感器求出车身倾斜角度,但是在精度上存在问题。
本发明是为了解决上述问题而完成的,其目的在于提供一种具有能够高精度地推定出车身倾斜角度的倾斜角推定机构的移动体。
用于解决问题的手段
本发明的移动体包括:加速度传感器,检测二轴方向上的加速度;陀螺传感器,检测车身的角速度;以及倾斜角推定机构,推定车身的倾斜角;其中,该倾斜角推定机构具有:根据所述加速度传感器检测出的加速度来推定第一倾斜角的单元;按照所述移动体的线性模型方程并根据所述陀螺传感器检测出的角速度来推定第二倾斜角的单元;以及通过将所述第一倾斜角作为观察器的参照值并进行反馈控制以使所述第二倾斜角追随所述第一倾斜角来推定倾斜角的单元。
这里,优选的是,所述倾斜角推定机构具有将用于调整所述第一倾斜角的影响的观察器增益K设定为任意值的设定单元。
另外,优选的是,所述设定单元在移动体处于前后加速状态的情况下将所述观察器增益K设定为小的值。
另外,优选的是,所述设定单元根据加速度传感器和陀螺传感器的故障状态来设定该观察器增益K。
另外,优选的是,在所述加速度传感器的后级设置有低通滤波器。
优选实施方式中的移动体是倒立两轮型车辆。
发明的效果
根据本发明,可以提供一种具有能够高精度地推定出车身倾斜角度的倾斜角推定机构的移动体。
附图说明
图1是用于说明本发明实施方式的移动体的传感器座标系的图;
图2是表示本发明实施方式的移动体的倾斜角推定方法的框图;
图3是表示本发明实施方式的移动体的倾斜角推定方法的流程图;
图4是表示本发明实施方式的移动体的倾斜角推定方法的流程图。
标号说明:
1车身
2车轮
10移动体
具体实施方式
图1表示了本发明的具有倾斜角推定机构的移动体的传感器座标系。如图1所示,该移动体10具有车身1和经由未图示的驱动机构而固定在车身1上的车轮2。
将与该移动体10的前方(即,移动方向、倾斜(pitch)方向)正交并沿近似水平方向(即,侧倾(roll)方向)延伸的轴作为X轴,将该移动体10的前方(即,移动方向、倾斜方向)作为Y轴,将铅垂方向作为Z轴。在本例中,将连结车身1和车轮2的旋转中心的线与Z轴所成的角度作为车身倾斜角。
移动体10包括测量Y轴方向和Z轴方向上的加速度的加速度传感器和设置在其后级的截止频率低的低通滤波器。可以根据由这两个加速度传感器检测出的Y轴方向和Z轴方向上的加速度u(1)、u(2),按照下式求出车身倾斜角(即,倾角(pitch angle))η。
η=tan-1(u(1)/u(2))···(1)
另外,该移动体10包括测量X轴方向上的角速度的单轴陀螺传感器(角速度传感器)。并且,在移动体10中,通过计算机来实现输入加速度传感器和陀螺传感器的检测信号和控制信号并推定(计算)出车身倾斜角的倾斜角推定机构。
该倾斜角推定机构包括:根据加速度传感器检测出的加速度来推定倾斜角的单元;根据陀螺传感器检测出的角速度来推定倾斜角的单元;以及根据通过加速度传感器得到的倾斜角和通过陀螺传感器得到的倾斜角并将移动体的线性模型方程(linear model equation)作为观察器来推定倾斜角的单元。此时,推定倾斜角的单元将通过陀螺传感器得到的倾斜角作为观察器的参照值,并按照使推定值反馈追随通过陀螺传感器得到的倾斜角的方式来进行推定。
图2是用于说明本发明的倾斜角推定处理的框图。如图所示,向I1输入控制信号,向I2输入由Y轴加速度传感器检测出的Y轴方向上的加速度信号,向I3输入由Z轴加速度传感器检测出的Z轴方向上的加速度信号,向I4输入由单轴陀螺传感器检测出的角速度信号。
首先,根据输入给I2的Y轴方向上的加速度和输入给I3的Z轴方向上的加速度,按照上述式(1)以几何学方式计算出车身倾斜角。这里计算出的倾斜角对于直流(DC)成分~低频带来说具有高精度,但是由于当伴随着加减速而运动时加速度传感器被施加了噪声,因此对于中频带~高频带来说精度低。
接着,输入控制信号、计算出的车身倾斜角、由陀螺传感器检测出的角速度,并且通过由外力观察器进行的反馈处理最终计算出倾斜角、倾斜角速度、以及外力,分别从O1、O2、O3输出。另外,在图2中,将与外力观察器相关的式y(n)=Cx(n)+Du(n)作为式(2),将x(n+1)=Ax(n)+Bu(n)作为式(3)。
接着,对外力观察器的设计的详细情况进行说明。
首先,对车身倾斜角进行线性模型化。倒立两轮车的车身模型(运动方程式)可以如下来表示。
[数1]
这里,η:车身的倾斜角,θ:车轮的旋转角,m1:车身的质量,m2:车轮的质量,1:车身重心距车轴的距离,J1:关于车身重心的惯性力矩,Jm:马达转子的惯性力矩,Jw:关于车轮轴的惯性力矩,n:齿轮比(马达:车轮=1:n),r:车轮半径,fr:驱动系统的阻力(resistance),u:马达的转矩值。
在上述式(4)、(5)中,由于在本发明中能够推定出车身倾斜角η即可,因此仅考虑式(4)。另外,在求倾斜角速度的情况下利用式(5)。如果通过η来表示式(4)的左边,则成为式(6)。
[数2]
将该式(6)作为基本模型来生成外力观察器。这里,式(6)右边的θ项作为η方程式的外力而发挥作用。在本发明中,如果忽视该θ项,则推定误差会变大,因此为了避免这种情况,构成了将外力f也作为状态量来进行考虑的外力观察器。
下面,对外力观察器的基本模型的导出进行说明。现在,通过下式(7)来表示状态量。
[数3]
这里,f为外力。
当使用式7表示的状态量将式6转换成状态方程式表示方式时,可以表示成下式(8)、(9)。
[数4]
M=m1l2+J1+n2Jm
这里,对于外力f来说,在采样周期的期间内为取恒定值的阶跃(stepwise)状,该期间的微分值为0。
下面,对外力观察器的增益的确定方法进行说明。
外力观察器可以通过下式(10)来表示。
K:观测器增益
对于式(10)中的观察器增益(反馈增益)K来说,针对各个状态量η、η点、f而分别设定为K1、K2、K3。根据式(10)中的观察器增益K的大小来决定推定的收敛速度。即,根据由式(10)求出的特性方程式的极的大小来决定推定的收敛速度。
当K=(K1,K2,K3)时,如果K1大,则接近于通过加速度传感器得到的推定值,如果K2大,则接近于通过陀螺传感器得到的推定值。由于在低频中判断加速度传感器的推定值正确,因此增大K2,在中~高频中增大K2。在能够预先推定出动作频率的情况下,根据该频率来设定K即可。
具体地说,考虑以下(A)、(B)之间的平衡来决定K。
(A)观察器增益K大(极距离实轴远)时
在该情况下,会大大地受到作为加速度传感器输入的观测量的影响。因此,对于推定值来说,使观测量优先,基本模型的影响变小。因此,容易受到传感器噪声的影响。另外,在该情况下,推定的收敛速度变高。
(B)观察器增益K小(极距离实轴近)时
在该情况下,大大地使作为加速度传感器输入的观测量平滑化。换言之,减小观测量的影响。因此,基本上推定值遵照基本模型。因此,难以受到传感器噪声的影响。另外,在该情况下,推定的收敛速度变低。
对于观察器增益K来说,原样输出根据陀螺传感器推定出的倾斜角的高频成分,使低频带和直流成分成为根据加速度传感器推定出的倾斜角,由此能够在从直流成分到高频带的宽的频带中高精度地推定出倾斜角。
在本发明中使用的外力观察器用于推定倾斜角的直流成分,因此其响应可以慢一些。所谓响应慢意味着能够相应地降低噪声,因此能够实现精度更高的推定。另外,由于使其成为响应慢的观察器,因此极设定得比较靠近实轴。
在本发明中,如上所述,与倾斜角对应的运动方程式(模型信息)被利用于外力观察器。根据该模型信息和由单轴陀螺传感器检测出的角速度在中频带~高频带中高精度地推定出倾斜角。并且,在本发明中,不但将根据单轴陀螺传感器推定出的倾斜角作为观察器的参照值,还将根据二轴加速度传感器推定出的倾斜角作为观察器的参照值,进行反馈控制以使推定值追随该参照值。由此,能够在从直流成分到高频带的宽的频带中高精度地推定出倾斜角。另外,对于加速度传感器的噪声来说,通过恰当地设定观察器增益K,能够降低该噪声的影响。
最后通过使设计出的连续系统外力观察器离散化,能够设计外力观察器。
另外,在本发明中,通过控制机构来控制观察器增益K。图3表示了该控制的流程图。首先,控制机构判断由陀螺传感器等检测出的角速度是否处于预先确定的预定范围内(S101)。这里,以角速度为基准的原因在于能够检测出移动体是否处于前后加速状态。因此,在图3所示的例子中根据角速度检测出移动体是否处于前后加速状态,但是不限于此,也可以根据其他参数来检测是否处于该前后加速状态。控制机构在判断出角速度处于预定范围内的情况下,不执行改变观察器增益K的值的控制。
接着,控制机构在判断出角速度不处于预定范围内、即处于预定范围外的情况下,还判断角速度是否比预定范围高(S102)。在判断的结果是控制机构判断出角速度比预定范围高的情况下,执行减小观察器增益K的值的控制(S103)。由此,由于处于前后加速状态而处于加速度传感器容易产生干扰噪声的状态,因此能够降低加速度传感器的影响。
在判断的结果是控制机构判断出角速度不比预定范围高、即比预定范围低的情况下,执行增大观察器K的值的控制(S104)。另外,对于观察器增益K的值的大小的控制来说,也可以选择减小观察器增益K而进行了推定处理的情况下和增大观察器增益K而进行了推定处理的情况下的各自的输出值中的某个输出值。
接下来,对传感器的故障控制进行说明。本发明包括陀螺传感器和加速度传感器,在某个传感器发生了故障的情况下,按照如下方式来进行控制:不执行基于发生了故障的传感器的倾斜角推定,而是仅根据没有发生故障的传感器来执行倾斜角推定。
具体地说,控制机构判断是否通过监视器等检测出了断线或传感器故障等故障(S201)。控制机构在判断为检测出了故障的情况下,判断是否是陀螺传感器的故障(S202)。控制机构在判断出是陀螺传感器的故障的情况下,通过没有发生故障的加速度传感器来推定车身倾斜角(S203)。另一方面,控制机构在判断出不是陀螺传感器的故障的情况下,判断是否是加速度传感器的故障(S204)。在判断的结果是控制机构判断出是加速度传感器的故障的情况下,通过没有发生故障的陀螺传感器来推定车身倾斜角(S205)。控制机构在判断为不是加速度传感器的故障的情况下停止推定处理(S206)。
另外,在本发明中使用了移动体的模型信息,能够提高倾斜角的推定精度。例如,在由于车辆的构造方面的限制而使得倾斜角不会大于等于预定值的情况下,如果推定值超过了该预定值,则在将该推定值限制为该预定值的基础上来进行推定处理,由此真值与推定值的偏差受到了限制,从而能够防止推定精度变差。
另外,在上述例子中移动体10是倒立两轮型的不稳定车辆,但是不限于此,也可以是步行型移动体或履带驱动的移动体。另外,移动体10也可以是搭乘型的移动体,还可以是组装到机器人的下半身的移动体或搭载货物而移动的移动体。
产业上的可利用性
本发明涉及具有倾斜角推定机构的移动体,特别是可以广泛地利用于具有倾斜角推定机构的倒立两轮型车辆。
Claims (6)
1.一种移动体,包括:加速度传感器,检测二轴方向上的加速度;陀螺传感器,检测车身的角速度;以及倾斜角推定机构,推定车身的倾斜角;其中,
该倾斜角推定机构具有:
根据所述加速度传感器检测出的加速度来推定第一倾斜角的单元;
按照所述移动体的线性模型方程并根据所述陀螺传感器检测出的角速度来推定第二倾斜角的单元;以及
通过将所述第一倾斜角作为观察器的参照值并进行反馈控制以使所述第二倾斜角追随所述第一倾斜角来推定倾斜角的单元。
2.如权利要求1所述的移动体,其中,
所述倾斜角推定机构具有将用于调整所述第一倾斜角的影响的观察器增益K设定为任意值的设定单元。
3.如权利要求2所述的移动体,其中,
所述设定单元在移动体处于前后加速状态的情况下减小所述观察器增益K的值。
4.如权利要求2所述的移动体,其中,
所述设定单元根据加速度传感器和陀螺传感器的故障状态来设定该观察器增益K。
5.如权利要求1至4中任一项所述的移动体,其中,
在所述加速度传感器的后级设置有低通滤波器。
6.如权利要求1至4中任一项所述的移动体,其中,
所述移动体是倒立两轮型车辆。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP273622/2006 | 2006-10-05 | ||
JP2006273622A JP4281777B2 (ja) | 2006-10-05 | 2006-10-05 | 傾斜角推定機構を有する移動体 |
PCT/JP2007/069404 WO2008041732A1 (ja) | 2006-10-05 | 2007-09-27 | 傾斜角推定機構を有する移動体 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101443628A CN101443628A (zh) | 2009-05-27 |
CN101443628B true CN101443628B (zh) | 2010-12-08 |
Family
ID=39268585
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2007800175536A Expired - Fee Related CN101443628B (zh) | 2006-10-05 | 2007-09-27 | 具有倾斜角推定机构的移动体 |
Country Status (5)
Country | Link |
---|---|
US (1) | US8000925B2 (zh) |
EP (1) | EP2077432B1 (zh) |
JP (1) | JP4281777B2 (zh) |
CN (1) | CN101443628B (zh) |
WO (1) | WO2008041732A1 (zh) |
Families Citing this family (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102160008B (zh) | 2008-09-17 | 2014-04-30 | 株式会社村田制作所 | 防摔倒控制装置及防摔倒控制方法 |
CN102362233B (zh) * | 2009-01-26 | 2013-11-06 | 爱考斯研究株式会社 | 车辆 |
JP5109990B2 (ja) * | 2009-01-26 | 2012-12-26 | 株式会社エクォス・リサーチ | 車両 |
JP5110009B2 (ja) * | 2009-03-11 | 2012-12-26 | 株式会社エクォス・リサーチ | 車両 |
DE112009005243B4 (de) * | 2009-09-18 | 2020-06-10 | Honda Motor Co., Ltd. | Inverses Pendelfahrzeug |
JP5488095B2 (ja) * | 2010-03-23 | 2014-05-14 | トヨタ自動車株式会社 | 倒立型移動体及びその制御方法 |
US9090214B2 (en) | 2011-01-05 | 2015-07-28 | Orbotix, Inc. | Magnetically coupled accessory for a self-propelled device |
US10281915B2 (en) | 2011-01-05 | 2019-05-07 | Sphero, Inc. | Multi-purposed self-propelled device |
US9429940B2 (en) | 2011-01-05 | 2016-08-30 | Sphero, Inc. | Self propelled device with magnetic coupling |
US8751063B2 (en) | 2011-01-05 | 2014-06-10 | Orbotix, Inc. | Orienting a user interface of a controller for operating a self-propelled device |
US9218316B2 (en) | 2011-01-05 | 2015-12-22 | Sphero, Inc. | Remotely controlling a self-propelled device in a virtualized environment |
WO2012114597A1 (ja) * | 2011-02-23 | 2012-08-30 | 株式会社村田製作所 | 歩行補助車 |
CN102174884B (zh) * | 2011-02-28 | 2013-08-21 | 重庆华渝电气仪表总厂 | 定向陀螺测斜仪点测装置 |
US8548722B2 (en) * | 2011-08-12 | 2013-10-01 | Deere & Company | Tilt sensor and method for determining the tilt of a vehicle |
US9827487B2 (en) | 2012-05-14 | 2017-11-28 | Sphero, Inc. | Interactive augmented reality using a self-propelled device |
WO2013173389A1 (en) | 2012-05-14 | 2013-11-21 | Orbotix, Inc. | Operating a computing device by detecting rounded objects in an image |
US10056791B2 (en) * | 2012-07-13 | 2018-08-21 | Sphero, Inc. | Self-optimizing power transfer |
JP5907037B2 (ja) * | 2012-10-16 | 2016-04-20 | 株式会社豊田中央研究所 | 移動体 |
CN104703871B (zh) * | 2012-10-16 | 2016-12-21 | 丰田自动车株式会社 | 倒立型移动体及其控制方法 |
FR2999699B1 (fr) * | 2012-12-19 | 2015-12-11 | Commissariat Energie Atomique | Procede de determination de l'inclinaison d'un objet |
JP6123906B2 (ja) * | 2013-10-10 | 2017-05-10 | 株式会社村田製作所 | 手押し車 |
US9829882B2 (en) | 2013-12-20 | 2017-11-28 | Sphero, Inc. | Self-propelled device with center of mass drive system |
JP5979322B2 (ja) * | 2013-12-25 | 2016-08-24 | 株式会社村田製作所 | 手押し車 |
CN104296722B (zh) * | 2014-01-07 | 2017-11-14 | 郑州宇通客车股份有限公司 | 车辆侧倾状态检测方法 |
JP5962689B2 (ja) * | 2014-02-14 | 2016-08-03 | トヨタ自動車株式会社 | 自律移動体、及びその故障判定方法 |
JP6187310B2 (ja) * | 2014-02-24 | 2017-08-30 | トヨタ自動車株式会社 | 倒立型移動体 |
KR20170070944A (ko) * | 2015-12-14 | 2017-06-23 | 현대오트론 주식회사 | 가속도 센서 및 자이로 센서를 이용한 차량 피치각 검출 장치 및 그 방법 |
CN105509693B (zh) * | 2015-12-31 | 2018-04-06 | 山东科技大学 | 一种移动式中部溜槽检测装置及其应用 |
US10551407B2 (en) * | 2016-07-29 | 2020-02-04 | Blackberry Limited | Determining an open/close status of a barrier |
CN110514178B (zh) * | 2019-09-03 | 2021-11-26 | 北京源清慧虹信息科技有限公司 | 基于单轴加速度传感器的倾角测量方法和装置 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1576068A (zh) * | 2003-07-03 | 2005-02-09 | 三菱电机株式会社 | 车辆倾翻判别装置及车辆倾翻判别方法 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2653197B2 (ja) | 1989-12-18 | 1997-09-10 | 日産自動車株式会社 | 車両のローリング制御装置 |
JPH0797033B2 (ja) | 1991-05-23 | 1995-10-18 | 日本航空電子工業株式会社 | 静電浮揚起動装置 |
US6581714B1 (en) * | 1993-02-24 | 2003-06-24 | Deka Products Limited Partnership | Steering control of a personal transporter |
US6678631B2 (en) * | 1998-11-19 | 2004-01-13 | Delphi Technologies, Inc. | Vehicle attitude angle estimator and method |
JP2002318274A (ja) | 2001-02-13 | 2002-10-31 | Mazda Motor Corp | 車体運動計測装置、車体運動計測方法及びその方法を記録した記録媒体 |
WO2003016031A1 (en) | 2001-08-16 | 2003-02-27 | Riken | Rapid prototyping method and device using v-cad data |
WO2003090979A1 (fr) | 2002-04-26 | 2003-11-06 | Honda Giken Kogyo Kabushiki Kaisha | Systeme permettant d'estimer l'attitude d'un robot mobile monte sur des jambes |
JP4138546B2 (ja) | 2003-03-26 | 2008-08-27 | トヨタ自動車株式会社 | 移動台車及び移動台車の制御方法 |
US7363993B2 (en) * | 2003-11-04 | 2008-04-29 | Toyota Jidosha Kabushiki Kaisha | Traveling apparatus and method for controlling thereof |
DE10360728A1 (de) | 2003-12-23 | 2005-07-21 | Daimlerchrysler Ag | Verfahren und Vorrichtung zur Bestimmung eines Fahrzeugzustandes |
US7222007B2 (en) * | 2004-01-07 | 2007-05-22 | Ford Global Technologies, Llc | Attitude sensing system for an automotive vehicle relative to the road |
JP4315918B2 (ja) | 2005-02-09 | 2009-08-19 | 株式会社クボタ | 傾斜角度計測装置 |
-
2006
- 2006-10-05 JP JP2006273622A patent/JP4281777B2/ja active Active
-
2007
- 2007-09-27 EP EP07829143.2A patent/EP2077432B1/en not_active Not-in-force
- 2007-09-27 US US12/297,323 patent/US8000925B2/en not_active Expired - Fee Related
- 2007-09-27 WO PCT/JP2007/069404 patent/WO2008041732A1/ja active Application Filing
- 2007-09-27 CN CN2007800175536A patent/CN101443628B/zh not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1576068A (zh) * | 2003-07-03 | 2005-02-09 | 三菱电机株式会社 | 车辆倾翻判别装置及车辆倾翻判别方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2008089531A (ja) | 2008-04-17 |
CN101443628A (zh) | 2009-05-27 |
WO2008041732A1 (ja) | 2008-04-10 |
JP4281777B2 (ja) | 2009-06-17 |
US8000925B2 (en) | 2011-08-16 |
WO2008041732A8 (ja) | 2008-07-03 |
EP2077432B1 (en) | 2014-03-19 |
EP2077432A4 (en) | 2012-11-14 |
EP2077432A1 (en) | 2009-07-08 |
US20090138232A1 (en) | 2009-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101443628B (zh) | 具有倾斜角推定机构的移动体 | |
US9630672B2 (en) | Roll angle estimation device and transport equipment | |
JP6153493B2 (ja) | ロール角推定装置および輸送機器 | |
JP4760162B2 (ja) | 移動台車の制御方法及び移動台車 | |
CN101417654B (zh) | 用于估计车辆状态以便避免倾翻的系统 | |
US8457832B2 (en) | Vehicle body speed estimating device | |
EP1806560A1 (en) | Angular velocity sensor unit and angular velocity sensor diagnosing device | |
CN102782506B (zh) | 车辆状态检测装置及车辆状态检测系统 | |
JP2007182209A (ja) | 車両物理量推定装置及びプロブラム | |
US9771102B2 (en) | Steer-by-wire steering reaction force control device | |
EP2972773A2 (en) | System and method for inertial sensor offset compensation | |
JP2009073466A (ja) | 車両姿勢角推定装置及びプログラム | |
US10919358B2 (en) | Attitude estimation apparatus and transportation machine | |
CN110346824A (zh) | 一种车辆导航方法、系统、装置及可读存储介质 | |
CN108290553B (zh) | 车辆运动检测设备 | |
JP2019189121A (ja) | 車両状態推定装置 | |
JP5137792B2 (ja) | 車両横力外乱推定装置 | |
KR20130099672A (ko) | 퍼지 추론 시스템 및 그 방법 | |
JP5907037B2 (ja) | 移動体 | |
JP5240365B2 (ja) | 移動方向制御装置及びコンピュータプログラム | |
JP7391616B2 (ja) | 移動体の姿勢推定装置 | |
JP5906802B2 (ja) | 舵角検出装置、舵角検出方法、及びプログラム | |
US20230314462A1 (en) | Inertial sensor | |
KR20160103750A (ko) | 차량의 곡률 반경 추정장치 및 그 방법 | |
WO2018012064A1 (ja) | 角度計測装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20101208 Termination date: 20200927 |