CN104699119B - 一种装载平台及装载物的水平调节控制方法 - Google Patents
一种装载平台及装载物的水平调节控制方法 Download PDFInfo
- Publication number
- CN104699119B CN104699119B CN201510028501.5A CN201510028501A CN104699119B CN 104699119 B CN104699119 B CN 104699119B CN 201510028501 A CN201510028501 A CN 201510028501A CN 104699119 B CN104699119 B CN 104699119B
- Authority
- CN
- China
- Prior art keywords
- loading platform
- level meter
- prime
- coordinate system
- inclination angle
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000006073 displacement reaction Methods 0.000 claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims abstract description 9
- 230000007704 transition Effects 0.000 claims abstract description 9
- 238000006243 chemical reaction Methods 0.000 claims abstract description 7
- 230000009466 transformation Effects 0.000 claims description 5
- 230000015572 biosynthetic process Effects 0.000 claims description 4
- 238000003786 synthesis reaction Methods 0.000 claims description 4
- 238000012544 monitoring process Methods 0.000 abstract description 11
- 230000008569 process Effects 0.000 description 9
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000009975 flexible effect Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000003534 oscillatory effect Effects 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000005855 radiation Effects 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000010438 heat treatment Methods 0.000 description 1
- 239000010720 hydraulic oil Substances 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000010338 mechanical breakdown Methods 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000001225 therapeutic effect Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Landscapes
- Details Of Measuring And Other Instruments (AREA)
Abstract
本发明的目的在于提供一种控制精度高,且能够实时监测和自动调节的装载平台及装载物的水平调节控制方法。本发明包括:采集水平仪数据;将水平仪坐标系下的倾角单位化;将水平仪坐标系下的表达式利用转换矩阵转换成为调平目标下的表达式,平台为调平目标,转换后的倾角表达式变为,求出倾角值;用当前倾斜角分别与初始安装倾斜角作差得到调整角;再次置平装载平台的支腿,调整位移。本发明实时监测水平仪倾角,出现偏差时自动实时调节,无需人工操作,效率高,控制精度高,可靠性高,在出现某一支腿卡死时,还可以通过调节其他支腿使调平目标水平。
Description
技术领域
本发明涉及地面空间模拟实验领域,具体涉及一种满足仪器设备工作对水平度的高精度要求的装载平台及装载物的水平调节控制方法。
背景技术
卫星在地面进行空间模拟实验时对水平度有很高的要求,然而外部辐射和内部设备的发热引起的装载卫星的平台受热不均匀会引起水平度超差,在真空环境中不可能进行人工调节,自动调平可解决这一问题。一些仪器设备对安放的水平度有较高要求,虽然已有很多水平调节仪器,但它们的调节效果不是很好,在装载平台上安装有设备时,通过传统的观察水平仪,用人工去升降各支点使其水平,难度大,效率低。例如在军工领域,对雷达天线车要求能快速自动地实现较高精度水平基准的调整,对于水平基准的调整,过去往往采用人工手动调平方式,依靠人眼观察基准水泡,经反复调整才能达到水平要求,调平时间较长,而且调平精度受到人为因素干扰较大;在医学领域,放射性治疗技术对CT治疗床的安放要求水平度很高,但目前的技术要达到此精度尚困难。
目前已知的平台水平调节控制方法中,有通过重力作用使摆杆与水平面保持垂直,悬臂保持水平,通过悬臂控制充气阀的开闭调节支腿上的空气弹簧来达到水平的。相关专利文献请参考公开号为CN 102806819 B的中国专利申请文件《平台水平自动调整装置及调整方法》。该方法在调平后需要保证其拥有自锁能力,即调平后长时间保持水平状态,且需要***抗干扰能力强,这就需要平台具有极高的稳定性,传统的气压式伺服***往往由于气压***自身缺点无法保证长时间的保持高度水平状态。再者参考公开号为CN104057612 A的中国专利申请文件《3D打印机用自动调平装置及3D打印机及调平方法》给出了一种位置误差调平法,判断各测量点到测距传感器的距离与距离的平均值是否在误差允许范围内,若超差则控制电机调整距离,若不超差结束此次调平。需要频繁移动测距传感器确定电机支撑点坐标和测量点到测距传感器的距离,操作相对复杂。文章《空间模拟器大型卫星装载平台监控***的实现》所述调平方法未考虑水平仪与平台不在同一平面的情况。
总的来说,现有平台水平调节方法存在如下的一些缺点:
1.自动调平的液压驱动方式可承载较大的负载,但液压***复杂,反应迟缓,一般会滞后,不易实现实时控制,且液压油易泄漏,维护较难。
2.实时性差,从监测到倾角超差到再次置平需要时间周期长;
3.调节精度低,运用常规的气泡水平仪或重力作用监测水平度;
4.自动化程度低,甚至需要人工调平。
发明内容
本发明的目的在于提供一种控制精度高,且能够实时监测和自动调节的装载平台及装载物的水平调节控制方法。
本发明的目的是这样实现的:
(1)采集水平仪数据:调平目标水平时,装载平台坐标系为O-XYZ、装载物坐标系为O'-X'Y'Z'和水平仪坐标系为O”-X”Y”Z”,水平仪在X轴Y轴上的倾角为θ”X0,θ”Y0,采集当前水平仪读数为θ”X1,θ”Y1;
(2)将水平仪坐标系下的倾角θ”X0,θ”Y0单位化,表达式为(i”0,j”0,k”0),其中
(3)将水平仪坐标系下的表达式(i”0,j”0,k”0)利用转换矩阵转换成为调平目标下的表达式,平台为调平目标,转换后的倾角表达式变为(i0,j0,k0),求出倾角值
求出当前装载平台的倾角值θX1,θY1;
(4)用当前倾斜角θX1,θY1分别与初始安装倾斜角θX,θY作差得到调整角:
ΔθX=θX1-θX0,
ΔθY=θY1-θY0,
合成后的倾斜角:
测量极限倾斜角θL,如果θ>θL,继续调整载物平台;如果θ≤θL,不再需要调整载物平台;
(5)再次置平装载平台的支腿,调整位移
转换矩阵
其中α,β,γ为三维空间直角坐标变换的三个旋转角。
本发明的有益效果在于:
本发明实时监测水平仪倾角,出现偏差时自动实时调节,无需人工操作,效率高,控制精度高,可靠性高,在出现某一支腿卡死时,还可以通过调节其他支腿使调平目标水平。
附图说明
图1是本发明实施例提供的装载平台及其装载物的水平调节控制方法流程图;
图2是实施例一装载平台、装载物和水平仪位置示意图;
图3是水平仪在X和Y轴方向上的倾角读数示意图;
图4是装载平台坐标系O-XYZ、装载物坐标系O'-X'Y'Z'和水平仪坐标系O”-X”Y”Z”转换示意图;
图5是四支腿装载平台坐标系示意图, 图 6 是 三支腿装载平台坐标系示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。图中标号说明:
水平仪1,装载平台2,支腿3,装载物4。
鉴于所述对水平精度的高要求和现有技术的局限,本发明提供了一种装载平台水平调节控制方法,所述装载平台设有三或四条支腿,每条支腿上固定有电机控制支腿的伸缩,水平仪安放在装载平台或装载物上,根据监测到的水平仪倾角,计算出支腿应伸缩的距离以再次置平调平目标(装载平台或装载物),控制电机调节支腿。
装载平台的水平控制方法包括:
信号采集***,由固定在装载平台或装载物上的高精度水平仪、固定在支腿上的位移传感器组成,高精度水平仪实时监测装载平台或装载物在X和Y轴方向的倾角,位移传感器实时监测支腿的位移;
位移控制***,由支腿组件和固定在支腿上的电机组成,电机通过蜗杆减速器与支腿组件相连,控制支腿的伸缩,并可实现自锁;
电控***,根据信号采集***传来的数据计算支腿的位移以控制调平目标的水平。
装载平台的水平控制方法可实现平台的自动调平功能,水平仪数据的采集和调平算法完全由控制程序来实现。
采集水平仪数据用到中断循环程序,每隔一个中断周期向水平仪发送一次采集请求,水平仪接受请求后向控制器返回当前倾角值
装载平台的调平算法:
装载平台为正方形,四支腿装载平台四个角上分别设置支腿,两对角线分别为X轴Y轴,交点为原点;三支腿装载平台支腿位置呈正三角形分布,两相邻角上设置支腿,设为X轴,垂直平分线为Y轴,另一支腿位置也就确定了。
当水平仪坐标系与装载平台或装载物坐标系不重合时,能够将水平仪的读数转换成装载平台坐标系下的倾斜角度,具体包括:
设装载平台坐标系为O-XYZ,装载物坐标系为O'-X'Y'Z',水平仪坐标系为O”-X”Y”Z”。
①以装载物为调平目标,水平仪安放在装载物上,把水平仪X和Y轴方向的倾角θx”和θY”由水平仪坐标系O”-X”Y”Z”转换成装载物坐标系O'-X'Y'Z'下的倾角;
②以装载物为调平目标,水平仪安放在装载平台上,把水平仪X和Y轴方向的倾角θx”和θY”由水平仪坐标系O”-X”Y”Z”转换成装载物坐标系O'-X'Y'Z'下的倾角;
③以装载平台为调平目标,水平仪安放在装载物上,把水平仪X和Y轴方向的倾角θx”和θY”由水平仪坐标系O”-X”Y”Z”转换成装载平台坐标系O-XYZ下的倾角;
装载平台的调平算法:
a采集水平仪数据。受装载物外形的影响,水平仪一般不会无缝贴合安放在装载平台或装载物上,这必将会造成装载平台坐标系O-XYZ、装载物坐标系O'-X'Y'Z'和水平仪坐标系O”-X”Y”Z”不能重合的现象,所以调平目标水平时水平仪可能会倾斜。设调平目标水平时,水平仪在X轴Y轴上的倾角为θ”X0,θ”Y0,当前水平仪读数为θ”X1,θ”Y1。
b将水平仪坐标系下的倾角θ”X0,θ”Y0单位化,表达式为(i”0,j”0,k”0),其中
c将水平仪坐标下的表达式(i”0,j”0,k”0)利用转换矩阵转换成为调平目标下的表达式,不妨设平台为调平目标,转换后的倾角表达式变为(i0,j0,k0),求出倾角值用同样方法求出当前装载平台的倾角值θX1,θY1,
d用当前倾斜角θX1,θY1分别与初始安装倾斜角θX,θY作差即可得调整角
ΔθX=θX1-θX,
ΔθY=θY1-θY
合成后的倾斜角为
设极限倾斜角θL,如果θ>θL,需要调整载物平台;如果θ≤θL,则不需要调整,进入下一次循环。为了保证调节过程的安全性,在自动调平过程中必须防止出现超调,更不允许出现振荡情况。为此将采用保守的调平策略,设置一个最大调整量θL,这样就将调整过程分多次进行,调整过程更为安全。
e计算再次置平支腿的调整位移当θ较小时,tanθ≈θ,可取其中l为装载平台边长。为保证支腿的位移不会超限,可控制装载平台中心固定,则四条支腿的调整量分别为
Δl10=-Δx/2 Δl20=-Δy/2 Δl30=Δx/2 Δl40=Δy/2
若要求平台中心移动距离Δl,则可在原调整量上加上Δl,即
Δl10=-Δx/2+Δl,Δl20=-Δy/2+Δl
Δl30=Δx/2+Δl,Δl40=Δy/2-Δl10;
若为三支腿支撑平台,取平台边长为m,则调整位移Δx0=mtanθX,调整量为Δl10=-Δx0/2,Δl20=Δx0/2,Δl30=-Δy0;
水平仪的读数转换装载平台坐标系下的倾斜角度方法,运用转换矩阵:
可求
其中α,β,γ为三维空间直角坐标变换的三个旋转角。运用以上转换方法分别将平台水平时水平仪的读数和当前监测到的水平仪读数转换成平台坐标系下的倾角值;
本发明可实现平台的自动调平功能,可实现调节范围外自动限位。支腿具有的移动部分具有上下限位开关和位移传感器,当支腿行程超限时触发限位开关闭合,实现硬限位。同时编有限位控制程序,接收来自位移传感器的数据,当支腿位移超过上限值或下限值时,触发报警开关。
若装载平台上安放有两个装载物,在不考虑另一装载物的水平情况下,可控制任一装载物为调平目标。假设装载平台上有装载物A和B,A和B上分别安放有水平仪,现只调节装载物A的水平,分别将装载物A初始水平时和倾斜后的水平仪坐标系下的倾角值转换成为装载平台坐标系下的倾角值。同样,也可只调节装载物B的水平。
装载平台的水平调节方法,具有支腿“卡死”检测功能。为检测是否有支腿卡死的情况出现,编写一中断循环程序,程序中对每个支腿设置3个计数器,一个是支腿驱动数据的绝对值累加计数器,一个用于存储支腿驱动数据增量值,一个用于存储反馈数据的增量值。当支腿的驱动数据绝对值到某一数值时,检验支腿驱动数据增量值和反馈数据增量值的差值,若在要求的范围以内,说明支腿运动正常,对以上3个计数器清零继续工作;若差值超差,说明支腿运动异常,***将作出卡死报警。
当装载平台某一支腿出现卡死或其他机械故障不能伸缩时,能够通过调节其他支腿以达到调平目标(装载平台或装载物)的水平。当某一支腿卡死时,调平策略,方法如下:
保持卡死的支腿不动,其他的支腿调整值减去卡死支腿的调整值,假设支腿一卡死,则其他三条支腿的调整量为:
Δl20=-Δy/2-Δl10;Δl30=Δx/2-Δl10;Δl40=Δy/2-Δl10
若为三支腿支撑平台,假设支腿一卡死,则其他两条支腿的调整量为Δl20=Δx0/2-Δl10,Δl30=-Δy0/2-Δl10。
为了保证调节过程的安全性,在自动调平过程中必须防止出现超调,更不允许出现振荡情况。为此将采用保守的调平策略,设置一个最大调整量θL,这样就将调整过程分多次进行,调整过程更为安全。
计算每个支腿的位移量,自动发出支腿运动指令,电机按给定的位移控制支腿的伸缩,四条支腿同时运动。
平台测控***配备2套电子水平装置,每套电子水平装置均具备独立调平控制功能,可以在主备水平仪之间实现切换。如果在调平***运行期间控制***连续多次接收不到水平仪的反馈数据,则认为该水平仪出现故障,切换到备用水平仪。
1.调平算法的步骤如下:
1)运用控制***的中断循环程序实时给水平仪发送请求返回倾角数据的指令,并把该数据翻译为角度值或弧度值;
2)运用下式将步骤1得到的水平仪的在X轴和Y轴方向的倾角θ”X,θ”Y单位化
受装载物外形的影响,水平仪一般不会无缝贴合安放在装载平台或装载物上,这必将会造成装载平台坐标系O-XYZ、装载物坐标系O'-X'Y'Z'和水平仪坐标系O”-X”Y”Z”不能重合的现象,所以平台水平时水平仪可能会倾斜。因为支腿直接控制的是装载平台,所以必须将将监测到的水平仪坐标系下的倾角表达式,转换成装载平台坐标系下的倾角表达式。运用转换矩阵
可求
其中α,β,γ为三维空间直角坐标变换的三个旋转角。平台坐标系下的倾角值分别为运用以上转换方法分别将调平目标水平时水平仪倾角和当前监测到的水平仪倾角转换成平台坐标系下在X轴和Y轴方向的倾角值θX0,θY0、θX1,θY1;
3)用当前倾角θX1,θY1分别与调平目标水平时倾角θX0,θY0作差可得X轴和Y轴方向的调整角
ΔθX=θX1-θX0,
ΔθY=θY1-θY0
合成后的倾斜角为
设极限角为常量θL,如果θ>θL,需要调整载物平台,执行步骤4;如果θ≤θL,则不需要调整,返回步骤1。
4)为了保证调节过程的安全性,在自动调平过程中必须防止出现超调,更不允许出现振荡情况。为此将采用保守的调平策略,设置一个最大调整量θL,这样就将调整过程分多次进行,调整过程更为安全。
计算再次置平时支腿的调整位移
当θ较小时,tanθ≈θ,可取其中l为装载平台边长。为保证支腿的位移不会超限,可控制装载平台中心固定,则四条支腿的调整量分别为
Δl10=-Δx/2,Δl20=-Δy/2,Δl30=Δx/2,Δl40=Δy/2
若要求平台中心移动距离Δl,则可在原调整量上加上Δl,即
Δl10=-Δx/2+Δl,Δl20=-Δy/2+Δl
Δl30=Δx/2+Δl,Δl40=Δy/2-Δl10
若为三支腿支撑平台,取平台边长为m,则调整位移Δx0=mtanθX,调整量为Δl10=-Δx0/2,Δl20=Δx0/2,Δl30=-Δy0
5)按步骤4得到的调整量控制电机移动支腿。返回步骤1进入下一次调节。
2.如果装载平台某一支腿出现卡死不能移动时,能够通过调节其他支腿以达到调平目标(装载平台或装载物)的水平。
为检测是否有支腿卡死的情况出现,在控制***中编写一中断循环程序,程序中对每个支腿设置3个计数器,一个是支腿驱动数据的绝对值累加计数器,一个用于存储支腿驱动数据增量值,一个用于存储反馈数据的增量值。当支腿的驱动数据绝对值到某一数值时,检验支腿驱动数据增量值和反馈数据增量值的差值,若在要求的范围以内,说明支腿运动正常,对以上3个计数器清零继续工作;若差值超差,说明支腿运动异常,***将作出卡死报警。
当某一支腿卡死时,调平策略,方法如下:
保持卡死的支腿不动,其他的支腿调整值减去卡死支腿的调整值,假设支腿一卡死,则其他三条支腿的调整量为:
Δl20=-Δy/2-Δl10;Δl30=Δx/2-Δl10;Δl40=Δy/2-Δl10
若为三支腿支撑平台,则调整量为Δl10=-Δx0/2,Δl20=Δx0/2,Δl30=-Δy0。
3.可实现调节范围外自动限位,支腿的移动部分具有上下限位开关和位移传感器,当支腿行程超限时触发限位开关闭合,实现硬限位。同时编有限位控制程序,接收来自位移传感器的数据,当支腿位移超过上限值或下限值时,触发报警开关。
4.若装载平台上安放有两个装载物,在不考虑另一装载物的水平情况下,可控制任一装载物为调平目标。假设装载平台上有装载物A和B,A和B上分别安放有水平仪,现只调节装载物A的水平,分别将装载物A初始水平时和倾斜后的水平仪坐标系下的倾角值转换成为装载物A坐标系下的倾角值,判断是否超差。同样,也可只调节装载物B的水平。
5.平台测控***配备2套电子水平装置,每套电子水平装置均具备独立调平控制功能,可以在主备水平仪之间实现切换。如果在调平***运行期间控制***连续多次接收不到水平仪的反馈数据,则认为该水平仪出现故障,切换到备用水平仪。
实施例:四支腿支撑平台以装载平台为调平目标,水平仪安放在装载平台上。
本实施例提供了一种装载平台及其装载物的水平调节控制方法,所述装载平台设有四条支腿(如图2),每条支腿上配置电机控制支腿的伸缩,该方法包括:
步骤1.运用PLC的中断循环组织块实时向水平仪发送反馈当前倾角数据的请求,监测水平仪的倾角(如图3),假设初始水平状态下水平仪坐标系X”方向的倾角为θX0”=0.0400rad,Y”方向的倾角为θY0”=0.0500rad
步骤2.求倾斜矢量R”在水平仪坐标系O”-X”Y”Z”中的表达式i0”,j0”,k0”
得出i0”=0.7800,j0”=0.6240,k0”=0.0312
由于安装位置的限制,水平仪坐标系一般与装载平台坐标系不重合,由倾斜矢量R”在水平仪坐标系O”-X”Y”Z”中的表达式i0”,j0”,k0”转换成倾斜矢量R在装载平台坐标系O-XYZ的表达式i0,j0,k0,如图4:
①绕OZ”旋转α=0.1800rad,OX”,OY”旋转至OX0,OY0;
②绕OY0旋转β=0.3500rad,OX0,OZ”旋转至OX,OZ0;
③绕OX旋转γ=0.5000rad,OY0,OZ0旋转至OY,OZ。
α,β,γ为三维空间直角坐标变换的三个旋转角,与它相对应的旋转矩阵分别为:
因此,可求
得出i0=0.3942,j0=0.9086,k0=-0.1337;
步骤3,求调整角度和调整位移,如图5,装载平台的边长是l=2828mm
初始安装倾斜角
假设某时刻监测到的在水平仪坐标系X”方向的倾角为θX”1=0.0500rad,Y”方向的倾角为θY”1=0.0700rad,同理重复步骤2、3可得当前状态的倾斜矢量 R1=(i1,j1,k1)=(0.4437,0.8859,-0.1437)
倾角θX1=-0.3132rad,θY1=-0.1608rad
用当前倾角θX1,θY1分别与初始水平时的倾角θX0,θY0作差即可得调整角
ΔθX=θX1-θX0=-0.3132-(-0.3270)=0.0138rad,
ΔθY=θY1-θY0=-0.1608-(-0.1461)=-0.0147rad
倾斜角
设极限角θL=0.0005rad,因θ>θL,所以需要调整载物平台,执行步骤4。
步骤4.计算调整位移
求调整量,设装载平台四条支腿的初始高度分别为l10,l20,l30和l40,为了保证平台的高度不超限,可使装载平台中心固定,则四条支腿的调整量为
Δl10=-Δx/2=0.2727/2=-0.1364mm,
Δl20=-Δy/2=1.9809/2=0.9905mm,
Δl30=Δx/2=0.2727/2=0.1364mm,
Δl40=Δy/2=-1.9809/2=-0.9905mm;
若要求平台中心移动距离Δl,则可在原调整量上加上Δl,即
Δl10=-Δx/2+Δl,Δl20=-Δy/2+Δl,Δl30=Δx/2+Δl,Δl40=Δy/2-Δl10
步骤5.按步骤4计算出的调整量控制电机移动支腿。
如果支腿1卡死,则其他三条支腿的调整量为:
Δl20=-Δy/2-Δl10=0.9905-(-0.1364)=1.1269mm,
Δl30=Δx/2-Δl10=0.1364-(-0.1364)=0.2728mm,
Δl40=Δy/2-Δl10=-0.9905-(-0.1364)=-0.8541mm
其他三种情况,与该实例类似。现以情况②说明,假设初始安放时装载物是水平状态,水平仪读数为θ”X0、θ”Y0,转换成装载平台坐标系下的读数为θX0、θY0。某时刻倾角超限读数变为θ”X1、θ”Y1,转换成装载平台坐标系下的读数为θX1、θY1,则实际倾角为:θX=θX1-θX0,θY=θY1-θY0
接下来算法与实施例步骤4以后相同。因为调平目标为装载物,所以不用考虑平台的水平状况。
Claims (2)
1.一种装载平台及装载物的水平调节控制方法,其特征在于:
(1)采集水平仪数据:调平目标水平时,装载平台坐标系为O-XYZ、装载物坐标系为O'-X'Y'Z'和水平仪坐标系为O″-X″Y″Z″,水平仪在X轴Y轴上的倾角为θ″X0,θ″Y0,采集当前水平仪读数为θ″X1,θ″Y1;
(2)将水平仪坐标系下的倾角θ″X0,θ″Y0单位化,表达式为(i″0,j″0,k″0),其中
(3)将水平仪坐标系下的表达式(i″0,j″0,k″0)利用转换矩阵转换成为调平目标下的表达式,平台为调平目标,转换后的倾角表达式变为(i0,j0,k0),求出倾角值
求出当前装载平台的倾角值θX1,θY1;
(4)用当前倾斜角θX1,θY1分别与初始安装倾斜角θX,θY作差得到调整角:
ΔθX=θX1-θX,
ΔθY=θY1-θY,
合成后的倾斜角:
测量极限倾斜角θL,如果θ>θL,继续调整载物平台;如果θ≤θL,不再需要调整载物平台;
(5)再次置平装载平台的支腿,调整位移l为装载平台边长。
2.根据权利要求1所述的一种装载平台及装载物的水平调节控制方法,其特征在于:
所述的转换矩阵为:
其中α,β,γ为三维空间直角坐标变换的三个旋转角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510028501.5A CN104699119B (zh) | 2015-01-21 | 2015-01-21 | 一种装载平台及装载物的水平调节控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510028501.5A CN104699119B (zh) | 2015-01-21 | 2015-01-21 | 一种装载平台及装载物的水平调节控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104699119A CN104699119A (zh) | 2015-06-10 |
CN104699119B true CN104699119B (zh) | 2017-06-20 |
Family
ID=53346346
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510028501.5A Expired - Fee Related CN104699119B (zh) | 2015-01-21 | 2015-01-21 | 一种装载平台及装载物的水平调节控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104699119B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106094880B (zh) * | 2016-06-16 | 2019-03-05 | 南京理工大学 | 基于十二点支撑的垂直发射平台姿态调平控制方法 |
CN107479578A (zh) * | 2017-08-18 | 2017-12-15 | 昆山寰震机电有限公司 | 一种用于冲床自动调节水平的方法 |
CN108839619A (zh) * | 2018-09-05 | 2018-11-20 | 邯郸学院 | 一种车载电子设备水平自调整平台 |
CN109696585B (zh) * | 2019-01-04 | 2021-05-25 | 北京环境特性研究所 | 一种天线调平方法和*** |
CN110928337B (zh) * | 2019-12-03 | 2020-08-18 | 广东冠能电力科技发展有限公司 | 一种裸导线绝缘涂覆机器人***及其升降控制方法 |
CN111257920B (zh) * | 2020-03-23 | 2021-09-03 | 三门核电有限公司 | 一种放射性探测定位装置、探测***及其探测方法 |
CN111717174B (zh) * | 2020-06-28 | 2021-10-15 | 北京航天发射技术研究所 | 一种电动缸快速展车调平控制方法和*** |
CN112145884B (zh) * | 2020-08-07 | 2022-03-22 | 中国科学院西安光学精密机械研究所 | 光电转台用自动调平***及自动调平光电转台 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102806819A (zh) * | 2012-08-24 | 2012-12-05 | 江西连胜科技有限公司 | 平台水平自动调整装置及调整方法 |
CN103292127A (zh) * | 2013-05-20 | 2013-09-11 | 哈尔滨工业大学 | 多轴支撑气浮平台的测量控制*** |
CN103292130A (zh) * | 2013-05-20 | 2013-09-11 | 哈尔滨工业大学 | 多轴支撑气浮平台的调平方法 |
CN103558870A (zh) * | 2013-11-18 | 2014-02-05 | 西华大学 | 一种消除四点支撑机电式车载平台虚腿的***及方法 |
CN103950433A (zh) * | 2014-03-25 | 2014-07-30 | 北京航天发射技术研究所 | 一种车载平台调平控制***及方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8745884B2 (en) * | 2010-06-28 | 2014-06-10 | Trimble Navigation Limited | Three dimensional layout and point transfer system |
CN102937813B (zh) * | 2012-09-27 | 2015-11-25 | 北京航天发射技术研究所 | 一种平台中心四点调平方法及调平*** |
-
2015
- 2015-01-21 CN CN201510028501.5A patent/CN104699119B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102806819A (zh) * | 2012-08-24 | 2012-12-05 | 江西连胜科技有限公司 | 平台水平自动调整装置及调整方法 |
CN103292127A (zh) * | 2013-05-20 | 2013-09-11 | 哈尔滨工业大学 | 多轴支撑气浮平台的测量控制*** |
CN103292130A (zh) * | 2013-05-20 | 2013-09-11 | 哈尔滨工业大学 | 多轴支撑气浮平台的调平方法 |
CN103558870A (zh) * | 2013-11-18 | 2014-02-05 | 西华大学 | 一种消除四点支撑机电式车载平台虚腿的***及方法 |
CN103950433A (zh) * | 2014-03-25 | 2014-07-30 | 北京航天发射技术研究所 | 一种车载平台调平控制***及方法 |
Non-Patent Citations (4)
Title |
---|
《四杆并联机构的卫星平台水平度监控***研究》;魏永庚,等;《哈尔滨工业大学学报》;20090930;第41卷(第9期);第256-260页 * |
《车载平台的调平方法与控制技术研究》;杨红军;《机械设计与制造》;20081231(第12期);第134-136页 * |
卫星装配定时器平台智能调平***设计;张文婕;《制造技术研究》;20120630(第3期);第24-27页 * |
空间模拟器大型卫星装载平台监控***的实现;王瑞,等;《机械设计》;20110630;第28卷(第7期);第38-41页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104699119A (zh) | 2015-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104699119B (zh) | 一种装载平台及装载物的水平调节控制方法 | |
CN103454619B (zh) | 一种星载微波跟瞄雷达的电轴光学标定***及其标定方法 | |
CN101825461B (zh) | 基于圆柱形模型的平台调平装置 | |
CN103697824B (zh) | 用于坐标测量机的测头的***标定方法 | |
CN104142209B (zh) | 质量重心测量装置及方法 | |
US20160124437A1 (en) | Measurement Control System for Multi-Shaft Supported Air Floatation Platform | |
CN104076828B (zh) | 平面翻转多点调平装置的平面翻转多点调平方法 | |
CN105739538B (zh) | 基于机械臂运动装置的定位方法、定位测试装置及方法 | |
CN103983189B (zh) | 一种基于二次平台线阵ccd的水平位置测量方法 | |
CN204388816U (zh) | 一种高精度水平支撑*** | |
CN104535035A (zh) | 用于零件的外形尺寸检测装置和外形尺寸检测*** | |
CN104215919A (zh) | 用于测量磁场梯度张量的装置及其测量方法 | |
CN105808882A (zh) | 仿爬行类四足步行机器人运动参数的标定方法与装置 | |
CN104506139B (zh) | 一种用于聚光光伏测试的多功能激光装置 | |
CN109387329A (zh) | 小型无人机重量重心测量装置及测量方法 | |
CN205670006U (zh) | 一种rtk倾斜测量装置 | |
CN104567773A (zh) | 臂型三维测量机和支撑该测量机的基部的倾斜校正方法 | |
CN106772635B (zh) | 一种基于扫描交汇的地下电缆三维定位装置及定位方法 | |
CN102062867B (zh) | 简便准确的辐射场三维扫描水平垂直调整设备和方法 | |
CN207407861U (zh) | 一种rtk倾斜测量装置 | |
CN108241289A (zh) | 一种用于三自由度加载***的力-位移混合控制方法 | |
CN109029357B (zh) | 一种桩体倾斜度测量装置及方法 | |
CN206177300U (zh) | 一种网架节点球定位装置 | |
CN105627989A (zh) | 一种转台倾角测量***及其测量方法 | |
CN206235290U (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 | ||
GR01 | Patent grant | ||
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: 20170620 |