【发明内容】
本发明的目的鉴于摆式陀螺寻北仪全方位寻北技术的研究现状与不足,提供了一种基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法,从陀螺进动速度与陀螺仪主轴偏北方向的角度关系着手,有效解决了摆式陀螺寻北仪实现全方位寻北的技术问题,并能满足不同寻北精度和寻北时间要求。
为实现上述目的,本发明采用如下的技术方案:
方案一:
基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法,包括以下步骤:
步骤1:启动陀螺电机至额定转速;
步骤2:选择寻北精度高于5″的高精度模式;
步骤3:粗寻北,并使陀螺仪主轴转动至偏离真北±1°的范围内,包括以下步骤;
步骤3.1:利用基于摆式陀螺最大进动速度的粗寻北原理计算出摆式陀螺最大进动速度位置B偏离真北方向N的角度α,其具体步骤如下:
步骤3.1.1:下放陀螺灵敏部;
步骤3.1.2:利用光电检测元件检测陀螺最大进动速度S并计算陀螺最大进动速度S时的位置B与悬带零位A0之间的夹角CB;
当陀螺最大进动速度位置B位于光电检测元件的检测范围(-L,L)内时,利用光电检测元件检测出陀螺最大进动速度S和所在位置B,并计算悬带零位A0与陀螺最大进动速度位置B之间的夹角CB;
当光标像将要超出光电检测元件的检测范围且仍没有检测到最大进动速度时,控制回转电机带动陀螺仪壳体向陀螺仪进动方向转动角度β一至两次,直至光电检测元件可以检测出陀螺最大进动速度S,并计算悬带零位A0与陀螺最大进动速度位置B之间的夹角CB。
步骤3.1.3:计算陀螺最大进动速度位置B偏离真北方向N的角度α,计算时各角度与位置之间的关系满足:
式中:
DB表示悬带扭矩系数,由悬带材料性质决定;
DK表示陀螺指北力矩系数,它由角动量H、仪器架设位置的纬度和地球自转角速度ωie决定;
n表示陀螺灵敏部所处空间的阻尼系数;
CB=α-ΔN<0,表示最大进动速度位置B与悬带零位A0之间的夹角,由步骤3.1.2检测得到,通过设计合理的陀螺灵敏部结构参数、陀螺转速和选择合适的金属悬带使CB≤2L,以确保光电检测元件能检测出最大进动速度的位置;
S表示步骤3.1.2测得的最大进动速度,因为规定陀螺仪架设偏北的位移取“+”,在指北力矩作用下,陀螺仪主轴必定向真北方向N进动,与位移方向相反,所以S取“-”;
令求解式(1)得陀螺最大进动速度位置B偏离真北方向N的角度α在0~π范围内的两个可能解α10和α20,其中,α10≤α20:
α10=arcsinK (2)
α20=π-arcsinK (3)
步骤3.2:计算悬带零位A0偏离真北方向N的角度ΔN10和ΔN20:
ΔN10=α10-CB (4)
ΔN20=α20-CB (5)
步骤3.3:锁紧陀螺灵敏部;
步骤3.4:根据角度ΔN10控制回转电机带动寻北仪壳体转动;
如果ΔN10=0,则控制回转电机带动寻北仪壳体转动10°,重复步骤3.1至步骤3.4;
如果ΔN10≠0,则控制回转电机带动陀螺仪壳体转动ΔN10;
步骤3.5:重复步骤3.1至步骤3.3,得到第二组悬带零位A0偏离真北方向N的角度ΔN11和ΔN22,根据ΔN11取值判断陀螺仪主轴是否位于真北附近;
如果ΔN11≈0,则说明陀螺仪主轴已经位于真北附近;
如果ΔN11不近似为0,则说明陀螺仪主轴没有位于真北附近,此时控制回转电机带动陀螺仪壳体转动角度(ΔN20-ΔN10)。
步骤4:制动陀螺电机;
步骤5:下放陀螺灵敏部;
步骤6:检测悬带零位;
步骤7:锁紧陀螺灵敏部;
步骤8:启动陀螺电机至额定转速;
步骤9:下放陀螺灵敏部;
步骤10:采用步进法限制陀螺灵敏部的摆幅;
步骤11:精寻北测量,得到陀螺北方位;
步骤12:锁紧陀螺灵敏部,制动陀螺电机,同时输出陀螺北方向。
方案二:
基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法,包括以下步骤:
步骤1:启动陀螺电机至额定转速;
步骤2:选择平均寻北时间不超过7分钟的快速模式;
步骤3:粗寻北,并使陀螺仪主轴转动至偏离真北方向±1°的范围内;步骤3.1:利用基于摆式陀螺最大进动速度的粗寻北原理计算出摆式陀螺最大进动速度位置B偏离真北方向N的角度α,其具体步骤如下:
步骤3.1.1:下放陀螺灵敏部;
步骤3.1.2:利用光电检测元件检测陀螺最大进动速度S以及陀螺最大进动速度S时的位置B与悬带零位A0之间的夹角CB;
当陀螺最大进动速度位置B位于光电检测元件的检测范围(-L,L)内时,利用光电检测元件检测出陀螺最大进动速度S和所在位置B,并计算悬带零位A0与陀螺最大进动速度位置B之间的夹角CB;
当光标像将要超出光电检测元件的检测范围且仍没有检测到最大进动速度时,控制回转电机带动陀螺仪壳体向陀螺仪进动方向转动角度β一至两次,直至光电检测元件可以检测出陀螺最大进动速度S,并计算悬带零位A0与陀螺最大进动速度位置B之间的夹角CB。
步骤3.1.3:计算陀螺最大进动速度位置B偏离真北方向N的角度α,计算时各角度与位置之间的关系满足:
式中:
DB表示悬带扭矩系数,由悬带材料性质决定;
DK表示陀螺指北力矩系数,它由角动量H、仪器架设位置的纬度和地球自转角速度ωie决定;
n表示陀螺灵敏部所处空间的阻尼系数;
CB=α-ΔN<0,表示最大进动速度位置B与悬带零位A0之间的夹角,由步骤3.1.2检测得到,通过设计合理的陀螺灵敏部结构参数、陀螺转速和选择合适的金属悬带使CB≤2L,以确保光电检测元件能检测出最大速度位置;
S表示步骤3.1.2测得的最大进动速度,因为规定陀螺仪架设偏北的位移取“+”,在指北力矩作用下,陀螺仪主轴必定向真北方向N进动,与位移方向相反,所以S取“-”;
令求解式(1)得陀螺最大进动速度位置B偏离真北方向N的角度α在0~π范围内的两个可能解α10和α20(α10≤α20):
α10=arcsinK (2)
α20=π-arcsinK (3)
步骤3.2:计算悬带零位A0偏离真北方向N的角度ΔN10和ΔN20:
ΔN10=α10-CB (4)
ΔN20=α20-CB (5)
步骤3.3:锁紧陀螺灵敏部;
步骤3.4:根据角度ΔN10控制回转电机带动寻北仪壳体转动;
如果ΔN10=0,则控制回转电机带动寻北仪壳体转动10°,重复步骤3.1至步骤3.4;
如果ΔN10≠0,则控制回转电机带动陀螺仪壳体转动ΔN10。
步骤3.5:重复步骤3.1至步骤3.2,得到第二组悬带零位A0偏离真北方向N的角度ΔN11和ΔN21,根据ΔN11取值判断陀螺仪主轴是否位于真北附近;
如果ΔN11≈0,则说明陀螺仪主轴已经位于真北附近;
如果ΔN11不近似为0,则说明陀螺仪主轴没有位于真北附近,此时锁紧陀螺灵敏部,控制回转电机带动陀螺仪壳体转动角度(ΔN20-ΔN10),下放陀螺灵敏部。
步骤4:精寻北测量,得到陀螺北方位;
步骤5:锁紧陀螺灵敏部,制动陀螺电机,同时输出陀螺北方向。
与现有技术相比,本发明具有如下的技术效果:
本发明一种基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法,其利用基于陀螺最大进动速度的粗寻北原理实现了摆式陀螺寻北仪的全方位寻北;高精度模式和快速模式两种寻北模式满足了不同寻北时间和寻北精度的要求。本发明有效避免了分析摆式陀螺寻北仪的大偏北角复杂运动规律,只利用一个摆式陀螺寻北仪就可以实现全方位高精度快速自主寻北。
【具体实施方式】
以下结合附图对本发明做进一步详细说明。
本发明基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法,根据不同寻北精度和寻北时间的要求分别选择两种寻北模式:高精度模式和快速模式;在高精度模式下,摆式陀螺寻北仪先基于陀螺最大进动速度的粗寻北原理完成粗寻北,然后依次完成悬带零位检测、步进限幅和精寻北;在快速模式下,摆式陀螺寻北仪基于陀螺最大进动速度的粗寻北原理完成粗寻北后直接进行精寻北,其寻北工作流程如图2所示。
设摆式陀螺寻北仪的各项参数为:角动量H=0.241kg·m2/s;仪器架设纬度空气阻尼系数n=0.001kg·rad·m2/s;指北力矩系数DK=1.4525×10-5kg·rad·m2/s2;悬带扭矩系数DB=3.6314×10-5kg·rad·m2/s2;光电检测元件有效检测范围L=±1.5°。
实施例1:
参见图3,假定陀螺仪初始架设位置为偏北124°13′56″。选择快速寻北模式,具体实施方式为:
步骤1:启动陀螺电机至额定转速;
步骤2:选择快速模式;
步骤3:粗寻北,并使陀螺仪转动至真北附近;
步骤3.1:下放陀螺灵敏部;
步骤3.2:光电检测元件8检测出陀螺最大进动速度S=0.0100rad/s以及该位置与悬带零位间的夹角为CB=-4°;
步骤3.3:计算陀螺最大进动速度位置B偏离真北方向N的角度:α10=60°和α20=120°;
步骤3.4:计算悬带零位A0偏离真北方向N的角度ΔN10=64°和ΔN20=124°;
步骤3.5:锁紧陀螺灵敏部;
步骤3.6:控制回转电机带动陀螺仪壳体向真北方向N转动ΔN10=64°;
步骤3.7:重复步骤3.1至步骤3.4,得到第二组悬带零位偏离真北方向的角度:ΔN11=60°和ΔN21=120°;
步骤3.8:因为ΔN11不近似为0,锁紧陀螺灵敏部,控制回转电机带动陀螺仪壳体继续向北转动60°,使陀螺仪转动至真北附近,下放陀螺灵敏部;
步骤4:积分法进行精寻北,得到陀螺北方位为124°13′47″;
步骤5:陀螺灵敏部上锁,制动陀螺电机,同时输出陀螺北方向。
实施例2:
参见图3,假定陀螺仪初始架设位置为偏北53°30′46″,选择高精度寻北模式,具体实施方式为:
步骤1:启动陀螺电机至额定转速;
步骤2:选择高精度模式;
步骤3:粗寻北,并使陀螺仪转动至真北附近;
步骤3.1:下放陀螺灵敏部;
步骤3.2:光电检测元件8检测出陀螺最大进动速度S=0.0089rad/s以及该位置与悬带零位间的夹角为CB=-3°30′;
步骤3.3:计算陀螺最大进动速度位置B偏离真北方向N的角度:α10=50°和α20=130°;
步骤3.4:计算悬带零位A0偏离真北方向N的角度ΔN10=53°30′和ΔN20=133°30′;
步骤3.5:锁紧陀螺灵敏部;
步骤3.6:控制回转电机带动陀螺仪壳体向真北转动ΔN10=53°30′;
步骤3.7:重复步骤3.1至步骤3.5,得到第二组悬带零位偏离真北方向的角度:ΔN11=0°和ΔN21=180°,因为ΔN11=0°,所以陀螺仪已转动至真北附近;
步骤5:制动陀螺电机;
步骤6:下放陀螺灵敏部;
步骤7:采用积分法测量悬带零位;
步骤8:锁紧陀螺灵敏部;
步骤9:启动陀螺电机至额定转速;
步骤10:下放陀螺灵敏部;
步骤11:采用步进法限幅;
步骤12:采用积分法进行精寻北,得到陀螺北方位为53°30′42″;
步骤13:锁紧陀螺灵敏部,制动陀螺电机,同时输出陀螺北方向。