一种抑制单杆跟踪零位漂移的有效方法技术

一种抑制单杆跟踪零位漂移的有效方法，涉及伺服控制系统领域，它解决现有单杆跟踪控制过程中采用速度闭环、位置开环控制，进而无法控制扰动力矩对漂移产生的影响问题，本发明专利技术当单杆归零后单杆跟踪系统自动将切换到以当前编码器为零点的位置闭环系统，在切换中将单杆控制器变量赋值给数引控制器，从而平滑切换。以当前编码器位置做定点引导，当单杆摆出死区范围瞬间，系统将自动将位置定点引导回路放开，切换到传统的单杆速度引导模式。由于单杆归零后有位置定点引导，从而抑制住了由各种扰动力矩引起的漂移。本发明专利技术适用于转台单杆跟踪时的速度稳定跟踪和稳定定位，特别是针对随动转台等因摩擦等扰动力矩而产生位置漂移的控制系统具有显著效果。

【技术实现步骤摘要】

本专利技术涉及伺服控制系统领域，具体涉及抑制单杆跟踪零位漂移的有效方法。技术背景近年来，随着经纬仪等测量设备和各种稳定平台的需求越来越多，使得单杆跟踪时产生的漂移问题也越来越受到关注。这种漂移产生的原因多是由于摩擦力矩、电机扰动力矩和外界干扰力矩等产生的，单杆跟踪漂移数据如图1所示。要想要彻底抑制这种漂移必须使这些外界扰动力矩得到有效控制。而传统的单杆控制是采用速度闭环、位置开环控制，很难有效控制住这些扰动力矩对漂移产生的影响。
技术实现思路
本专利技术为解决现有单杆跟踪控制过程中采用速度闭环、位置开环控制，进而无法控制扰动力矩对漂移产生的影响问题，提供。，该方法由以下步骤实现步骤一、判断当前的工作方式是否为单杆跟踪方式，如果是，则执行步骤三，如果否，则执行步骤二；步骤二、进入其它的跟踪方式；步骤三、执行单杆跟踪控制方式，判断单杆跟踪控制方式是否进入死区，如果是， 则执行步骤四，如果否继续执行步骤三；步骤四、将单杆控制器当前值赋值至数引控制器，并采集当前编码器值，以当前编码器值作为定点位置输入，切换到数引定点工作方式；步骤五、判断单杆跟踪控制方式是否超出死区，如果是，执行步骤六，如果否，则返回步骤四；步骤六、切换到单杆跟踪控制方式，返回执行步骤三。本专利技术的工作原理本专利技术中设计了一种基于位置、速度均闭环的单杆跟踪控制系统，这种控制系统和传统的单杆跟踪控制系统工作方式一致，只是多了单杆归零后的位置闭环定位控制。传统的单杆跟踪方式中单杆输入量是作为速度给定引导平台按照指定的速度作速度引导运动，不做定位处理。本专利技术的单杆跟踪系统也是将单杆输入量加在速度环的输入端，引导转台做速度运动，但是当单杆归零后(即进入单杆死区内)单杆跟踪系统自动将切换到以当前编码器为零点的位置闭环系统，在切换中将单杆控制器变量赋值给数引控制器，从而平滑切换。即以当前编码器位置做定点引导，当单杆摆出死区范围瞬间，系统将自动将位置定点引导回路放开，切换到传统的单杆速度引导模式。这样由于单杆归零后有位置定点引导，从而设备抑制住了由各种扰动力矩引起的漂移。本专利技术的有益效果本文中的专利技术方法在多种型号经纬仪上得到了应用，很好的抑制了单杆零位漂移的问题；本专利技术的目的是采用位置开环控制和闭环控制切换的方式抑制单杆的归零漂移，方法有效而简洁。附图说明图1为传统单杆跟踪爬行曲线；图2为传统单杆跟踪原理框图3为本专利技术所述的的原理图4为本专利技术所述的中单杆归零后切换到定点引导不平滑曲线示意图5为本专利技术所述的中单杆归零后平滑切换到定点引导曲线示意图6为本专利技术所述的的流程图。具体实施方式结合图3至图6说明本实施方式，，该方法由以下步骤实现1.采集工作方式；工作方式包括指数引跟踪方式、可见电视跟踪方式或者红外电视跟踪方式；2.判断是否为单杆工作方式，如果不是则进入其他跟踪方式，如果是则进入单杆工作流程；3.如果进入单杆工作流程，判断单杆是否进入死区范围；4.如果没有进入单杆死区范围则继续按照单杆方式工作，如果进入单杆死区范围则采集当前编码器值，并且将单杆控制器值赋予数引控制器，将工作方式切换到数引定点工作方式；5.在定点工作方式下判断单杆是否超出死区范围，如果没有超出死区范围则继续按照定点工作方式运行；否则如果超出死区范围则将工作方式切换到单杆工作方式，继续重复步骤4操作。本实施方式中所述的单杆归零后(即进入单杆死区内)，单杆跟踪系统自动将切换到以当前编码器为零点的位置闭环系统，即做以当前编码器位置做定点引导，当单杆摆出死区范围瞬间，系统将自动将位置定点引导回路放开，切换到传统的单杆速度引导模式。当单杆跟踪方式瞬间切换到数引定点工作方式时，要将单杆控制器当前值赋给数引控制器。其中数引一阶控制器变量为数组SYa0neTmp，其中SYeOneTmp用于存储控制器的上一帧输入值，SYeOneTmp用于存储控制器的上一帧输出值。单杆一阶控制器变量为数组DGe0neTmp，其中DGeOneTmp用于存储控制器的上一帧输入值， DGeOneTmp 用于存储控制器的上一帧输出值。为了保证切换平滑不起振，要进行切换前夫之操作如下SYaOneTmp = DGaOneTmp；SYeOneTmp = DGeOneTmp 。数引跟踪到单杆跟踪过程切换，由于数引定点跟踪偏差不大所以控制器初始值不需要另行处理，仍按照初始赋值即可。结合图4和图5说明本实施方式，本实施方式设计的难点在于单杆归零后单杆跟踪到数引跟踪的切换过程，如果切换设计不好会引起切换抖动，造成单杆操作手感觉不平滑。要使单杆归零后平滑过渡到定点引导而不起振动，关键是控制器初始值的设定，当单杆进入死区后切换到数引时，如果数引控制器不设定初值或者初值设定为零时，会造成控制器的前几帧输出数据失真，即引起初始震荡，这种情况下需要将单杆跟踪控制器的当前值赋予数引控制器作为初始值，从而避免引起切换震荡。权利要求1.，其特征是，该方法由以下步骤实现 步骤一、判断当前的工作方式是否为单杆跟踪方式，如果是，则执行步骤三，如果否，则执行步骤二；步骤二、进入其它的跟踪方式；步骤三、执行单杆跟踪控制方式，判断单杆跟踪控制方式是否进入死区，如果是，则执行步骤四，如果否，则继续执行步骤三；步骤四、将单杆控制器当前值赋值至数引控制器，并采集当前编码器值，以当前编码器值作为定点位置输入，切换到数引定点工作方式；步骤五、判断单杆跟踪控制方式是否超出死区，如果是，执行步骤六，如果否，则返回步骤四；步骤六、切换到单杆跟踪控制方式，返回执行步骤三。2.根据权利要求1所述的，其特征在于，步骤二所述的进入其它的跟踪方式是指数引跟踪、可见电视跟踪或者红外电视跟踪。全文摘要，涉及伺服控制系统领域，它解决现有单杆跟踪控制过程中采用速度闭环、位置开环控制，进而无法控制扰动力矩对漂移产生的影响问题，本专利技术当单杆归零后单杆跟踪系统自动将切换到以当前编码器为零点的位置闭环系统，在切换中将单杆控制器变量赋值给数引控制器，从而平滑切换。以当前编码器位置做定点引导，当单杆摆出死区范围瞬间，系统将自动将位置定点引导回路放开，切换到传统的单杆速度引导模式。由于单杆归零后有位置定点引导，从而抑制住了由各种扰动力矩引起的漂移。本专利技术适用于转台单杆跟踪时的速度稳定跟踪和稳定定位，特别是针对随动转台等因摩擦等扰动力矩而产生位置漂移的控制系统具有显著效果。文档编号G05D3/12GK102520735SQ20111044930公开日2012年6月27日 申请日期2011年12月29日 优先权日2011年12月29日专利技术者张淑梅, 张玉良, 杜壁秀, 林兆华, 米阳 申请人:中国科学院长春光学精密机械与物理研究所本文档来自技高网...

【技术保护点】

【技术特征摘要】

【专利技术属性】
技术研发人员：张玉良，张淑梅，米阳，杜壁秀，林兆华，
申请(专利权)人：中国科学院长春光学精密机械与物理研究所，
类型：发明
国别省市：