CN113739794B - 姿态推定装置及方法、传感器模块、计测系统、移动体 - Google Patents
姿态推定装置及方法、传感器模块、计测系统、移动体 Download PDFInfo
- Publication number
- CN113739794B CN113739794B CN202110586719.8A CN202110586719A CN113739794B CN 113739794 B CN113739794 B CN 113739794B CN 202110586719 A CN202110586719 A CN 202110586719A CN 113739794 B CN113739794 B CN 113739794B
- Authority
- CN
- China
- Prior art keywords
- posture
- movable body
- information
- parameter
- angular velocity
- 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
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000001133 acceleration Effects 0.000 claims abstract description 65
- 230000008859 change Effects 0.000 claims abstract description 22
- 238000005259 measurement Methods 0.000 claims description 48
- 238000012545 processing Methods 0.000 claims description 46
- 230000008569 process Effects 0.000 claims description 15
- 238000004891 communication Methods 0.000 claims description 13
- 230000007246 mechanism Effects 0.000 description 21
- 238000001514 detection method Methods 0.000 description 19
- 238000010586 diagram Methods 0.000 description 8
- 206010034719 Personality change Diseases 0.000 description 7
- 238000012544 monitoring process Methods 0.000 description 6
- 238000010276 construction Methods 0.000 description 5
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 4
- 238000005070 sampling Methods 0.000 description 4
- 230000008602 contraction Effects 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 3
- 230000001360 synchronised effect Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000012806 monitoring device Methods 0.000 description 2
- 238000010187 selection method Methods 0.000 description 2
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N silicon dioxide Inorganic materials O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 239000010453 quartz Substances 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000004984 smart glass Substances 0.000 description 1
- 239000003381 stabilizer Substances 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 230000002194 synthesizing effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/02—Control of vehicle driving stability
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/11—Pitch movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/112—Roll movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/114—Yaw movement
-
- 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
-
- 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
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
- A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
- A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2300/00—Indexing codes relating to the type of vehicle
- B60W2300/15—Agricultural vehicles
- B60W2300/152—Tractors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/90—Single sensor for two or more measurements
- B60W2420/905—Single sensor for two or more measurements the sensor being an xyz axis sensor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Mathematical Physics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了姿态推定装置及方法、传感器模块、计测系统、移动体。姿态推定装置根据基于可动体的姿态变化的加速度信息和基于可动体的姿态变化的角速度信息来推定可动体的姿态,该姿态推定装置具备:存储部,存储加速度信息、角速度信息以及与可动体的运动相关联的多个姿态参数;参数控制部,从多个姿态参数中选择选择姿态参数;以及姿态运算部,使用加速度信息、角速度信息以及选择姿态参数来推定可动体的姿态。
Description
技术领域
本发明涉及姿态推定装置、传感器模块、计测系统、移动体以及姿态推定方法。
背景技术
已知有如下装置、系统:通过在物体上装配惯性计测装置(IMU:InertialMeasurement Unit)并使用惯性计测装置的输出信号来计算物体的位置、姿态。由于在惯性计测装置的输出信号中存在有偏置误差,在姿态计算中也会产生误差,因此提出有使用卡尔曼滤波器来校正这些误差,推定物体的正确的姿态的方法。例如,在专利文献1中,记载有使用角速度传感器的输出来计算对象物的姿态变化量,使用姿态变化量和姿态参数来推定对象物的姿态的姿态推定装置。
专利文献1:日本特开2015-179002号公报
发明内容
然而,在专利文献1所记载的姿态推定装置中,由于推定对象物的姿态的姿态参数固定,因此存在有如下的问题:在对象物的运动较快的情况下、对象物的运动较慢的情况下,在相同的姿态参数下均难以高精度地进行姿态推定。
姿态推定装置根据基于可动体的姿态变化的加速度信息和基于所述可动体的所述姿态变化的角速度信息来推定所述可动体的姿态,所述姿态推定装置具备:存储部,存储所述加速度信息、所述角速度信息以及与所述可动体的运动相关联的多个姿态参数;参数控制部,从所述多个姿态参数中选择选择姿态参数;以及姿态运算部,使用所述加速度信息、所述角速度信息以及所述选择姿态参数来推定所述可动体的姿态。
传感器模块具备:上述所记载的姿态推定装置;惯性计测装置,具有检测加速度的加速度传感器、检测角速度的角速度传感器以及对从所述加速度传感器和所述角速度传感器输出的信号进行处理的信号处理部;以及通信部,输出由所述姿态推定装置推定出的所述可动体的姿态信息。
计测系统具备:上述所记载的传感器模块;以及主机设备,与所述传感器模块电连接。
移动体具备:上述所记载的传感器模块;以及控制装置,基于所述传感器模块推定出的所述可动体的姿态,进行所述可动体的姿态的控制。
姿态推定方法包括如下工序:在可动体装配参照用传感器模块;使所述可动体动作而获得参照用姿态输出;在所述可动体装配传感器模块和所述参照用传感器模块;将所述传感器模块的姿态推定所使用的选择姿态参数设定为第一参数;使所述可动体动作而获得第一姿态输出;将所述传感器模块的姿态推定所使用的选择姿态参数设定为第二参数;使所述可动体动作而获得第二姿态输出;以及将所述第一姿态输出和所述第二姿态输出与所述参照用姿态输出进行比较,选择成为接近所述参照用姿态输出的姿态输出的所述选择姿态参数。
姿态推定方法包括如下工序:在可动体装配传感器模块;将所述传感器模块的姿态推定所使用的选择姿态参数设定为第一参数;使所述可动体以已知的角度动作而获得第一姿态输出;将所述传感器模块的姿态推定所使用的选择姿态参数设定为第二参数;使所述可动体以所述已知的角度动作而获得第二姿态输出;以及将所述第一姿态输出和所述第二姿态输出与所述已知的角度进行比较,选择成为接近所述已知的角度的姿态输出的所述选择姿态参数。
附图说明
图1是表示具备第一实施方式所涉及的姿态推定装置的传感器模块的结构的框图。
图2是表示设定参数控制部的姿态参数的方法的流程图。
图3是表示传感器模块的姿态推定方法的流程图。
图4是表示具备第二实施方式所涉及的姿态推定装置的传感器模块的结构的框图。
图5是表示设定参数控制部的姿态参数的方法的流程图。
图6是表示具备第三实施方式所涉及的姿态推定装置的传感器模块的结构的框图。
图7是表示推定姿态推定装置的可动体的姿态的方法的流程图。
图8是表示第四实施方式所涉及的传感器模块的姿态推定方法的流程图。
图9是表示具备第五实施方式所涉及的传感器模块的计测系统的结构的框图。
图10是表示具备第六实施方式所涉及的传感器模块的移动体的结构的图。
图11是表示移动体的结构的框图。
图12是表示具备第七实施方式所涉及的传感器模块的移动体的结构的图。
图13是表示移动体的结构的框图。
附图标记说明
1、1a、1b…传感器模块;10…惯性计测装置;12…角速度传感器;14…加速度传感器;16…信号处理部;20、20a、20b…姿态推定装置;21…处理部;22…姿态变化量计算部;23…速度变化量计算部;24…姿态推定部;25…姿态运算部;26…参数控制部;27…存储部;28…权重系数切换部;30…通信部;200…计测系统;500、600…移动体。
具体实施方式
1.第一实施方式
首先,参照图1以及图2对具备第一实施方式所涉及的姿态推定装置20的传感器模块1进行说明。
如图1所示,本实施方式的传感器模块1具备惯性计测装置10、姿态推定装置20以及通信部30。
惯性计测装置10包括角速度传感器12、加速度传感器14以及信号处理部16。
角速度传感器12计测相互交叉的、理想上是正交的3轴方向上各自的角速度,输出与计测到的3轴角速度的大小以及朝向相应的模拟信号。
加速度传感器14计测相互交叉的、理想上是正交的3轴方向上各自的加速度,输出与计测到的3轴加速度的大小以及朝向相应的模拟信号。
信号处理部16进行如下处理:以规定的采样间隔Δt对角速度传感器12的输出信号进行采样并转换为数字值的角速度数据。另外,信号处理部16进行如下处理:以规定的采样间隔Δt对加速度传感器14的输出信号进行采样并转换为数字值的加速度数据。
理想的情况是,角速度传感器12以及加速度传感器14以使各自的3轴与针对惯性计测装置10定义的正交坐标系即传感器坐标系的3轴(x轴、y轴、z轴)一致的方式安装于惯性计测装置10,但是实际上会产生安装角的误差。为此,信号处理部16还进行如下处理:使用根据安装角误差预先计算出的校正参数,将角速度数据以及加速度数据转换为xyz坐标系的数据。进而,信号处理部16还进行如下处理:根据角速度传感器12以及加速度传感器14的温度特性,对角速度数据以及加速度数据进行温度校正。
此外,也可以使角速度传感器12以及加速度传感器14具有A/D转换、温度校正的功能。
惯性计测装置10将基于信号处理部16处理后的角速度数据以及加速度数据向姿态推定装置20输出。
姿态推定装置20包括处理部21和存储部27。姿态推定装置20从存储基于从惯性计测装置10输出的可动体的姿态变化的加速度信息和角速度信息以及与可动体的运动相关联的多个姿态参数的存储部27,使用加速度信息、角速度信息、以及从多个姿态参数中选择出的选择姿态参数,在处理部21中推定作为对象物的可动体的姿态。
处理部21包括姿态变化量计算部22、速度变化量计算部23以及姿态推定部24。处理部21依据存储于存储部27的ROM或者记录介质中的程序、或者经由网络从服务器接收并存储于存储部27的RAM、记录介质中的程序来进行各种处理。特别是在本实施方式中,处理部21通过执行该程序而作为姿态变化量计算部22、速度变化量计算部23、以及姿态推定部24发挥功能,进行如下处理:针对惯性计测装置10以规定的采样间隔输出的角速度数据以及加速度数据进行规定的运算,推定可动体的姿态。此外,惯性计测装置10输出的角速度数据以及加速度数据作为角速度信息以及加速度信息被存储于存储部27。
姿态变化量计算部22基于作为角速度传感器12的输出的角速度信息来计算可动体的姿态变化量。具体而言,姿态变化量计算部22进行如下处理:使用由偏置去除部去除了偏置误差所得的3轴角速度,利用以采样间隔为变量的多项式进行近似,从而计算可动体的姿态变化量。
速度变化量计算部23基于加速度传感器14的输出即加速度信息和角速度传感器的输出即角速度信息来计算可动体的速度变化量。具体而言,速度变化量计算部23进行如下处理:使用由偏置去除部去除了偏置误差所得的3轴角速度和3轴加速度,计算可动体的速度变化量。
姿态推定部24包括姿态运算部25以及参数控制部26。姿态推定部24进行如下处理:使用由姿态变化量计算部22计算出的姿态变化量、由速度变化量计算部23计算出速度变化量、由参数控制部26设定的选择姿态参数,推定可动体的姿态。
姿态运算部25使用根据存储于存储部27的加速度信息和角速度信息计算出的姿态变化量以及速度变化量、以及参数控制部26基于存储于存储部27的姿态参数选择信息而从与可动体的运动相关联的多个姿态参数中选择出的选择姿态参数,推定可动体的姿态。
参数控制部26与用户从姿态推定装置20的未图示的输入部输入的模式设定相伴地,基于存储于存储部27中的姿态参数选择信息,从多个姿态参数之中选择与模式设定对应的选择姿态参数,并设定在姿态运算部25中。
具体而言,如图2所示,在步骤S11中,当用户设定与可动体的运动相关联的模式时,在步骤S12中,在模式A的情况下,在步骤S13中,基于姿态参数选择信息而从存储部27选择第一参数P1,并将第一参数P1作为选择姿态参数设定在姿态运算部25中。另外,在模式B的情况下,在步骤S14中,基于姿态参数选择信息而从存储部27选择第二参数P2,并将第二参数P2作为选择姿态参数设定在姿态运算部25中。另外,在模式C的情况下,步骤S15中,基于姿态参数选择信息而从存储部27选择第三参数P3,并将第三参数P3作为选择姿态参数设定在姿态运算部25中。
此外,在本实施方式中,将可动体的运动被设为可动体的速度,选择姿态参数的不同根据可动体的假定速度V[km/h]之差而不同。
例如,第一参数P1是假定速度V为V<x的情况下的参数,第二参数P2是假定速度V为x≤V≤y的情况下的参数,第三参数P3是假定速度V为y<V的情况下的参数。因此,将以假定速度V进行了条件划分的模式和对应的参数建立关联所得的数据成为姿态参数选择信息。
存储部27包括存储处理部21用于进行各种处理的程序、用于实现应用功能的各种程序、数据等的ROM。
另外,存储部27被用作处理部21的作业区域,包括临时存储从ROM读出的程序、数据、处理部21依据各种程序执行的运算结果、姿态参数选择信息、以及与可动体的运动相关联的多个姿态参数等。
另外,存储部27包括存储通过处理部21的处理而生成的数据中的需要长期保存的数据的非易失性的记录介质。此外,记录介质也可以存储处理部21用于进行各种处理的程序、用于实现应用功能的各种程序、数据等。
通信部30能够将由姿态推定装置20推定出的可动体的姿态信息向其他装置等发送,能够接收来自其他装置等的控制信号等。
如上所述,在本实施方式的姿态推定装置20中,参数控制部26基于姿态参数选择信息,从与可动体的运动相关联的多个姿态参数中选择选择姿态参数,在姿态运算部25中,使用加速度信息、角速度信息、选择姿态参数来推定可动体的姿态,因此能够根据可动体的运动高精度地推定可动体的姿态。
另外,由于本实施方式的传感器模块1具备上述姿态推定装置20,因此能够根据可动体的运动高精度地推定可动体的姿态,并向其他装置发送。
接下来,参照图3对使用了具备本实施方式所涉及的姿态推定装置20的传感器模块1的姿态推定方法进行说明。
如图3所示,本实施方式所涉及的姿态推定方法包括第一装配工序、参照用输出获取工序、第二装配工序、第一参数设定工序、第一输出获取工序、第二参数设定工序、第二输出获取工序、参数选择工序以及姿态推定工序。
1.1第一装配工序
首先,在步骤S101中,将具有不受可动体的运动的速度影响的高精度姿态计测功能的参照用传感器模块装配于作为对象物的可动体。
1.2参照用输出获取工序
接下来,在步骤S102中,使可动体动作,获得参照用姿态输出。
1.3第二装配工序
接下来,在步骤S103中,对装配有参照用传感器模块的可动体装配传感器模块1。
1.4第一参数设定工序
接下来,在步骤S104中,将第一参数P1设定为传感器模块1的姿态推定所使用的选择姿态参数。
1.5第一输出获取工序
接下来,在步骤S105中,使可动体动作,获得根据第一参数P1计算出的第一姿态输出。
1.6第二参数设定工序
接下来,在步骤S106中,将第二参数P2设定为传感器模块1的姿态推定所使用的选择姿态参数。
1.7第二输出获取工序
接下来,在步骤S107中,使可动体动作,获得根据第二参数P2计算出的第二姿态输出。
1.8参数选择工序
接下来,在步骤S108中,将第一姿态输出、第二姿态输出与参照用姿态输出进行比较,选择成为接近参照用姿态输出的姿态输出的选择姿态参数。
1.9姿态推定工序
接下来,在步骤S109中,设定成为接近参照用姿态输出的姿态输出的选择姿态参数,进行推定可动体的姿态的处理,从而推定可动体的姿态。
由于选择成为接近作为基准的参照用姿态输出的姿态输出的选择姿态参数,使用选择出的选择姿态参数来推定可动体的姿态,因此能够更正确地推定可动体的姿态。此外,在本实施方式中,使用两个选择姿态参数来选择成为接近参照用姿态输出的姿态输出的选择姿态参数,但是进行比较的选择姿态参数只要是两个以上即可。若进行比较的选择姿态参数较多,则能够选择成为更接近参照用姿态输出的姿态输出的选择姿态参数。
如上所述,由于本实施方式的姿态推定方法是在对接近作为基准的参照用姿态输出的姿态输出的选择姿态参数进行了实测之后进行选择的,因此能够更正确地推定可动体的姿态。
此外,在本实施方式的姿态推定方法中,将可动体的速度用作可动部的运动,但是并不局限于此,也可以使用可动体的加速度、角速度、角加速度、停止时间的长度中的任意一个。根据这些,也能够成为更正确地推定可动体的姿态的姿态推定方法。
2.第二实施方式
接下来,参照图4和图5对具备第二实施方式所涉及的姿态推定装置20a的传感器模块1a进行说明。
本实施方式的姿态推定装置20a与第一实施方式的姿态推定装置20相比,除了姿态推定部24a的结构不同以外,均与第一实施方式的姿态推定装置20相同。此外,以与上述第一实施方式的不同点为中心进行说明,省略相同事项的说明。
如图4所示,姿态推定装置20a的姿态推定部24a具有姿态运算部25和参数控制部26a,并进行如下处理:基于来自通信部30的可动体的运动信息即脉冲(Pulse)信号,从多个姿态参数中选择选择姿态参数,推定可动体的姿态。此外,Pulse信号例如是指是计测作为可动体的车辆的速度所得的车速脉冲信号、从安装于可动体的GPS输出的脉冲频率(PPS,Pulse Per Second)信号。
参数控制部26a基于来自通信部30的可动体的运动信息即Pulse信号,从存储于存储部27的多个姿态参数中选择与Pulse信号对应的选择姿态参数,并设定在姿态运算部25中。
具体而言,如图5所示,在步骤S21中,根据来自通信部30的Pulse信号检测速度。在步骤S22中,在假定速度V为V<x的情况下,在步骤S23中,从存储部27选择第一参数P1,并设定在姿态运算部25中。另外,在假定速度V为x≤V≤y的情况下,在步骤S24中,从存储部27选择第二参数P2,并设定在姿态运算部25中。另外,在假定速度V为y<V的情况下,在步骤S25中,从存储部27中选择第三参数P3,并设定在姿态运算部25中。
在姿态运算部25中,使用参数控制部26a基于Pulse信号选择出的选择姿态参数来运算可动体的姿态。
通过设为这样的结构,本实施方式的姿态推定装置20a能够根据可动体的运动信息即Pulse信号而自动地选择与可动体的运动相应的最佳的选择姿态参数,因此能够更正确地推定可动体的姿态。
3.第三实施方式
接下来,参照图6以及图7对具备第三实施方式所涉及的姿态推定装置20b的传感器模块1b进行说明。
本实施方式的姿态推定装置20b与第一实施方式的姿态推定装置20相比,除了姿态推定部24b的结构不同以外,均与第一实施方式的姿态推定装置20相同。此外,以与上述第一实施方式的不同点为中心进行说明,省略相同事项的说明。
如图6所示,姿态推定装置20b的姿态推定部24b具有第一姿态运算部251、第二姿态运算部252、第三姿态运算部253、参数控制部26b以及权重系数切换部28。姿态推定部24b进行如下处理:基于来自通信部30的可动体的运动信息即Pulse信号,选择至少两个姿态参数作为选择姿态参数,并对选择出的姿态参数分别乘以权重系数R,运算可动体的姿态,并将运算出的结果相加,从而推定可动体的姿态。此外,在本实施方式中,作为一个例子,列举选择了三个姿态参数的情况并进行说明。
第一姿态运算部251使用对由参数控制部26b选择出的第一参数P1乘以由权重系数切换部28设定的权重系数R所得的姿态参数,运算可动体的姿态。
第二姿态运算部252使用对由参数控制部26b选择出的第二参数P2乘以由权重系数切换部28设定的权重系数R所得的姿态参数,运算可动体的姿态。
第三姿态运算部253使用对由参数控制部26b选择出的第三参数P3乘以由权重系数切换部28设定的权重系数R所得的姿态参数,运算可动体的姿态。
参数控制部26b对从存储于存储部27中的多个姿态参数之中选择出的第一参数P1乘以由权重系数切换部28设定的与第一参数P1对应的权重系数R,并设定在第一姿态运算单元251中。
参数控制部26b对从存储于存储部27中的多个姿态参数之中选择出的第二参数P2乘以由权重系数切换部28设定的与第二参数P2对应的权重系数R,并设定在第二姿态运算单元252中。
参数控制部26b对从存储于存储部27中的多个姿态参数之中选择出的第三参数P3乘以由权重系数切换部28设定的与第三参数P3对应的权重系数R,并设定在第三姿态运算单元253中。
权重系数切换部28基于来自通信部30的可动体的运动信息即Pulse信号,切换针对第一参数P1的权重系数R、针对第二参数P2的权重系数R、以及针对第三参数P3的权重系数R。
如图7所示,在姿态推定装置20b中的推定可动体的姿态的处理中,首先,在步骤S31中,根据来自通信部30的Pulse信号检测速度。接下来,在步骤S32中,根据假定速度V进行条件划分。
在假定速度V为V<x的情况下,在步骤S33中,使用乘以由权重系数切换部28设定的权重系数R1(例如0.6)后的第一参数P1,通过第一姿态运算部251来运算可动体的姿态。接下来,在步骤S34中,使用乘以由权重系数切换部28设定的权重系数R2(例如0.3)后的第二参数P2,通过第二姿态运算部252来运算可动体的姿态。在步骤S35中,使用乘以由权重系数切换部28设定的权重系数R3(例如,0.1)后的第三参数P3,通过第三姿态运算部253来运算可动体的姿态。之后,在步骤S36中,将第一姿态运算部251的运算结果、第二姿态运算部252的运算结果、第三姿态运算部253的运算结果相加而作为可动体的姿态。
在假定速度V为x≤V≤y的情况下,在步骤S37中,使用乘以由权重系数切换部28设定的权重系数R4(例如0.2)后的第一参数P1,通过第一姿态运算部251来运算可动体的姿态。接下来,在步骤S38中,使用乘以由权重系数切换部28设定的权重系数R5(例如0.6)后的第二参数P2,通过姿态运算部252来运算可动体的姿态。在步骤S39中,使用乘以由权重系数切换部28设定的权重系数R6(例如0.2)后的第三参数P3,通过第三姿态运算部253来运算可动体的姿态。之后,在步骤S40中,将第一姿态运算部251的运算结果、第二姿态运算部252的运算结果、第三姿态运算部253的运算结果相加而作为可动体的姿态。
在假定速度V为y<V的情况下,在步骤S41中,使用乘以由权重系数切换部28设定的权重系数R7(例如0.1)后的第一参数P1,通过第一姿态运算部251来运算可动体的姿态。接下来,在步骤S42中,使用乘以由权重系数切换部28设定的权重系数R8(例如0.3)后的第二参数P2,通过第二姿态运算部252来运算可动体的姿态。在步骤S43中,使用乘以由权重系数切换部28设定的权重系数R9(例如0.6)后的第三参数P3,通过第三姿态运算部253来运算可动体的姿态。之后,在步骤S44中,将第一姿态运算部251的运算结果、第二姿态运算部252的运算结果、第三姿态运算部253的运算结果相加而作为可动体的姿态。
通过设为这样的结构,本实施方式的姿态推定装置20b能够根据可动体的运动信息即Pulse信号,与可动体的运动相应地动态地切换选择姿态参数的权重系数R,因此能够更正确地推定可动体的姿态。
4.第四实施方式
接下来,参照图8对第四实施方式所涉及的传感器模块1、1a、1b的姿态推定方法进行说明。此外,在以下的说明中,应用传感器模块1来进行说明。
如图8所示,本实施方式所涉及的姿态推定方法包括装配工序、第一参数设定工序、第一输出获取工序、第二参数设定工序、第二输出获取工序、参数选择工序以及姿态推定工序。
4.1装配工序
首先,在步骤S111中,将传感器模块1装配于作为对象物的可动体。
4.2第一参数设定工序
接下来,在步骤S112中,将第一参数P1设定为传感器模块1的姿态推定所使用的选择姿态参数。
4.3第一输出获取工序
接下来,在步骤S113中,使可动体以已知的角度动作,获得根据第一参数P1计算出的第一姿态输出。
4.4第二参数设定工序
接下来,在步骤S114中,将第二参数P2设定为传感器模块1的姿态推定所使用的选择姿态参数。
4.5第二输出获取工序
接下来,在步骤S115中,使可动体以已知的角度动作,获得根据第二参数P2计算出的第二姿态输出。
4.6参数选择工序
接下来,在步骤S116中,将第一姿态输出、第二姿态输出与已知的角度进行比较,选择成为接近已知的角度的姿态输出的选择姿态参数。
4.7姿态推定工序
接下来,在步骤S117中,设定成为接近已知的角度的姿态输出的选择姿态参数,进行推定可动体的姿态的处理,从而推定可动体的姿态。
由于选择成为接近已知的角度的姿态输出的选择姿态参数,并使用选择出的选择姿态参数来推定可动体的姿态,因此能够更正确地推定可动体的姿态。此外,在本实施方式中,使用两个选择姿态参数来选择成为接近已知的角度的姿态输出的选择姿态参数,但是进行比较的选择姿态参数只要是两个以上即可。若进行比较的选择姿态参数较多,则能够选择成为更接近已知的角度的姿态输出的选择姿态参数。
如上所述,由于本实施方式的姿态推定方法是在对成为接近已知的角度的姿态输出的选择姿态参数进行实测之后进行选择的,因此能够更正确地推定可动体的姿态。
5.第五实施方式
接下来,参照图9对具备第五实施方式所涉及的传感器模块1、1a、1b的计测系统200进行说明。此外,在以下的说明中,以应用了传感器模块1的结构为例进行说明。
本实施方式所涉及的计测系统200包括传感器模块1和与传感器模块1电连接的主机设备210。另外,能够包括GPS接收部220、GPS接收用的天线222以及振荡器230。主机设备210能够通过MPU等各种处理器来实现。此外,也可以通过ASIC的集成电路装置来实现主机设备210。主机设备210包括执行数字信号处理的DSP212和生成时钟信号的时钟信号生成电路213。
GPS接收部220经由天线222接收来自GPS卫星的信号。即,作为GPS载波,接收位置信息叠加而成的卫星信号。GPS接收部220是GPS接收机,能够通过包括GPS的接收电路在内的集成电路装置来实现。主机设备210基于GPS接收部220接收到的信号,检测表示移动体等计测对象物的位置、速度、方位的GPS定位数据。计测对象物的位置是纬度、经度或者高度等。在该GPS定位数据中也包括表示接收状态、接收时刻等的状态数据。另外,主机设备210接收来自传感器模块1的加速度数据以及角速度数据,并对这些数据进行惯性导航运算处理,求出惯性导航定位数据。惯性导航定位数据包括计测对象物的加速度数据以及姿态数据。然后,主机设备210基于求出的惯性导航定位数据和GPS定位数据,计算计测对象物的位置等。在计测对象物是汽车等移动体的情况下,计算移动体在地面的哪个位置行驶。此外,这样的计测对象物的位置、姿态的运算处理能够通过使用了DSP212的卡尔曼滤波器处理来实现。
振荡器230使用石英振子等振子来生成振荡时钟信号。振荡器230例如是温度补偿型振荡器(TCXO)。或者,作为振荡器230,也可以使用具备恒温槽的恒温槽型振荡器(OCXO)等。时钟信号生成电路213基于来自振荡器230的振荡时钟信号,生成在主机设备210中使用的各种时钟信号。在该情况下,时钟信号生成电路213基于从GPS等卫星定位系统获取的信号即时刻基准信号来生成时钟信号。例如,作为时钟信号之一而生成外部同步信号EXSYC。
主机设备210能够基于在GPS接收部220接收到的卫星信号中含有的时刻信息来获取正确的绝对时刻信息。时刻信息为年、月、日、时、分、秒等信息。然后,GPS接收部220作为时刻基准信号而输出以秒为单位产生脉冲的PPS信号。时钟信号生成电路213由通过来自振荡器230的振荡时钟信号进行动作的PLL电路构成,在PLL电路中,PPS信号作为时钟同步用的基准信号而被输入。然后,PLL电路生成与时刻基准信号即PPS信号同步的时钟信号。这样,主机设备210将与时刻基准信号同步的外部同步信号EXSYC向传感器模块1输出。
如上所述,在本实施方式中,外部同步信号EXSYC成为基于时刻基准信号而生成的信号。由此,能够使用基于时刻基准信号而生成的外部同步信号EXSYC,获取角速度传感器12以及加速度传感器14中的检测数据。即,通过使用基于时刻基准信号而生成的外部同步信号EXSYC,能够在正确的时刻进行了同步的定时下,获取来自角速度传感器12以及加速度传感器14的检测电路的检测数据。因而,能够将在正确的时刻进行了同步的恰当的定时下获取的检测数据向信号处理部16输出,能够实现使用传感器模块1计测的信息的高精度化。
例如,主机设备210通过使用GPS接收部220接收到的卫星信号,能够获取正确的绝对时刻信息。因而,也能够指定外部同步信号EXSYC的各同步定时的绝对时刻。而且,从传感器模块1输出在外部同步信号EXSYC的同步定时下获取的检测数据。另外,由于从角速度传感器12以及加速度传感器14中的检测数据的获取定时至该检测数据被输入主机装置210的定时为止的延迟时间是基于数字处理的延迟时间,因此主机设备210能够指定该延迟时间的长度即时钟数。因而,主机设备210能够指定从传感器模块1输入的加速度数据、角速度数据等检测数据是在哪个时刻获取的检测数据。而且,如上所述,主机设备210根据基于卫星信号求出的GPS定位数据、基于来自传感器模块1的检测数据求出的惯性导航定位数据,计算计测对象物的位置等。因而,由于能够指定加速度数据、角速度数据等检测数据的获取定时的绝对时刻,因此能够正确地计算计测对象物的位置等。
另外,在本实施方式中,时刻基准信号例如是从卫星定位系统获取的信号。例如,时刻基准信号是从卫星定位系统获取的PPS信号等。这样,能够有效利用卫星定位系统而获取时刻基准信号,能够使用基于所获取的时刻基准信号而生成的外部同步信号EXSYC,获取角速度传感器12以及加速度传感器14中的检测数据。
6.第六实施方式
接下来,参照图10以及图11对具备第六实施方式所涉及的传感器模块1、1a、1b的移动体500进行说明。此外,在以下的说明中,以应用了传感器模块1的结构为例来进行说明。
本实施方式所涉及的移动体500包括:上述实施方式的传感器模块1;以及控制装置570,基于传感器模块1的姿态推定装置20推定出的移动体500的姿态信息,控制移动体500的姿态。
如图10所示,移动体500具有车体502、车轮504。另外,在移动体500装配有定位装置510,且进行车辆控制等的控制装置570设于内部。另外,如图11所示,移动体500具有:发动机、马达等驱动机构580;盘式制动器、鼓式制动器等制动机构582;以及由方向盘、转向齿轮箱等实现的转向机构584。这样,移动体500具备驱动机构580、制动机构582、转向机构584,是在地上、天空、海上移动的设备、装置。例如,移动体500是农业机械等四轮汽车。
定位装置510是装配于移动体500而进行移动体500的定位的装置。定位装置510包括:传感器模块1,具有惯性计测装置10和姿态推定装置20;GPS接收部520;以及GPS接收用的天线522。姿态推定装置20包括位置信息获取部、位置合成部、运算处理部以及定位处理部。惯性计测装置10具有3轴的加速度传感器14和3轴的角速度传感器12。运算处理部接收来自加速度传感器14、角速度传感器12的加速度数据、角速度数据,并对这些数据进行惯性导航运算处理,输出惯性导航定位数据。惯性导航定位数据是表示移动体500的加速度、姿态的数据。
GPS接收部520经由天线522接收来自GPS卫星的信号。位置信息获取部基于GPS接收部520接收到的信号,输出表示装配有定位装置510的移动体500的位置、速度、方位的GPS定位数据。位置合成部基于从运算处理部输出的惯性导航定位数据和从位置信息获取部输出的GPS定位数据,计算移动体500在地面的哪个位置行驶。例如,即使在GPS定位数据中含有的移动体500的位置相同,只要如图10所示那样移动体500的姿态因地面的倾斜(θ)等的影响而不同,则移动体500便在地面的不同位置行驶。因此,仅通过GPS定位数据无法计算出移动体500的正确的位置。
为此,位置合成部使用惯性导航定位数据中的特别是与移动体500的姿态相关的数据,计算移动体500在地面的哪个位置行驶。从位置合成部输出的位置数据由定位处理部进行规定的处理,并作为定位结果显示于显示部550。另外,也可以是,位置数据被通信部30向外部装置发送。
控制装置570控制移动体500的驱动机构580、制动机构582、转向机构584。控制装置570是车辆控制用的控制器,例如能够通过多个控制单元来实现。控制装置570具有:作为进行车辆控制的控制单元的车辆控制部572;作为进行自动驾驶控制的控制单元的自动驾驶控制部574;以及通过半导体存储器等来实现的存储部576。监视装置578是监视移动体500的周边的障碍物等物体的装置,通过周边监控照相机、毫米波雷达或者声纳等来实现。
然后,如图11所示,本实施方式的移动体500包括姿态推定装置20和控制装置570。控制装置570基于姿态推定装置20推定出的移动体500的姿态信息,控制移动体500的姿态。例如,姿态推定装置20基于包括来自惯性计测装置10的检测数据的输出信号,如上述那样进行各种处理,求出移动体500的位置、姿态的信息。例如,如上所述,姿态推定装置20能够基于GPS定位数据和惯性导航定位数据来求出移动体500的位置的信息。另外,姿态推定装置20例如能够基于在惯性导航定位数据中含有的角速度数据等来推定移动体500的姿态的信息。移动体500的姿态的信息例如能够通过四元数、侧倾角、俯仰角、偏摆角等来表示。然后,控制装置570基于通过姿态推定装置20的处理推定出的移动体500的姿态信息,控制移动体500的姿态。该控制例如由车辆控制部572来进行。该姿态的控制例如能够通过控制装置570对转向机构584进行控制来实现。或者,在滑移控制等使移动体500的姿态稳定化的控制中,控制装置570也可以控制驱动机构580、或者控制制动机构582。根据本实施方式,由于能够通过姿态推定装置20高精度地推定姿态的信息,因此能够实现移动体500的良好的姿态控制。
另外,在本实施方式中,控制装置570基于由姿态推定装置20求出的移动体500的位置以及姿态的信息,控制移动体500的加速、制动以及转向中的至少一个。例如,控制装置570能够基于移动体500的位置以及姿态的信息,控制驱动机构580、制动机构582以及转向机构584中的至少一个。
由此,例如能够实现基于自动驾驶控制部574的移动体500的自动驾驶控制。在该自动驾驶控制中,除了移动体500的位置以及姿态的信息以外,还使用基于监视装置578的周围的物体的监视结果、存储于存储部576的地图信息、行驶路径信息等。然后,控制装置570基于惯性计测装置10的输出信号的监视结果来切换实施或者不实施移动体500的自动驾驶。例如,姿态推定装置20监视来自惯性计测装置10的检测数据等的输出信号。然后,例如,在基于监视结果检测出惯性计测装置10的检测精度的降低、感应异常的情况下,控制装置570从实施自动驾驶切换为不实施自动驾驶。例如,在自动驾驶中,移动体500的加速、制动以及转向中的至少一个被自动地控制。另一方面,在不实施自动驾驶时,不实施这样的加速、制动、转向的自动控制。由此,关于进行自动驾驶的移动体500的行驶,能够进行可靠性更高的辅助。此外,也可以基于惯性计测装置10的输出信号的监视结果来切换自动驾驶的自动化等级。
7.第七实施方式
接下来,参照图12以及图13对具备第七实施方式所涉及的传感器模块1、1a、1b的移动体600进行说明。此外,在以下的说明中,以应用了传感器模块1的结构为例来进行说明。
上述实施方式的传感器模块1的姿态推定装置20能够有效地应用于建设机械的姿态控制等中,作为移动体600,列举作为建设机械的一例的液压挖掘机来进行说明。
如图12所示,在移动体600中,车体由下部行驶体612和能够回转地搭载于下部行驶体612上的上部回转体611构成,在上部回转体611的前部侧设有由能够在上下方向上转动的多个构件构成的作业机构620。在上部回转体611设有未图示的驾驶席,在驾驶席上设有对构成作业机构620的各构件进行操作的未图示的操作装置。而且,在上部回转体611配置有作为检测上部回转体611的倾斜角的倾斜传感器发挥功能的上述实施方式的惯性计测装置10。
作为多个构件,作业机构620具备:起重臂613,以能够进行俯仰动作的方式安装于上部回转体611的前部侧;臂614,以能够进行仰俯动作的方式安装于起重臂613的前端侧;铲斗连杆616,能够转动地安装于臂614的前端侧;铲斗615,能够转动地安装于臂614及铲斗连杆616的前端侧;起重臂缸617,驱动起重臂613;臂缸618,驱动臂614;以及铲斗缸619,经由铲斗连杆616驱动铲斗615。
起重臂613的基端侧被上部回转体611支撑为能够在上下方向上转动,通过起重臂缸617的伸缩而驱动起重臂613,使其相对于上部回转体611相对地旋转。而且,在起重臂613配置有作为检测起重臂613的运动的状态的惯性传感器发挥功能的惯性计测装置10c。
在起重臂613的前端侧,臂614的一端侧被支撑为能够旋转,通过臂缸618的伸缩而驱动臂614,使其相对于起重臂613相对地旋转。在臂614配置有作为检测臂614的运动的状态的惯性传感器发挥功能的惯性计测装置10b。
铲斗连杆616与铲斗615被臂614的前端侧支撑为能够转动,根据铲斗缸619的伸缩而驱动铲斗连杆616,使其相对于臂614相对地旋转,与之联动地,驱动铲斗615,使其相对于臂614相对地旋转。而且,在铲斗连杆616配置有作为检测铲斗连杆616的运动的状态的惯性传感器发挥功能的惯性计测装置10a。
惯性计测装置10a、10b、10c能够检测作用于作业机构620的各构件、上部回转体611的角速度以及加速度中的至少一个。另外,如图13所示,惯性计测装置10a、10b、10c串联地连接,能够将检测信号向运算装置630发送。这样,通过将惯性计测装置10a、10b、10c串联地连接,能够减少用于发送可动区域内的检测信号的布线数量,能够获得紧凑的布线构造。通过紧凑的布线构造,布线的铺设方法的选择变得容易,能够降低布线的劣化、损伤等的产生。
进而,如图13所示,在移动体600设有运算上部回转体611的倾斜角、构成作业机构620的起重臂613、臂614、铲斗615的位置姿态的运算装置630。如图13所示,运算装置630包括上述实施方式的姿态推定装置20和控制装置632。姿态推定装置20基于惯性计测装置10、10a、10b、10c的输出信号,推定移动体600的姿态信息。控制装置632基于姿态推定装置20推定出的移动体600的姿态信息,控制移动体600的姿态。具体而言,运算装置630输入来自各惯性计测装置10、10a、10b、10c的各种检测信号,基于各种检测信号,运算起重臂613、臂614、铲斗615的位置姿态或者姿态角、上部回转体611的倾斜状态。运算出的包括起重臂613、臂614、铲斗615的姿态角在内的位置姿态信号、包括上部回转体611的姿态角在内的倾斜信号,例如铲斗615的位置姿态信号被用于驾驶席的监视器装置(未图示)的显示、或者用于控制作业机构620、上部回转体611的动作的反馈信息中,进而,经由通信部30向其他装置等发送。
此外,作为使用上述实施方式的传感器模块1的姿态推定装置20的建设机械,除了上述示例的液压挖掘机(挖车、反铲挖土机、动力挖掘机)以外,例如,还具有越野起重机(起重车)、推土机、挖掘/装载机、轮式装载机、高空作业车(升降车)等。
根据本实施方式,由于通过传感器模块1的姿态推定装置20,能够高精度地求出姿态的信息,因此能够实现移动体600的良好的姿态控制。另外,根据移动体600,由于装配有紧凑的惯性计测装置10,因此能够提供如下的建设机械,例如,即使在铲斗连杆616等的极其有限的狭窄的区域内,也能够在惯性计测装置10的每个设置部位以串联连接(多连接)的方式紧凑地配置多个惯性计测装置、或者使通过电缆串联地连接设置于各部位的惯性计测装置10彼此的电缆的引绕变得紧凑。
此外,在本实施方式中,作为使用传感器模块1的姿态推定装置20的移动体,以农业机械等四轮汽车、建设机械为例进行了说明,但是除此以外,还具有摩托车、自行车、电车、飞机、双足步行机器人、或者无线电控制飞机、无线电控制直升机、无人机等远程操纵或者自主式的飞行体、火箭、人造卫星、船舶、AGV(无人搬运车)等。
另外,作为使用传感器模块1的姿态推定装置20的例子,除了移动体以外,还列举有智能手机、平板终端、智能手表、智能眼镜、HMD(头戴显示器)等可穿戴设备、具有稳定器等的照相机、摄像机等电子设备等。
Claims (6)
1.一种姿态推定装置,其特征在于,具备:
加速度传感器,安装于可动体,检测动作中的所述可动体的加速度以提供加速度数据作为加速度信息;
角速度传感器,安装于所述可动体,检测所述动作中的所述可动体的绕轴的角速度以提供角速度数据作为角速度信息;
存储部,构成为存储程序、基于所述动作中的所述可动体的姿态变化的所述加速度信息、基于所述动作中的所述可动体的所述姿态变化的所述角速度信息以及与所述动作中的所述可动体的运动相关联的多个姿态参数;以及
处理器,构成为执行所述程序,以便:
使所述可动体以参照用速度和/或参照用姿态移动,而从参照用传感器模块获得参照用信息;
从所述多个姿态参数中选择与用于所述可动体的所述运动的第一速度和/或第一姿态相关联的第一姿态参数;
使所述可动体以所述第一速度和/或所述第一姿态移动而获得第一输出信息,所述第一输出信息包括所述可动体以所述第一速度和/或所述第一姿态移动期间的所述加速度信息和所述角速度信息;
从所述多个姿态参数中选择与用于所述可动体的所述运动的第二速度和/或第二姿态相关联的第二姿态参数;
使所述可动体以所述第二速度和/或所述第二姿态移动而获得第二输出信息,所述第二输出信息包括所述可动体以所述第二速度和/或所述第二姿态移动期间的所述加速度信息和所述角速度信息;
将所述参照用信息与所述第一输出信息和所述第二输出信息分别进行比较,确定所述第一输出信息和所述第二输出信息中的哪一个输出信息接近所述参照用信息;
使用所述第一输出信息和所述第二输出信息中接近的一方的输出信息以及所述第一姿态参数和第二姿态参数中相对应的一方来推定所述可动体的姿态;以及
基于所推定的姿态,确定实施或者不实施所述可动体的所述动作中的自动驾驶、和/或是否校正所述可动体的所述姿态。
2.根据权利要求1所述的姿态推定装置,其特征在于,
所述可动体的所述运动是所述可动体的速度。
3.一种传感器模块,其特征在于,具备:
权利要求1或2中所述的姿态推定装置;
惯性计测装置,具有所述加速度传感器、所述角速度传感器以及对从所述加速度传感器和所述角速度传感器输出的信号进行处理的信号处理部;以及
通信部,输出由所述姿态推定装置推定出的所述可动体的姿态信息。
4.一种计测系统,其特征在于,具备:
权利要求3所述的传感器模块;以及
主机设备,与所述传感器模块电连接。
5.一种移动体,其特征在于,具备:
权利要求3所述的传感器模块;以及
控制装置,基于所述传感器模块推定出的所述可动体的姿态,进行所述可动体的姿态的控制。
6.一种姿态推定方法,其特征在于,用于使处理器执行处理,所述姿态推定方法包括在所述处理器上执行如下步骤:
使安装于可动体的加速度传感器检测动作中的所述可动体的加速度以提供加速度数据作为加速度信息;
使安装于所述可动体的角速度传感器检测所述动作中的所述可动体的绕轴的角速度以提供角速度数据作为角速度信息;
使所述可动体以参照用速度和/或参照用姿态移动,而从参照用传感器模块获得参照用信息;
从多个姿态参数中选择与用于所述可动体的运动的第一速度和/或第一姿态相关联的第一姿态参数;
使所述可动体以所述第一速度和/或所述第一姿态移动而获得第一输出信息,所述第一输出信息包括所述可动体以所述第一速度和/或所述第一姿态移动期间的所述加速度信息和所述角速度信息;
从所述多个姿态参数中选择与用于所述可动体的所述运动的第二速度和/或第二姿态相关联的第二姿态参数;
使所述可动体以所述第二速度和/或所述第二姿态移动而获得第二输出信息,所述第二输出信息包括所述可动体以所述第二速度和/或所述第二姿态移动期间的所述加速度信息和所述角速度信息;
将所述参照用信息与所述第一输出信息和所述第二输出信息分别进行比较,确定所述第一输出信息和所述第二输出信息中的哪一个输出信息接近所述参照用信息;
使用所述第一输出信息和所述第二输出信息中接近的一方的输出信息以及所述第一姿态参数和第二姿态参数中相对应的一方来推定所述可动体的姿态;以及
基于所推定的姿态,确定实施或者不实施所述可动体的所述动作中的自动驾驶、和/或是否校正所述可动体的所述姿态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410084679.0A CN117906597A (zh) | 2020-05-28 | 2021-05-27 | 姿态推定装置及方法、传感器模块、计测系统、移动体 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020093025 | 2020-05-28 | ||
JP2020-093025 | 2020-05-28 | ||
JP2020142419A JP7547865B2 (ja) | 2020-05-28 | 2020-08-26 | 姿勢推定装置、センサーモジュール、計測システム、移動体、及び姿勢推定方法 |
JP2020-142419 | 2020-08-26 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202410084679.0A Division CN117906597A (zh) | 2020-05-28 | 2021-05-27 | 姿态推定装置及方法、传感器模块、计测系统、移动体 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113739794A CN113739794A (zh) | 2021-12-03 |
CN113739794B true CN113739794B (zh) | 2024-01-12 |
Family
ID=78706097
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110586719.8A Active CN113739794B (zh) | 2020-05-28 | 2021-05-27 | 姿态推定装置及方法、传感器模块、计测系统、移动体 |
CN202410084679.0A Pending CN117906597A (zh) | 2020-05-28 | 2021-05-27 | 姿态推定装置及方法、传感器模块、计测系统、移动体 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202410084679.0A Pending CN117906597A (zh) | 2020-05-28 | 2021-05-27 | 姿态推定装置及方法、传感器模块、计测系统、移动体 |
Country Status (2)
Country | Link |
---|---|
US (2) | US11797026B2 (zh) |
CN (2) | CN113739794B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09154308A (ja) * | 1995-12-12 | 1997-06-17 | Kubota Corp | 作業機械の姿勢制御装置 |
JP2001141507A (ja) * | 1999-11-11 | 2001-05-25 | Yokogawa Denshikiki Co Ltd | 慣性航法装置 |
JP2006101737A (ja) * | 2004-10-01 | 2006-04-20 | Mitsubishi Agricult Mach Co Ltd | 作業車輌における傾斜自動制御装置 |
CN1774206A (zh) * | 2003-04-11 | 2006-05-17 | 松下电器产业株式会社 | 加速度传感器轴信息校正装置、及其校正方法 |
JP2011227017A (ja) * | 2010-04-23 | 2011-11-10 | Univ Of Tokyo | 慣性センサ,磁気センサおよび速度計を用いた移動体の姿勢推定装置および姿勢推定方法 |
CN109115213A (zh) * | 2017-06-21 | 2019-01-01 | 卡特彼勒公司 | 用于利用传感器融合来确定机器状态的系统和方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0821732A (ja) | 1994-07-05 | 1996-01-23 | Data Tec:Kk | 姿勢方位位置計測装置 |
US6876926B2 (en) | 2002-09-26 | 2005-04-05 | Honeywell International Inc. | Method and system for processing pulse signals within an inertial navigation system |
US8626465B2 (en) | 2010-03-30 | 2014-01-07 | Apple Inc. | Calibrating sensor measurements on mobile devices |
US8531180B2 (en) | 2010-03-30 | 2013-09-10 | Apple Inc. | Determining heading using magnetometer data and angular rate data |
JP2015179002A (ja) | 2014-03-19 | 2015-10-08 | セイコーエプソン株式会社 | 姿勢推定方法、姿勢推定装置及びプログラム |
WO2016058099A1 (en) * | 2014-10-15 | 2016-04-21 | Shen Xuemin | Method, system and apparatus for enabling vehicular communications |
GB2534417B (en) * | 2015-01-26 | 2019-06-12 | Atlantic Inertial Systems Ltd | Multiple sensor integration |
JP6616679B2 (ja) | 2015-12-16 | 2019-12-04 | 日立建機株式会社 | 建設機械 |
JP2020020631A (ja) | 2018-07-31 | 2020-02-06 | セイコーエプソン株式会社 | 姿勢推定方法、姿勢推定装置及び移動体 |
-
2021
- 2021-05-27 US US17/332,094 patent/US11797026B2/en active Active
- 2021-05-27 CN CN202110586719.8A patent/CN113739794B/zh active Active
- 2021-05-27 CN CN202410084679.0A patent/CN117906597A/zh active Pending
-
2023
- 2023-09-06 US US18/461,598 patent/US20230409052A1/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09154308A (ja) * | 1995-12-12 | 1997-06-17 | Kubota Corp | 作業機械の姿勢制御装置 |
JP2001141507A (ja) * | 1999-11-11 | 2001-05-25 | Yokogawa Denshikiki Co Ltd | 慣性航法装置 |
CN1774206A (zh) * | 2003-04-11 | 2006-05-17 | 松下电器产业株式会社 | 加速度传感器轴信息校正装置、及其校正方法 |
JP2006101737A (ja) * | 2004-10-01 | 2006-04-20 | Mitsubishi Agricult Mach Co Ltd | 作業車輌における傾斜自動制御装置 |
JP2011227017A (ja) * | 2010-04-23 | 2011-11-10 | Univ Of Tokyo | 慣性センサ,磁気センサおよび速度計を用いた移動体の姿勢推定装置および姿勢推定方法 |
CN109115213A (zh) * | 2017-06-21 | 2019-01-01 | 卡特彼勒公司 | 用于利用传感器融合来确定机器状态的系统和方法 |
Non-Patent Citations (2)
Title |
---|
"Improved Scale-Factor and Bias Stability of Ovenized Inertial Sensors in an Environmentally-Stabilized Inertial Measurement Unit (eIMU) ";David Lemmerhirt et al.;《 2019 IEEE International Symposium on Inertial Sensors and Systems (INERTIAL)》;第1-4页 * |
"基于MEMS传感器的高精度姿态角测量研究";刘震等;《中国测试》;第43卷(第2期);第6-12页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113739794A (zh) | 2021-12-03 |
CN117906597A (zh) | 2024-04-19 |
US11797026B2 (en) | 2023-10-24 |
US20210373577A1 (en) | 2021-12-02 |
US20230409052A1 (en) | 2023-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10261176B2 (en) | Rotating attitude heading reference systems and methods | |
US9347205B2 (en) | Estimation of the relative attitude and position between a vehicle body and an implement operably coupled to the vehicle body | |
US7844397B2 (en) | Method and apparatus for high accuracy relative motion determination using inertial sensors | |
US8213803B2 (en) | Method and system for laser based communication | |
US7979231B2 (en) | Method and system for estimation of inertial sensor errors in remote inertial measurement unit | |
US20090069957A1 (en) | Unmanned helicopter | |
JP4199553B2 (ja) | ハイブリッド航法装置 | |
US20040158354A1 (en) | Robot localization system | |
CN110221332A (zh) | 一种车载gnss/ins组合导航的动态杆臂误差估计和补偿方法 | |
US11372020B2 (en) | Posture estimation method, posture estimation device, and vehicle | |
US20080150798A1 (en) | Beam steering control for mobile antennas | |
CN110133695A (zh) | 一种双天线gnss位置延迟时间动态估计系统及方法 | |
JP2022029823A (ja) | 無人飛行体の制御システム、及び無人飛行体の制御方法 | |
US20230417790A1 (en) | Inertial measurement unit | |
CN113739794B (zh) | 姿态推定装置及方法、传感器模块、计测系统、移动体 | |
JP2736122B2 (ja) | 目標物の位置推定装置 | |
JP7547865B2 (ja) | 姿勢推定装置、センサーモジュール、計測システム、移動体、及び姿勢推定方法 | |
JP2021189160A (ja) | 姿勢推定装置、センサーモジュール、計測システム、移動体、及び姿勢推定方法 | |
JP3569015B2 (ja) | Gpsナビゲーション装置 | |
CN211506218U (zh) | 一种基于sins/gnss组合导航的飞行器制导控制装置 | |
CN111610800B (zh) | 一种松耦合无人机控制系统 | |
CN112815949A (zh) | 一种适用水下回收过程的超短组合导航方法 | |
JP2005300347A (ja) | 移動体搭載用衛星自動追尾装置 | |
JPH11325951A (ja) | 宇宙航行体の姿勢センサによる軌道決定方法および軌道決定装置 | |
US11543246B1 (en) | Rear axle center locating |
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 |