CN102066875A - 测斜仪测量系统和提供用于运动诱导加速度误差的校正的方法 - Google Patents
测斜仪测量系统和提供用于运动诱导加速度误差的校正的方法 Download PDFInfo
- Publication number
- CN102066875A CN102066875A CN2009801221916A CN200980122191A CN102066875A CN 102066875 A CN102066875 A CN 102066875A CN 2009801221916 A CN2009801221916 A CN 2009801221916A CN 200980122191 A CN200980122191 A CN 200980122191A CN 102066875 A CN102066875 A CN 102066875A
- Authority
- CN
- China
- Prior art keywords
- tiltmeter
- acceleration
- platform
- place
- axis
- 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.)
- Granted
Links
Images
Classifications
-
- 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/08—Means for compensating acceleration forces due to movement of instrument
-
- 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
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
本发明包括一种系统和一种方法,通过所述系统和方法可感应例如平台的机械元件的倾角,并可消除可能由切向和径向加速度导致的误差。所述平台限定了正交的X轴和Y轴,以及与X轴和Y轴二者正交的Z轴。所述平台可围绕平行于Z轴延伸的轴旋转。所述系统包括测斜仪,所述测斜仪被安装在平台上与旋转轴相隔距离r的位置,所述测斜仪用于提供指示X和Y方向上的加速度的测斜仪输出,所述测斜仪输出分别被指定为Ix和Iy。从旋转轴到测斜仪的直线与X轴形成夹角B。速率陀螺被安装在平台上。所述速率陀螺感应平台围绕旋转轴的旋转速度w,并提供指示旋转速度w的速率陀螺输出。一个电路对所述速率陀螺输出求微分以确定平台的角加速度dw/dt。一个电路用值r乘以所述角加速度,以确定平台上安装了测斜仪的点处的切向加速度r(dw/dt)。一个电路分解平台上安装了测斜仪的点处的切向加速度以确定其X轴分量,并分解平台上安装了测斜仪的点处的切向加速度以确定其Y轴分量。一个电路从平行于X轴的方向上感应的加速度Ix中减去平台上安装了测斜仪的点处的切向加速度的X轴分量,并且从平行于Y轴的方向上感应的加速度Iy中减去平台上安装了测斜仪的点处的切向加速度的Y轴分量。结果,所述测斜仪输出Ix和Iy校正由径向加速度导致的误差。
Description
技术领域
本发明涉及用于校正参照重力的倾角传感器(或测斜仪)中的运动诱导加速度产生的测量误差的装置。通常期望已知机械的可动构件相对于地球重力或相对于其它机械元件的倾角。实现此目的的一个方法在于将参照重力的测斜仪附于可动构件或元件。本发明提供了一种改善这种测斜仪在可动构件的旋转期间的性能的方法。本发明对正切和旋转加速度对感应重力加速度的测斜仪作出的测斜仪测量的影响做了校正。
背景技术
特别有用的是,能监视各种施工设备元件的取向。例如,这种可动元件可以是挖掘机的吊臂、铲斗柄、提斗或底盘平台,或者是推土机、平路机或铲土机的叶片或底盘平台。在多种情况下,随着在操作者的控制下或在自动控制系统的控制下的可动构件的倾角改变,可动构件围绕已知点或轴旋转。由于多种原因,例如参照重力的测斜仪的坚固耐用性、可靠性、小尺寸、安装的简易性以及低成本,参照重力的测斜仪特别适合用于施工设备应用。来自这种参照重力的测斜仪的有用的和期望的输出信号是其相对于水平面的倾角的测量。相对于地球重力测量所述水平面。为了测量相对于重力的倾角,传感器响应于沿着灵敏轴的重力加速度的矢量分量。由于这种类型的传感器不能识别重力加速度和非重力源加速度,因此它本质上对机械运动产生的加速度敏感。直线或平移运动和振动也产生可测量的加速度。这些非重力源加速度可导致来自测斜仪的非期望的和错误的输出信号。这种错误信号的大小与测斜仪经历的非重力加速度是成比例的。在一些情况下,非期望的信号与期望的倾角测量相比是巨大的,使得在产生这种非期望加速度的运动停止之前的传感器输出不可靠且不能用。
当可动构件绕轴转动时,构件的旋转将导致在径向方向上的加速度测量误差。当这种旋转的速度变化时,也将在运动方向的切线方向产生加速度测量误差。这种切向加速度被限定为旋转物体上与旋转轴的距离为“r”的一个点的直线或平移加速度。可动构件上任何位置处的切向加速度均为角加速度和与距离枢转点或轴(可动构件围绕所述枢转点或轴转动)的径向距离“r”的乘积。附于机械的可动构件的参照重力的测斜仪可理想地被设置在所述构件枢转或旋转时所围绕的轴处。因此,距离“r”将等于零,并且将不存在作用于测斜仪上的来自可动构件的角运动的切向加速度。在实际环境下,不可能或不期望将测斜仪设置在构件旋转所围绕的轴处。
用于显示或控制施工机械的可动构件的位置的系统目前以多种形式存在。在可用的传感器中,由于多种原因,包括坚固耐用性、可靠性、小尺寸、安装的简易性以及低成本,参照重力的测斜仪在施工设备应用中是有用的。当这种参照重力的测斜仪未被精确设置在轴(可动构件绕所述轴枢转或旋转)处时,很难获取精确的倾角读数。过滤这种测斜仪的输出以获取更稳定的信号(其具有叠加在该信号上的较少抖动)是常见的。然而,低通过滤也将潜在因素带入了角测量。结果,必须暂时将机械或其元件维持静止,以便于获取精确的位置信息。另外,在控制系统中,潜在因素是不合需要的,其可能造成系统的不稳定。
因此,可以看出,需要一种当测斜仪被安装在枢转或旋转的机械元件上时,校正参照重力的测斜仪中被加速度诱导的测量误差的装置,并且需要这样一种装置,其中测斜仪的速度和精度被提高。
发明内容
根据本发明的用于感应平台相对于重力的倾角的系统和方法满足这些需求。单词“平台”旨在包括测斜仪被安装在其上的任何机械元件,并且不限于支承其它机械元件的机械元件。平台限定了正交的X轴和Y轴,以及与X轴和Y轴二者正交的Z轴。所述平台能够绕平行于Z轴延伸的旋转轴旋转。所述系统包括安装在平台上与旋转轴相隔距离r的位置处的测斜仪,所述测斜仪用于提供指示X和Y方向上的加速度的测斜仪输出,它们分别被指定为Ix和Iy。从旋转轴到测斜仪的直线与X轴形成了夹角B。速率陀螺被安装在平台上。所述速率陀螺感应平台围绕旋转轴的旋转速度w,并提供指示旋转速度w的速率陀螺输出。一个电路对速率陀螺输出求微分以确定平台的角加速度dw/dt。一个电路通过值r乘以所述角加速度来确定平台上安装了测斜仪的点处的切向加速度r(dw/dt)。一个电路分解平台上安装了测斜仪的点处的切向加速度以确定其X轴分量,并且分解平台上安装了测斜仪的点处的切向加速度以确定其Y轴分量。一个电路从平行于X轴方向上感应的加速度Ix中减去平台上安装了测斜仪的点处的切向加速度的X轴分量,并且从平行于Y轴方向上感应的加速度Iy中减去平台上安装了测斜仪的点处的切向加速度的Y轴分量。结果,测斜仪输出Ix和Iy被用于校正可能由切向加速度导致的误差。
所述系统还可包括一个电路,其用于将平台围绕旋转轴的速度w进行平方,并用距离r乘以旋转速度的平方以确定平台的径向加速度。一个电路分解平台上安装了测斜仪的点处的径向加速度以确定其X轴分量,并分解平台上安装了测斜仪的点处的径向加速度以确定其Y轴分量。一个电路从平行于X轴方向上感应的加速度Ix中减去平台上安装了测斜仪的点处的径向加速度的X轴分量,并且从平行于Y轴方向上感应的加速度Iy中减去平台上安装了测斜仪的点处的径向加速度的Y轴分量。结果,测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
用于分解平台上安装了测斜仪的点处的径向加速度以确定其X轴分量,并用于分解平台上安装了测斜仪的点处的径向加速度以确定其Y轴分量的所述电路分别用cos(B)和sin(B)乘以平台上安装了测斜仪的点处的径向加速度来确定X轴和Y轴分量。用于分解平台上安装了测斜仪的点处的切向加速度以确定其X轴分量,并用于分解平台上安装了测斜仪的点处的切向加速度以确定其Y轴分量的所述电路分别用sin(B)和cos(B)乘以平台上安装了测斜仪的点处的切向加速度来确定X轴和Y轴分量。
提供了一种用于感应平台相对于重力的倾角的方法,所述平台限定了正交的X轴和Y轴,以及与X轴和Y轴二者正交的Z轴,所述平台可围绕平行于Z轴延伸的旋转轴旋转。所述方法包括以下步骤:a.)感应来自被安装在平台上与旋转轴间隔距离r的位置处的测斜仪的X方向和Y方向上的加速度,所述加速度分别被指定为Ix和Iy,并提供所述测斜仪输出;b.)感应平台围绕旋转轴的旋转速度w,并提供指示旋转速度w的输出;c.)对旋转速度w求微分以确定平台的角加速度dw/dt;d.)用值r乘以角加速度以确定平台上安装了测斜仪的点处的切向加速度r(dw/dt);e.)分解平台上安装了测斜仪的点处的切向加速度以确定其X轴分量;f.)分解平台上安装了测斜仪的点处的切向加速度以确定其Y轴分量;g.)从平行于X轴方向上感应的加速度Ix中减去平台上安装了测斜仪的点处的切向加速度的X轴分量;以及h.)从平行于Y轴方向上感应的加速度Iy中减去平台上安装了测斜仪的点处的切向加速度的Y轴分量,由此,测斜仪输出Ix和Iy被用于校正可能由切向加速度导致的误差。
所述方法还可包括以下步骤:i.)将平台围绕旋转轴的旋转速度w进行平方,并用距离r乘以所述旋转速度的平方,以提供平台的径向加速度;.j.)分解平台上安装了测斜仪的点处的径向加速度以确定其X轴分量;k.)分解平台上安装了测斜仪的点处的径向加速度以确定其Y轴分量;l.)从平行于X轴方向上感应的加速度Ix中减去平台上安装了测斜仪的点处的径向加速度的X轴分量;以及m.)从平行于Y轴方向上感应的加速度Iy中减去平台上安装了测斜仪的点处的径向加速度的Y轴分量,由此,测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
分解平台上安装了测斜仪的点处的径向加速度以确定其X轴分量,并且分解平台上安装了测斜仪的点处的径向加速度以确定其Y轴分量的步骤可包括以下步骤:分别用cos(B)和sin(B)乘以平台上安装了测斜仪的点处的径向加速度以确定X轴和Y轴分量。角度B为从旋转轴到测斜仪的直线与X轴之间的夹角。
分解平台上安装了测斜仪的点处的切向加速度以确定其X轴分量,并且分解平台上安装了测斜仪的点处的切向加速度以确定其Y轴分量的步骤包括以下步骤:分别用sin(B)和cos(B)乘以平台上安装了测斜仪的点处的切向加速度以确定X轴和Y轴分量。角度B为从旋转轴到测斜仪的直线与X轴之间的夹角。
因此,本发明的目的在于提供一种布置和方法,通过所述布置和方法可以给系统中的径向和切向加速度提供补偿,在所述系统中通过测斜仪确定活动元件相对于重力的取向。
附图说明
图1示出了一种机械,以挖掘机说明,本发明的系统和方法可被用于所述机械以改进机械元件的倾角测量;
图2为图1的挖掘机的概略示图,如以上所示,示出了机械平台的旋转轴和平台测斜仪的位置;以及
图3为根据本发明的系统的示意图,所述系统用于根据本发明以强化的方式感应倾角。
具体实施方式
参见图1,其示出了挖掘机1,所述挖掘机1具有可定位的工具,例如挖斗2,所述挖斗2附于工具定位装置3。所述工具定位装置3包括铲斗柄4,以及连接到挖掘机1的驾驶室6的吊臂5。所述驾驶室6起到平台的作用,在操作者的控制下或车载挖掘机控制系统的控制下,可通过一系列的液压缸7将吊臂5、铲斗柄4和挖斗2从所述平台上移走。
所述工具定位装置3可包括多个线位或角位编码器或其它类似的传感器(未显示),其输出可指示所述工具定位装置3相对于驾驶室6的取向和位置。编码器可被设置在沿着吊臂5、铲斗柄4和挖斗2的各个位置。例如,编码器可指示连杆和液压缸的线位,或枢转点10、11和12的相对角度。然而,将理解,所有这些测量均和平台或驾驶室6相关,并且因此需要驾驶室或平台相对于重力的倾角,以评定工具定位装置的取向。
车载工具控制系统可使用各个编码器输出的信息,以自动定位挖斗2或用于指导操作者手动定位挖斗2。例如,车载处理系统可有权使用数字地面模型,所述数字地面模型针对施工现场的各种位置指定设计高度。车载处理还可包括精确的定位系统,例如GPS接收系统20。所述车载处理系统可使用来自数字地面模型的数据和来自GPS接收器20的位置数据,以定位挖斗2或在操作者手动定位挖斗2时提供指导。
将理解,作为此方法的一部分,确定平台6的倾角是十分重要的,并且测斜仪30被设置在平台6上,如图1和图2中所示。如将理解的,测斜仪30为双轴测斜仪,所述双轴测斜仪提供沿着X轴32和Y轴34的倾角的指示。通常,这种设备感应重力加速度,并且在X或Y方向上的加速度程度指示了平台6从精确水平方向倾斜的程度。在操作机械时,挖掘机1可围绕垂直的Z轴36枢转。应该理解,这种旋转导致径向的和切向加速力被施加到测斜仪30,这将导致暂态误差。虽然可能周期性地暂停挖掘机的操作以允许暂态误差减小从而可获得平台取向的精确读数,但这种操作方法是效率低的。本发明考虑一种系统,在所述系统中,使用速率陀螺确定切向和径向加速度水平,并且从测得的加速度水平中减去所述切向和径向加速度水平,以提供倾角的补偿指示。
测斜仪30被安装在平台6上与旋转轴36间隔距离r的位置处,并提供指示X和Y方向上加速度的测斜仪输出,在图3中,所述测斜仪输出被分别指定为Ix和Iy。从旋转轴36到测斜仪30的直线与X轴32形成了夹角B。速率陀螺40被安装在平台6上并感应平台6围绕旋转轴36的旋转速度w。速率陀螺40提供了指示旋转速度w的速率陀螺输出。图3指示了一种方法,在所述方法中,结合角度B和距离r(所述角度B和距离r二者在系统被安装时被确定且在此布置中保持不变)使用速率陀螺输出w,以确定切向和径向加速度,以便于校正来自测斜仪30的输出。
电路42对速率陀螺输出w求微分以将平台6的角加速度确定为dw/dt。电路44用值r乘以角加速度dw/dt,以确定平台上安装了测斜仪的点处的切向加速度为r(dw/dt)。电路46分解平台6上安装了测斜仪30的点处的切向加速度r(dw/dt),以确定其X轴分量Atx,并分解平台上安装了测斜仪30的点处的切向加速度,以确定其Y轴分量Aty。为了将切向加速度分解为其X轴和Y轴分量,在48和50处用B的正弦和余弦乘以加速度,所述B的正弦和余弦分别由电路52和54提供。
电路56被提供用于从平行于X轴的方向上感应的加速度Ix中减去平台上安装了测斜仪的点处的切向加速度的X轴分量Atx,并且用于从平行于Y轴的方向上感应的加速度Iy中减去平台上安装了测斜仪的点处的切向加速度的Y轴分量Atx。结果,测斜仪输出Ix和Iy被用于校正切向加速度导致的误差,并且分别被提供为输出Ixc和Iyc。电路56包括用于进行所需减法的电路58和电路60。
本发明也可校正当平台6围绕Z轴36旋转时由于测斜仪的径向加速度产生的误差。为此,所述系统包括电路62,所述电路62将来自速率陀螺40的输出w(平台6围绕旋转轴36的旋转速度w)平方,并用距离r乘以旋转速度的平方w2,以确定平台6的径向加速度rw2。电路62包括乘法器64和平方电路66。电路68被提供用于分解平台6上安装了测斜仪30的点处的径向加速度Ar,以确定其X轴分量Arx,并且用于分解平台6上安装了测斜仪30的点处的径向加速度Ar,以确定其Y轴分量Ary。为了将径向加速度分解为其X轴和Y轴分量,在70和72处用B的正弦和余弦乘以加速度,所述B的正弦和余弦分别由电路52和54提供。最后,电路56从平行于X轴的方向上感应的加速度Ix减去平台6上安装了测斜仪30的点处的径向加速度的X轴分量,并且从平行于Y轴的方向上感应的加速度Iy减去平台6上安装了测斜仪30的点处的径向加速度的Y轴分量。通过这种装置,测斜仪输出Ix和Iy被用于校正径向加速度导致的误差。
应当理解,虽然在说明书和权利要求中通过执行所需功能的一系列分立电路实施的形式来说明本发明,但是本发明和权利要求包含这些构造,即,在所述构造中,这些电路通过微处理器或其它构建基于计算机的实施。所说明的电路提供了数据被处理的方法的说明,但是通过软件或固件完成这些功能的计算机系统被认为是在本发明范围内。
显然,本发明不受限于校正平台的倾角测量,而是实际上本发明可被用于校正任何设置中针对切向加速度和径向加速度的基于重力的测量。例如,如果基于重力的测斜仪80(图1中以虚线示出)被安装在例如挖掘机1的铲斗柄4的机械元件上,则由于切向和径向加速度,平台6围绕轴36的旋转将在测斜仪80提供的测量中产生误差。以如上所述大体相同的方式从测斜仪输出中去除这些误差。然而,在此布置中必需考虑距离r’不是常量,而是在挖掘机的操作中不断变化的。应该相信,以这种方式操作的系统落入本发明和附加权利要求的范围内。
可从附图、公开和附加权利要求的研究中获得本发明的其它方面、目的和优势。
Claims (16)
1.一种用于感应元件相对于重力的倾角的系统,所述元件限定了正交的X轴和Y轴,以及与所述X轴和Y轴二者正交的Z轴,所述元件可围绕平行于所述Z轴延伸的旋转轴旋转,所述系统包括:
测斜仪,所述测斜仪被安装在所述元件上与所述旋转轴间隔距离r的位置处,所述测斜仪用于提供指示X和Y方向上的加速度的测斜仪输出,所述测斜仪输出分别被指定为Ix和Iy,从所述旋转轴到所述测斜仪的直线与所述X轴形成夹角B;
传感器,所述传感器被安装在平台上,所述传感器用于感应元件围绕所述旋转轴的旋转速度w,并提供指示所述旋转速度w的传感器输出;
电路,所述电路用于对所述传感器输出求微分以确定所述元件的角加速度dw/dt;
电路,所述电路用值r乘以所述角加速度,以确定所述元件上安装了所述测斜仪的点处的切向加速度r(dw/dt);
电路,所述电路分解所述元件上安装了所述测斜仪的所述点处的切向加速度,以确定其X轴分量,并分解所述平台上安装了所述测斜仪的所述点处的切向加速度,以确定其Y轴分量;以及
电路,所述电路从平行于所述X轴的方向上感应的所述加速度Ix中减去所述元件上安装了所述测斜仪的所述点处的所述切向加速度的所述X轴分量,并且从平行于所述Y轴的方向上感应的所述加速度Iy中减去所述元件上安装了所述测斜仪的所述点处的所述切向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
2.根据权利要求1所述的系统,还包括:
电路,所述电路用于将元件围绕所述旋转轴的旋转速度w平方,并用距离r乘以旋转速度的平方,以确定元件的径向加速度;
电路,所述电路用于分解所述元件上安装了所述测斜仪的所述点处的径向加速度,以确定其X轴分量,并用于分解所述元件上安装了所述测斜仪的所述点处的径向加速度,以确定其Y轴分量;以及
电路,所述电路用于从平行于所述X轴的方向上感应的所述加速度Ix中减去所述元件上安装了所述测斜仪的所述点处的所述径向加速度的所述X轴分量,并用于从平行于所述Y轴的方向上感应的所述加速度Iy中减去所述元件上安装了所述测斜仪的所述点处的所述径向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
3.根据权利要求2所述的系统,其中所述电路用于分解所述元件上安装了所述测斜仪的所述点处的径向加速度,以确定其X轴分量,并用于分解所述元件上安装了所述测斜仪的所述点处的径向加速度,以确定其Y轴分量,分别用cos(B)和sin(B)乘以所述元件上安装了所述测斜仪的所述点处的所述径向加速度来确定所述X轴和Y轴分量。
4.根据权利要求1所述的系统,其中所述电路用于分解所述元件上安装了所述测斜仪的所述点处的切向加速度,以确定其X轴分量,并用于分解所述元件上安装了所述测斜仪的所述点处的切向加速度,以确定其Y轴分量,分别用sin(B)和cos(B)乘以所述元件上安装了所述测斜仪的所述点处的所述切向加速度来确定所述X轴和Y轴分量。
5.一种用于感应元件相对于重力的倾角的方法,所述元件限定了正交的X轴和Y轴,以及与X轴和Y轴二者正交的Z轴,所述元件可围绕平行于所述Z轴延伸的旋转轴旋转,所述方法包括以下步骤:
感应来自被安装在所述元件上与所述旋转轴间隔距离r的位置处的测斜仪的X和Y方向上的加速度,所述加速度分别被指定为Ix和Iy,并提供指示X和Y方向上的加速度的测斜仪输出;
感应元件围绕所述旋转轴的旋转速度w,并提供指示所述旋转速度w的输出;
对所述旋转速度w求微分,以确定所述元件的角加速度dw/dt;
用值r乘以所述角加速度,以确定所述元件上安装了所述测斜仪的所述点处的切向加速度r(dw/dt);
分解所述元件上安装了所述测斜仪的所述点处的切向加速度,以确定其X轴分量;
分解所述元件上安装了所述测斜仪的所述点处的切向加速度,以确定其Y轴分量;
从平行于所述X轴方向上感应的所述加速度Ix中减去所述元件上安装了所述测斜仪的所述点处的所述切向加速度的所述X轴分量;以及
从平行于所述Y轴方向上感应的所述加速度Iy中减去所述元件上安装了所述测斜仪的所述点处的所述切向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由切向加速度导致的误差。
6.根据权利要求5所述的方法,还包括以下步骤:
将所述元件围绕所述旋转轴的旋转速度w平方,并用距离r乘以旋转速度的平方,以提供所述元件的径向加速度;
分解所述元件上安装了所述测斜仪的所述点处的径向加速度,以确定其X轴分量;
分解所述元件上安装了所述测斜仪的所述点处的径向加速度,以确定其Y轴分量;
从平行于所述X轴方向上感应的所述加速度Ix中减去所述元件上安装了所述测斜仪的所述点处的所述径向加速度的所述X轴分量;以及
从平行于所述Y轴方向上感应的所述加速度Iy中减去所述元件上安装了所述测斜仪的所述点处的所述径向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
7.根据权利要求6所述的方法,其中分解所述元件上安装了所述测斜仪的所述点处的径向加速度以确定其X轴分量,并且分解所述元件上安装了所述测斜仪的所述点处的径向加速度以确定其Y轴分量的所述步骤包括以下步骤:分别用cos(B)和sin(B)乘以所述元件上安装了所述测斜仪的所述点处的所述径向加速度以确定所述X轴和Y轴分量,所述角度B为从所述旋转轴到所述测斜仪的直线与所述X轴之间的夹角。
8.根据权利要求5所述的方法,其中分解所述元件上安装了所述测斜仪的所述点处的切向加速度以确定其X轴分量,并且分解所述元件上安装了所述测斜仪的所述点处的切向加速度以确定其Y轴分量的所述步骤包括以下步骤:分别用sin(B)和cos(B)乘以所述元件上安装了所述测斜仪的所述点处的所述切向加速度以确定所述X轴和Y轴分量,所述角度B为从所述旋转轴到所述测斜仪的直线与所述X轴之间的夹角。
9.一种用于感应平台相对于重力的倾角的系统,所述平台限定了正交的X轴和Y轴,以及与所述X轴和Y轴二者正交的Z轴,所述平台可围绕平行于所述Z轴延伸的旋转轴旋转,所述系统包括:
测斜仪,所述测斜仪被安装在所述平台上与所述旋转轴间隔距离r的位置处,所述测斜仪用于提供指示X和Y方向上的加速度的测斜仪输出,所述测斜仪输出分别被指定为Ix和Iy,从所述旋转轴到所述测斜仪的直线与所述X轴形成夹角B;
速率陀螺,所述速率陀螺被安装在平台上,用于感应平台围绕所述旋转轴的旋转速度w,并提供指示所述旋转速度w的速率陀螺输出;
电路,所述电路用于对所述速率陀螺输出求微分,以确定所述平台的角加速度dw/dt;
电路,所述电路用值r乘以所述角加速度,以确定所述平台上安装了所述测斜仪的所述点处的切向加速度r(dw/dt);
电路,所述电路用于分解所述平台上安装了所述测斜仪的所述点处的切向加速度,以确定其X轴分量,并且用于分解所述平台上安装了所述测斜仪的所述点处的切向加速度,以确定其Y轴分量;以及
电路,所述电路用于从平行于所述X轴的方向上感应的所述加速度Ix中减去所述平台上安装了所述测斜仪的所述点处的所述切向加速度的所述X轴分量,并且用于从平行于所述Y轴的方向上感应的所述加速度Iy中减去所述平台上安装了所述测斜仪的所述点处的所述切向加速度的所述Y轴分量,由此所述测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
10.根据权利要求9所述的系统,还包括:
电路,所述电路用于将平台围绕所述旋转轴的旋转速度w平方,并用距离r乘以旋转速度的平方,以确定平台的径向加速度;
电路,所述电路用于分解所述平台上安装了所述测斜仪的所述点处的径向加速度,以确定其X轴分量,并用于分解所述平台上安装了所述测斜仪的所述点处的径向加速度,以确定其Y轴分量;以及
电路,所述电路用于从平行于所述X轴的方向上感应的所述加速度Ix中减去所述平台上安装了所述测斜仪的所述点处的所述径向加速度的所述X轴分量,并用于从平行于所述Y轴的方向上感应的所述加速度Iy中减去所述平台上安装了所述测斜仪的所述点处的所述径向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
11.根据权利要求10所述的系统,其中用于分解所述平台上安装了所述测斜仪的所述点处的径向加速度以确定其X轴分量,并用于分解所述平台上安装了所述测斜仪的所述点处的径向加速度以确定其Y轴分量的所述电路分别用cos(B)和sin(B)乘以所述平台上安装了所述测斜仪的所述点处的所述径向加速度,以确定所述X轴和Y轴分量。
12.根据权利要求9所述的系统,其中用于分解所述平台上安装了所述测斜仪的所述点处的切向加速度以确定其X轴分量,并用于分解所述平台上安装了所述测斜仪的所述点处的切向加速度以确定其Y轴分量的所述电路分别用sin(B)和cos(B)乘以所述平台上安装了所述测斜仪的所述点处的所述切向加速度,以确定所述X轴和Y轴分量。
13.一种用于感应平台相对于重力的倾角的方法,所述平台限定了正交的X轴和Y轴,以及与X轴和Y轴二者正交的Z轴,所述平台可围绕平行于所述Z轴延伸的旋转轴旋转,所述方法包括以下步骤:
感应来自被安装在所述平台上与所述旋转轴间隔距离r的位置处的测斜仪的X和Y方向上的加速度,所述加速度分别被指定为Ix和Iy,并提供指示X和Y方向上加速度的测斜仪输出;
感应平台围绕所述旋转轴的旋转速度w,并提供指示所述旋转速度w的输出;
对所述旋转速度w求微分,以确定所述平台的角加速度dw/dt;
用值r乘以所述角加速度,以确定所述平台上安装了所述测斜仪的所述点处的切向加速度r(dw/dt);
分解所述平台上安装了所述测斜仪的所述点处的切向加速度,以确定其X轴分量;
分解所述平台上安装了所述测斜仪的所述点处的切向加速度,以确定其Y轴分量;
从平行于所述X轴方向上感应的所述加速度Ix中减去所述平台上安装了所述测斜仪的所述点处的所述切向加速度的所述X轴分量;以及
从平行于所述Y轴方向上感应的所述加速度Iy中减去所述平台上安装了所述测斜仪的所述点处的所述切向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由切向加速度导致的误差。
14.根据权利要求13所述的方法,还包括以下步骤:
将所述平台围绕所述旋转轴的旋转速度w进行平方,并用距离r乘以旋转速度的平方,以提供平台的径向加速度;
分解所述平台上安装了所述测斜仪的所述点处的径向加速度,以确定其X轴分量;
分解所述平台上安装了所述测斜仪的所述点处的径向加速度,以确定其Y轴分量;
从平行于所述X轴方向上感应的所述加速度Ix中减去所述平台上安装了所述测斜仪的所述点处的所述径向加速度的所述X轴分量;以及
从平行于所述Y轴方向上感应的所述加速度Iy中减去所述平台上安装了所述测斜仪的所述点处的所述径向加速度的所述Y轴分量,由此,所述测斜仪输出Ix和Iy被用于校正可能由径向加速度导致的误差。
15.根据权利要求14所述的方法,其中分解所述平台上安装了所述测斜仪的所述点处的径向加速度以确定其X轴分量,并且分解所述平台上安装了所述测斜仪的所述点处的径向加速度以确定其Y轴分量的所述步骤包括以下步骤:分别用cos(B)和sin(B)乘以所述平台上安装了所述测斜仪的所述点处的所述径向加速度以确定所述X轴和Y轴分量,所述角度B为从所述旋转轴到所述测斜仪的直线与所述X轴之间的夹角。
16.根据权利要求13所述的方法,其中分解所述平台上安装了所述测斜仪的所述点处的切向加速度以确定其X轴分量,并且分解所述平台上安装了所述测斜仪的所述点处的切向加速度以确定其Y轴分量的所述步骤包括以下步骤:分别用sin(B)和cos(B)乘以所述平台上安装了所述测斜仪的所述点处的所述切向加速度以确定所述X轴和Y轴分量,所述角度B为从所述旋转轴到所述测斜仪的直线与所述X轴之间的夹角。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US12/140,451 | 2008-06-17 | ||
US12/140,451 US7650252B2 (en) | 2008-06-17 | 2008-06-17 | Inclinometer measurement system and method providing correction for movement induced acceleration errors |
PCT/US2009/047471 WO2009155269A2 (en) | 2008-06-17 | 2009-06-16 | Inclinometer measurement system and method providing correction for movement induced acceleration errors |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102066875A true CN102066875A (zh) | 2011-05-18 |
CN102066875B CN102066875B (zh) | 2013-11-13 |
Family
ID=41360265
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2009801221916A Active CN102066875B (zh) | 2008-06-17 | 2009-06-16 | 测斜仪测量系统和提供用于运动诱导加速度误差的校正的方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US7650252B2 (zh) |
CN (1) | CN102066875B (zh) |
DE (1) | DE112009001466B4 (zh) |
WO (1) | WO2009155269A2 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107532897A (zh) * | 2015-04-13 | 2018-01-02 | 莱卡地球系统公开股份有限公司 | 动态运动补偿 |
WO2018040288A1 (zh) * | 2016-08-29 | 2018-03-08 | 中国科学院地质与地球物理研究所 | 一种旋转状态下重力加速度测量装置与提取方法 |
Families Citing this family (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8150651B2 (en) | 2008-06-11 | 2012-04-03 | Trimble Navigation Limited | Acceleration compensated inclinometer |
US7856336B2 (en) * | 2008-06-11 | 2010-12-21 | Trimble Navigation Limited | Forward-looking altitude detector |
US9157737B2 (en) * | 2008-06-11 | 2015-10-13 | Trimble Navigation Limited | Altimeter with calibration |
US8566034B1 (en) * | 2008-06-11 | 2013-10-22 | Trimble Navigation Limited | Inclinometer with calibration |
DE102009018070A1 (de) * | 2009-04-20 | 2010-10-21 | Robert Bosch Gmbh | Mobile Arbeitsmaschine mit einer Positionsregeleinrichtung eines Arbeitsarms und Verfahren zur Positionregelung eines Arbeitsarms einer mobilen Arbeitsmaschine |
US8406996B2 (en) * | 2010-08-25 | 2013-03-26 | Trimble Navigation Limited | Cordless inertial vehicle navigation |
US8467967B2 (en) * | 2010-08-25 | 2013-06-18 | Trimble Navigation Limited | Smart-phone bracket for car and truck navigation |
US8548722B2 (en) * | 2011-08-12 | 2013-10-01 | Deere & Company | Tilt sensor and method for determining the tilt of a vehicle |
FI20115922A0 (fi) * | 2011-09-20 | 2011-09-20 | Konecranes Oyj | Nosturin ohjaus |
US9020776B2 (en) * | 2011-09-28 | 2015-04-28 | Caterpillar Inc. | Inclination angle compensation systems and methods |
US9145144B2 (en) * | 2011-09-28 | 2015-09-29 | Caterpillar Inc. | Inclination detection systems and methods |
US20140166362A1 (en) * | 2012-12-14 | 2014-06-19 | Caterpillar Inc. | Implement Pose Control System and Method |
US9945957B2 (en) | 2013-03-14 | 2018-04-17 | Agjunction Llc | Machine control system and method |
US9781915B2 (en) * | 2013-03-14 | 2017-10-10 | Agjunction Llc | Implement and boom height control system and method |
US20140372074A1 (en) * | 2013-06-14 | 2014-12-18 | Memsic, Inc. | Tip-over sensor |
CN103278135B (zh) * | 2013-06-25 | 2015-06-17 | 俞斌 | 激光水平精确检测系统 |
US9618338B2 (en) | 2014-03-18 | 2017-04-11 | Caterpillar Inc. | Compensating for acceleration induced inclination errors |
EP2930467A1 (en) | 2014-04-11 | 2015-10-14 | Airbus Defence and Space GmbH | A system and method for sensing the inclination of a moving platform with respect to gravity |
JP5844465B1 (ja) | 2014-05-19 | 2016-01-20 | 株式会社小松製作所 | 作業機械の姿勢演算装置、油圧ショベルの姿勢演算装置及び作業機械 |
WO2016043270A1 (ja) * | 2014-09-18 | 2016-03-24 | 住友建機株式会社 | ショベル |
US9617708B2 (en) | 2015-08-06 | 2017-04-11 | Honeywell International, Inc. | Methods and apparatus for correcting a position of an excavation vehicle using tilt compensation |
US9902300B2 (en) * | 2015-11-06 | 2018-02-27 | Clearmotion Acquisition I Llc | Lean-in cornering platform for a moving vehicle |
US9944206B2 (en) | 2015-11-06 | 2018-04-17 | Clearmotion Acquisition I Llc | Controlling active isolation platform in a moving vehicle |
US10245004B2 (en) | 2016-01-06 | 2019-04-02 | General Electric Company | Systems and methods for imbalance measurement of rotating machinery |
US10002469B2 (en) | 2016-09-09 | 2018-06-19 | The University Of Hong Kong | Inclinometer methods and systems for generating and calibrating an in-vehicle inclination angle |
DE102018200060B4 (de) | 2018-01-04 | 2024-05-08 | Robert Bosch Gmbh | Verfahren zum Betreiben einer mobilen Arbeitsmaschine und mobile Arbeitsmaschine |
CN109059959B (zh) * | 2018-06-12 | 2023-07-07 | 湖北省地震局 | 水管倾斜仪整机检测系统及其方法 |
NO20180946A1 (en) * | 2018-07-05 | 2020-01-06 | Mhwirth As | Position Measuring Method and System for use on a Floating Installation |
DE102018118147A1 (de) * | 2018-07-26 | 2020-01-30 | Liebherr-Mining Equipment Colmar Sas | Verfahren zum Bestimmen eines Winkels eines Arbeitsgeräts einer Maschine |
CN111609785B (zh) * | 2020-05-22 | 2021-10-26 | 水利部南京水利水文自动化研究所 | 一种测斜仪自动率定装置及率定方法 |
EP4296434A1 (en) | 2022-06-22 | 2023-12-27 | Leica Geosystems Technology A/S | Improved determination of an excavator swing boom angle based on intermittent first interim swing boom angles |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4038876A (en) * | 1976-03-04 | 1977-08-02 | Systron Donner Corporation | Acceleration error compensated attitude sensing and control apparatus and method |
FR2511146B1 (fr) * | 1981-08-07 | 1986-07-25 | British Aerospace | Instrument de navigation |
US4920655A (en) * | 1984-07-30 | 1990-05-01 | Applied Technologies Associates | High speed well surveying and land navigation |
DE3907134A1 (de) | 1989-03-06 | 1990-09-13 | Marco Systemanalyse Entw | Verfahren und vorrichtung zur lagebestimmung eines an dem freien ende des mehrgelenkigen auslegers angeordneten werkzeuges |
DE3924691C2 (de) * | 1989-07-26 | 1993-11-04 | Daimler Benz Ag | Verfahren zur kompensation von fehlern eines beschleunigungsgebers |
FI920754A0 (fi) | 1992-02-21 | 1992-02-21 | Novatron | Foerfarande foer att definiera laeget av ett laongstraeckt stycke. |
US7216055B1 (en) * | 1998-06-05 | 2007-05-08 | Crossbow Technology, Inc. | Dynamic attitude measurement method and apparatus |
US6647352B1 (en) * | 1998-06-05 | 2003-11-11 | Crossbow Technology | Dynamic attitude measurement method and apparatus |
US6253160B1 (en) | 1999-01-15 | 2001-06-26 | Trimble Navigation Ltd. | Method and apparatus for calibrating a tool positioning mechanism on a mobile machine |
DE19955925A1 (de) | 1999-11-20 | 2001-05-23 | Hermann Eilers | Verfahren zur Positionsbestimmung eines Auslegers einer Arbeitsmaschine |
US6518519B1 (en) | 2000-08-30 | 2003-02-11 | Caterpillar Inc | Method and apparatus for determining a weight of a payload |
US6873931B1 (en) * | 2000-10-10 | 2005-03-29 | Csi Technology, Inc. | Accelerometer based angular position sensor |
US6600985B2 (en) * | 2001-03-26 | 2003-07-29 | Indiana Mills & Manufacturing, Inc. | Roll sensor system for a vehicle |
US6691437B1 (en) | 2003-03-24 | 2004-02-17 | Trimble Navigation Limited | Laser reference system for excavating machine |
US6880258B2 (en) * | 2003-08-26 | 2005-04-19 | Horizon Hobby | Digital inclinometer and related methods |
DE10348570A1 (de) * | 2003-10-20 | 2005-05-12 | Rudolf Schubach | Vorrichtung zum Messen der Drehrate in einer Ebene und des Schwimmwinkels von Fahrzeugen |
NZ538885A (en) * | 2005-03-15 | 2006-10-27 | Actronic Ltd | Weighing device for excavator payloads |
CN100487374C (zh) * | 2006-07-21 | 2009-05-13 | 北京航空航天大学 | 消除动调式陀螺测斜仪惯性器件常值误差的对转定位机构 |
-
2008
- 2008-06-17 US US12/140,451 patent/US7650252B2/en active Active
-
2009
- 2009-06-16 WO PCT/US2009/047471 patent/WO2009155269A2/en active Application Filing
- 2009-06-16 CN CN2009801221916A patent/CN102066875B/zh active Active
- 2009-06-16 DE DE112009001466.6T patent/DE112009001466B4/de active Active
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107532897A (zh) * | 2015-04-13 | 2018-01-02 | 莱卡地球系统公开股份有限公司 | 动态运动补偿 |
CN107532897B (zh) * | 2015-04-13 | 2020-11-17 | 莱卡地球系统公开股份有限公司 | 提供对运动学加速度的补偿的方法和补偿测量结果的系统 |
WO2018040288A1 (zh) * | 2016-08-29 | 2018-03-08 | 中国科学院地质与地球物理研究所 | 一种旋转状态下重力加速度测量装置与提取方法 |
US11002128B2 (en) | 2016-08-29 | 2021-05-11 | Institute Of Geology And Geophysics, Chinese Academy Of Sciences | Gravity acceleration measurement apparatus and extraction method in a rotating state |
Also Published As
Publication number | Publication date |
---|---|
DE112009001466T5 (de) | 2011-05-12 |
CN102066875B (zh) | 2013-11-13 |
US20090312974A1 (en) | 2009-12-17 |
US7650252B2 (en) | 2010-01-19 |
WO2009155269A3 (en) | 2010-02-25 |
DE112009001466B4 (de) | 2018-12-06 |
WO2009155269A2 (en) | 2009-12-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102066875B (zh) | 测斜仪测量系统和提供用于运动诱导加速度误差的校正的方法 | |
CN103808331B (zh) | 一种mems三轴陀螺仪误差标定方法 | |
US7463953B1 (en) | Method for determining a tilt angle of a vehicle | |
CN101629969B (zh) | 一种低精度光纤惯组输出误差的标定补偿和测试方法及装置 | |
EP0077504A2 (en) | Heading reference system | |
CN101617199B (zh) | 一种用于补偿位置测量设备中的漂移的方法 | |
KR20090018659A (ko) | 자세각 검출 장치와 자세각 검출 방법 | |
CN102269592A (zh) | 基于传感器的定向系统 | |
CN112567097B (zh) | 用于确定机器的作业设备的角度的方法 | |
CN116125789A (zh) | 一种基于四元数的姿态算法参数自动匹配系统及方法 | |
JP2008002842A (ja) | 作業機械の姿勢計測方法及び姿勢計測装置 | |
CN107063181A (zh) | 复杂环境下多功能调试台的水平倾角的测量方法及装置 | |
CN114034885A (zh) | 一种基于全误差分析的陀螺加速度计在双轴离心机上的测试方法 | |
US20230417025A1 (en) | Determination of an excavator swing boom angle based on the direction of the centripetal acceleration | |
CN110542430B (zh) | 一种惯性测量单元大动态性能测试装置及方法 | |
US6502055B1 (en) | Method and apparatus for determining the geographic heading of a body | |
CN114324977B (zh) | 一种基于全误差分析的在离心机上对惯性导航的加速度计标定的方法 | |
JP2023101310A (ja) | 校正値の算出方法 | |
JP2024530351A (ja) | センサ装置および機械を監視するセンサシステム | |
JP3732829B2 (ja) | 傾斜角計測装置および傾斜角計測方法 | |
CN113805215A (zh) | 工程机械位姿确定方法、装置、工程机械及存储介质 | |
CN1080414C (zh) | 磁化罗盘的水平稳定方法 | |
CN108007458A (zh) | 一种捷联惯性原件连接装置及其用于测量机械臂角度方法 | |
JP2822662B2 (ja) | 半導体加速度検出装置の測定方法 | |
CN117848386A (zh) | 轨道检测小车惯导性能检测方法 |
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 |