CN110285816B - 一种小卫星星上设备高精度姿态测量***及方法 - Google Patents

一种小卫星星上设备高精度姿态测量***及方法 Download PDF

Info

Publication number
CN110285816B
CN110285816B CN201910576252.1A CN201910576252A CN110285816B CN 110285816 B CN110285816 B CN 110285816B CN 201910576252 A CN201910576252 A CN 201910576252A CN 110285816 B CN110285816 B CN 110285816B
Authority
CN
China
Prior art keywords
coordinate system
electronic theodolite
satellite
theodolite
vertical beam
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
Application number
CN201910576252.1A
Other languages
English (en)
Other versions
CN110285816A (zh
Inventor
李帅
杨海龙
王凤彬
张名毅
梁小峰
沈群
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aerospace Dongfanghong Satellite Co Ltd
Original Assignee
Aerospace Dongfanghong Satellite Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Aerospace Dongfanghong Satellite Co Ltd filed Critical Aerospace Dongfanghong Satellite Co Ltd
Priority to CN201910576252.1A priority Critical patent/CN110285816B/zh
Publication of CN110285816A publication Critical patent/CN110285816A/zh
Application granted granted Critical
Publication of CN110285816B publication Critical patent/CN110285816B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16M—FRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00—Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/02—Heads
    • F16M11/04—Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06—Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/08—Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting around a vertical axis, e.g. panoramic heads
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16M—FRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00—Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/02—Heads
    • F16M11/18—Heads with mechanism for moving the apparatus relatively to the stand
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16M—FRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00—Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/42—Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters with arrangement for propelling the support stands on wheels
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C1/00—Measuring angles
    • G01C1/02—Theodolites
    • G01C1/04—Theodolites combined with cameras
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
    • 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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16M—FRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M2200/00—Details of stands or supports
    • F16M2200/08—Foot or support base
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/30—Assessment of water resources

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Astronomy & Astrophysics (AREA)
  • Automation & Control Theory (AREA)
  • Multimedia (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

一种小卫星星上设备高精度姿态测量***及方法，利用控制终端确定转台转角并改变转台位置，确定电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角，并利用升降支架改变电子经纬仪的位置，完成粗定位工作；在粗定位工作的基础上利用CCD相机完成精确准直工作，获取立方棱镜两个端面的法向矢量，最终确定星上设备的姿态测量值。本发明针对多级硬件***坐标矩阵转换带来的***累计误差问题，进行了***硬件构建优化，以及算法的优化改进，提高了航天器设备姿态测量的测量精度和测量稳定性，还大幅提高了测量效率，降低了测量人力成本，减轻了测量技术人员的劳动强度。

Description

一种小卫星星上设备高精度姿态测量***及方法
技术领域
本发明涉及一种小卫星星上设备高精度姿态测量***及方法，用于小卫星星上单机设备姿态的自动化精密测量，并指导精密装配。
背景技术
目前，卫星上的关键单机设备在整星座标系下有很高的姿态精度要求，为了保证小卫星在空间中的正常运行工作，在小卫星的总装生产过程中需要对关键单机设备(如星敏、天线、推进及控制装置等)姿态进行精密测量，与此同时根据精测结果，在地面总装阶段将关键单机设备组件调整到设计要求的几何精度。由于设备本身姿态无法进行直接测量，常规方法是在设备上加装立方镜，通过经纬仪测量立方镜与基准立方镜之间的关系，来确定被测设备的姿态。立方镜在航天器组件的位姿测量应用比较广泛，目前大都采用经纬仪工业测量***建站和准直测量结合的方法，但该方法实际测量过程中需要较多人员共同参与进行准直和多次互瞄，测量效率低、测量结果易受人为因素影响，难以满足工业测量发展对高精度、高效率、自动化的需求。
上海装备研究所201611123615.9号专利公开了一种自动化精度测量***，包括准直测量子***、机械伺服子***。其中，机械伺服子***包括航天器停放架、基准定位支架、环形转台、竖直运动支架、航天器本体。准直测量子***包括第一基准经纬仪、第二基准经纬仪、准直经纬仪，使用时将航天器本体静置于航天器停放架上；第一基准经纬仪、第二基准经纬仪都固定安装在基准定位架上；准直经纬仪固定在竖直运动支架上，并沿上下运动；整个竖直运动支架安装在环形转台上，环形转台实现0～360°的方位旋转，整个机械伺服***运动形成一个高度H的柱形空间。测量时先利用机械伺服机构将准直经纬仪运动到相应位置，并准直待测目标，然后旋转方位角和俯仰角与基准经纬仪进行互瞄，两个过程均读取相应转台的方位角和俯仰角读数、光电自准直仪的读数、电子水平仪的读数，最后通过将待测镜面矢量转移到基准经纬仪所在的基准坐标系下，测量多个待测目标后即可计算两两之间的夹角关系。但该方法主要存在以下问题：
1)***引入硬件设备较多，***包括三台经纬仪，其中两台基准经纬仪，经纬仪互瞄环节较多，坐标关系在硬件***之间转换，会造成***累计误差较大，影响测量精度。
2)***的转台和竖直运动支架采用固连的形式，两台基准经纬仪位置也相对固定，因此整个***的能够适用的卫星尺寸受限，不具备更大的通用性。
发明内容
本发明的技术解决问题是：克服现有技术的不足，提出了一种小卫星星上设备高精度姿态测量***及方法，解决了多级硬件***坐标矩阵转换带来的***累计误差问题，进行了***硬件构建优化，以及基于该硬件***的算法优化改进，提高了航天器设备姿态测量的测量精度和测量稳定性，还大幅提高了测量效率、加快了卫星总装生产进程，并大大节省了卫星生产成本。
本发明的技术方案是：
一种小卫星星上设备高精度姿态测量***，包括：电子经纬仪、升降支架、转台、CCD相机、控制终端；
升降支架包括：可移动底座、立梁、升降旋转机构；可移动底座上设置有立梁，所述立梁上设置有能够沿所述立梁上下移动和绕所述立梁轴线旋转的升降旋转机构，电子经纬仪固定在所述升降旋转机构上，电子经纬仪的目镜上固连有CCD相机；卫星固定在转台上，卫星上的待测设备上粘贴有立方棱镜；
电子经纬仪固定在升降支架上，卫星固定在转台上，电子经纬仪的目镜上固连有CCD相机；卫星上的待测设备上粘贴有立方棱镜；
控制终端：确定转台转角、电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角；根据所述确定的电子经纬仪的竖直高度H、电子经纬仪的水平驱动角和垂直驱动角，利用升降支架改变电子经纬仪的位置，根据所述确定的转台转角改变转台位置，完成粗定位工作；在粗定位工作的基础上利用CCD相机完成精确准直工作；重复粗定位工作和精确准直工作，获取立方棱镜两个端面的法向矢量，所述两个端面的法向矢量正交，根据所述两个法向矢量确定卫星上待测设备相对于整星坐标系的姿态测量值。
一种利用上述的测量***进行星上设备姿态测量的方法，包括步骤如下：
1)获得整星坐标系与转台坐标系之间的转换矩阵M1，作为第一转换矩阵；
2)获得电子经纬仪坐标系与转台坐标系之间的转换矩阵M2，作为第二转换矩阵；
3)根据卫星上待测设备的相对于整星坐标系的姿态设计值，确定转台转角、电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角；
4)根据步骤3)确定的转台转角改变转台位置，同时，根据步骤4)确定的电子经纬仪的竖直高度H、电子经纬仪的水平驱动角和垂直驱动角，改变电子经纬仪的位置，使其目镜能够看到立方棱镜的任意一个端面；完成粗定位工作；
5)使用CCD相机通过电子经纬仪目镜对立方棱镜的端面成像，获得十字光标和目镜上十字刻线之间的距离偏差；
6)根据步骤5)获得的距离偏差，确定电子经纬仪的水平驱动角和垂直驱动角；
7)根据步骤6)确定的水平驱动角和垂直驱动角，利用电子经纬仪的驱动机构改变经纬仪光标的位置，使经纬仪的光轴垂直于立方棱镜的端面达到十字光标和目镜上的十字刻线完全重合；完成精确准直工作；
8)利用电子经纬仪获得在电子经纬仪坐标系下的立方棱镜端面的法向矢量，作为第一法向矢量r1；
9)重复步骤3)～8)，再次获得在电子经纬仪坐标系下的立方棱镜一个端面的法向矢量，作为第二法向矢量r2；
10)根据步骤8)确定的第一法向矢量r1和步骤9)确定的第二法向矢量r2，构建坐标系OXY，作为在电子经纬仪坐标系下的立方棱镜坐标系；
11)确定电子经纬仪坐标系O′XY与步骤10)构建的立方棱镜坐标系OXY之间的转换矩阵M3×3，作为第四转换矩阵；
12)通过整星坐标系与转台坐标系之间的转换矩阵M1，和电子经纬仪坐标系与转台坐标系之间的转换矩阵M2，确定整星坐标系与电子经纬仪坐标系之间的转换矩阵M3，作为第三转换矩阵；
13)根据12)确定的第三转换矩阵和步骤11)确定的第四转换矩阵，获得卫星上待测设备相对于整星坐标系的姿态测量值M4。
所述步骤11)确定M3×3的方法，具体如下：
其中，(xri yri zri)为ri在电子经纬仪坐标系下的矢量坐标，r3＝r1×r2。
所述步骤12)确定整星坐标系与电子经纬仪坐标系之间的转换M3的方法，具体如下：
所述步骤13)确定卫星上待测设备相对于整星坐标系的姿态M4的方法，具体如下：M4＝M3×3×M3。
本发明与现有技术相比的有益效果是：
1)本发明采用了优化硬件***构建的方法手段，仅采用了一台电子经纬仪、一个升降支架、一个转台和一个CCD相机，优化了硬件***组成，降低了硬件成本，具有很广泛的应用前景；
2)本发明采用了硬件***相互分离的方式，使硬件***具有更好的通用性以及可维护性，如：升降支架和转台为彼此分离，可在任意可视范围内进行摆放，对不同尺寸的卫星均适用；
3)本发明采用了待测量设备坐标系直接转换在升降支架上的电子经纬仪坐标系下的方法，并通过标定的整星坐标系跟升降支架上电子经纬仪坐标系之间的矩阵关系，直接将待测设备坐标系转换到星体坐标系下表示，降低了硬件***坐标矩阵转换带来的累计误差，全过程无需经纬仪互瞄，提高了测量精度，并大大减少了程序的计算量，提高软件程序的执行效率。
附图说明
图1为本发明自动化精密测量硬件***构成示意图；
图2为本发明软件实现算法流程图；
图3为本发明一维转台二维平面示意图；
图4为本发明转台旋转角度计算示意图；
图5为本发明升降支架升降高度解算示意图；
图6为本发明电子经纬仪水平角计算模型示意图；
图7为本发明升降支架示意图；
图8为本发明可移动底座上端面示意图；
图9为本发明可移动底座下端面示意图；
图10为本发明立梁示意图；
图11为本发明升降旋转机构示意图；
图12为本发明升降旋转机构径向示意图；
图13为本发明升降旋转机构底部示意图。
具体实施方式
本发明自动化智能化精度测量***可实现小卫星不同总装阶段精测任务的快速执行。为实现全自动准直测量，软件算法主要实现三个功能，即自动运动驱动功能，自动准直功能和准直结果自动解算功能。软件依靠卫星设计提供的各单机设备坐标系参数和单机设备立方镜设计参数等先验数据，基于运动参数解算模型，计算在***布局下一维转台的旋转角度、升降支架升降量、电子经纬仪水平角和垂直角，用通信指令控制各设备按计算量进行驱动，实现对卫星上被测单机设备立方镜的自动概略准直；再通过自动准直技术，实现小范围内测量仪器的自动精确准直；软件采集精确准直状态下各设备数据，包括：电子经纬仪的水平角和垂直角、一维转台转角、升降支架高度，依据姿态参数解算模型，计算被测设备立方镜在整星坐标系下的姿态参数，从而实现全自动准直测量。
姿态测量***控制终端通过串口通信指令控制各设备运动和数据读取；精密一维转台为被测设备提供水平方向上的旋转运动；升降支架带动电子经纬仪进行竖直方向上的升降；电子经纬仪目镜安装有CCD相机实现自动准直功能；使用额外两台电子经纬仪和升降支架上的电子经纬仪可用于***参数标定，可确定升降支架上的测量经纬仪坐标系和转台坐标系之间的转换参数；使用其中一台额外电子经纬仪和升降支架上的电子经纬仪可确定升降支架在升降运动过程中扭转误差，在计算过程中用于误差修正。
自动化测量过程中，首先需要卫星上单机设备的先验设计数据，即单机设备坐标系与整星坐标系的姿态角度参数。这些参数将作为自动测量***的先验参数，参与到自动测量运动参数和准直姿态参数的解算中。
自动测量***标定的目的一方面是建立全局测量坐标***，将单机设备坐标系、一维转台坐标系、电子经纬仪坐标系联系起来，并统一转换到整星坐标系下表示，以此计算各个子***运动控制的概略初始驱动值，并实现各个子***的自动驱动控制；另一方面标定出升降支架在一维长行程运动过程中产生的扭转误差，在计算过程中用于误差修正。
下面结合附图对本发明做进一步详细的描述。
如图1所述，本发明一种小卫星星上设备高精度姿态测量***，包括：电子经纬仪、升降支架、转台、CCD相机、控制终端。电子经纬仪固定在升降支架上，卫星固定在转台上，电子经纬仪的目镜上固连有CCD相机；卫星上的待测设备上粘贴有立方棱镜。
如图7所示，升降支架包括：可移动底座100、立梁200、升降旋转机构300、立梁支撑杆400；可移动底座100上设置有立梁200，所述立梁200上设置有能够沿所述立梁200上下移动和绕所述立梁200轴线旋转的升降旋转机构300，电子经纬仪固定在所述升降旋转机构300上，电子经纬仪的目镜上固连有CCD相机；卫星固定在转台上，卫星上的待测设备上粘贴有立方棱镜。立梁支撑杆400的一端固定连接所述可移动底座100，所述立梁支撑杆400的另一端固定连接所述立梁200，所述可移动底座100固定连接有多个立梁支撑杆400。
控制终端：确定转台转角、电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角；根据所述确定的电子经纬仪的竖直高度H、电子经纬仪的水平驱动角和垂直驱动角，利用升降支架改变电子经纬仪的位置，根据所述确定的转台转角改变转台位置，完成粗定位工作；在粗定位工作的基础上利用CCD相机完成精确准直工作；重复粗定位工作和精确准直工作，获取立方棱镜两个端面的法向矢量，所述两个端面的法向矢量正交，根据所述两个法向矢量确定卫星上待测设备相对于整星坐标系的姿态测量值。
如图8、9所示，所述可移动底座100包括：支撑底盘101、地脚支撑手轮102、铰合103、控制开关104、立梁安装接口105、脚轮106；
所述支撑底盘101的为三棱锥结构，支撑底盘101上均布设置有多个地脚支撑手轮102、铰合103、脚轮106；所述多个铰合103与所述多个脚轮106一一对应，所述铰合103用于收起或打开所述脚轮106，所述多个脚轮106打开后用于移动所述支撑底盘101；所述地脚支撑手轮102用于在所述多个脚轮106收起后支撑固定所述支撑底盘101的位置。所述支撑底盘101的中心位置设置有用于连接所述立梁200的立梁安装接口105；所述支撑底盘101上还设置有用于控制所述升降旋转机构300的控制开关104。本实施例所述地脚支撑手轮102、铰合103、脚轮106的个数均为3个，所述支撑底盘101的每个棱边上均固定有一个地脚支撑手轮102、一个铰合103、一个脚轮106。
如图10所示，立梁200包括：连接块201、立梁本体202、导轨203、滚珠丝杠204。立梁本体202固定在所述立梁安装接口105上，在所述立梁安装接口105和所述立梁本体202固定连接位置设置有用于加固处理的连接块201；立梁本体202截面为矩形的杆结构，所述立梁本体202的一个侧面上设置有用于使所述升降旋转机构300沿所述立梁200上下移动的导轨203和滚珠丝杠204。
如图11、12、13所示，升降旋转机构300包括：旋转盘301、支撑滑轮302、承力框架303、滑块304、经纬仪305、小齿轮306、电机307、大齿轮308。承力框架303内部设置有用于与所述立梁200连接的滑块304，承力框架303通过支撑滑轮302固定连接旋转盘301，所述旋转盘301为截面为圆环的薄板，所述经纬仪305固定连接所述旋转盘301；所述大齿轮308固定在所述旋转盘301的端面上，所述小齿轮306固定连接所述承力框架303，所述电机307用于驱动所述小齿轮306啮合所述大齿轮308，使所述旋转盘301绕所述承力框架303旋转。
如图2所示，本发明一种利用上述的测量***进行星上设备姿态测量的方法，包括步骤如下：
1)建立与转台固连的转台坐标系，获得整星坐标系与转台坐标系之间的转换矩阵M1，作为第一转换矩阵；
2)建立与电子经纬仪固连的转台坐标系，获得电子经纬仪坐标系与转台坐标系之间的转换矩阵M2，作为第二转换矩阵；
3)标定电子经纬仪由于立梁竖直运动产生的扭转误差；
4)根据卫星上待测设备的相对于整星坐标系的姿态设计值，确定转台转角ω、电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角。
转台转角ω具体为：
其中，n、p、q、μ均为已知数。如附图3和附图4所示，其中O为星体坐标系中心，I1(x1,y1,z1)为被测立方镜中心，I2(x2,y2,z2)为立方镜被准直面法线上的一点，为立方镜被测面的法线，T(xT,yT,zT)为升降支架上的电子经纬仪坐标系中心。当一维转台旋转角度ω至电子经纬仪准直立方镜被测面时，立方镜被测面法线/>变成/>并穿过测量经纬仪中心T。此时立方镜中心位于I′1(x′1,y′1,z′1)位置，I2点移至I′2(x′2,y′2,z′2)，立方镜运动至被准直位置。从而在准直状态下，根据法线/>穿过T，即I1、I2、T三点共线的关系推导得到转台的驱动角度表达式。
电子经纬仪在升降支架上的竖直高度H，具体为：
H＝d×tanθ+(z′1-zT)，
其中T为测量经纬仪坐标系原点，I′1为被测立方镜中心，如图5所示，根据I′1T0⊥TT0，可知点T0坐标为(xT yT z′1)。由于与/>交于点T1，则设T1坐标为/>可解/>和/>的夹角θ以及/>的长度d，进而可以得到升降支架的升降高度H。
电子经纬仪的水平驱动角的确定方法，具体如下：
(x″1 y″1 z″1)T＝M3(x′1-xT y′1-yT z′1-zT)T，
在初始电子经纬仪坐标系下，在水平面内设T′为电子经纬仪坐标系原点，I″1(x″1,y″1,z″1)为被测立方镜中心。已知初始电子经纬仪坐标系与整星体坐标系关系矩阵M3，将I′1(x′1,y′1,z′1)坐标转换到初始测量经纬仪坐标系下。如图6所示，I″1在XOY平面内的坐标为(x″1，y″1)，判断投影点象限，X轴与逆时针方向的夹角α，即为测量经纬仪应转动至的水平角。
电子经纬仪垂直驱动角的确定方法，具体如下：
在初始电子经纬仪坐标系下，经纬仪垂直角解算模型假设T′、T′0、T′1、I″1均为初始星体坐标系下对应点在初始测量经纬仪坐标系下的表示。I″1坐标已知，T11坐标是T1坐标/>从初始星体坐标系转换到初始测量经纬仪坐标系下，d由升降支架的升降高度计算公式可得。则可得到电子经纬仪垂直角β的表达式。
5)根据步骤4)确定的转台转角改变转台位置，同时，跟据步骤4)确定的电子经纬仪的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角，改变电子经纬仪的位置，使其目镜能够看到立方棱镜的任意一个端面；完成粗定位工作；
6)使用CCD相机通过电子经纬仪目镜对立方棱镜的端面成像，获得十字光标和目镜上十字刻线之间的距离偏差；
7)根据步骤6)获得的距离偏差，确定电子经纬仪的水平驱动角和垂直驱动角；
8)根据步骤7)确定的水平驱动角和垂直驱动角，利用电子经纬仪的驱动机构改变经纬仪光标的位置，使经纬仪的光轴垂直于立方棱镜的端面达到十字光标和目镜上的十字刻线完全重合；完成精确准直工作；
9)利用电子经纬仪获得在其坐标系下的立方棱镜端面的法向矢量，作为第一法向矢量r1；
10)重复步骤4)～9)，再次获得在电子经纬仪坐标系下的立方棱镜一个端面的法向矢量，作为第二法向矢量r2；
11)根据步骤9)确定的第一法向矢量r1和步骤10)确定的第二法向矢量r2，构建坐标系OXY，作为在电子经纬仪坐标系下的立方棱镜坐标系；
12)确定电子经纬仪坐标系O′XY与步骤11)构建的立方棱镜坐标系OXY之间的转换矩阵M3×3，作为第四转换矩阵；
其中，(xri yri zri)为ri在电子经纬仪坐标系下的矢量坐标，r3＝r1×r2。
13)通过整星坐标系与转台坐标系之间的转换矩阵M1，和电子经纬仪坐标系与转台坐标系之间的转换矩阵M2，确定整星坐标系与电子经纬仪坐标系之间的转换矩阵M3，作为第三转换矩阵；
14)根据13)确定的第三转换矩阵和步骤12)确定的第四转换矩阵，即根据整星坐标系与电子经纬仪坐标系之间的转换矩阵M3，将立方棱镜坐标系转换到整星坐标系中，获得卫星上待测设备相对于整星坐标系的姿态测量值M4。M4＝M3×3×M3。
实施例
依据解算的运动参数ω、H、α、β驱动各设备运动后，由于被测单机设备实际姿态与理论值的偏差，电子经纬仪处于粗略准直状态。完成粗略准直后，使用CCD相机通过电子经纬仪目镜对立方棱镜的端面成像，获得十字光标和目镜上十字刻线之间的距离偏差；根据获得的距离偏差，确定电子经纬仪的水平驱动角和垂直驱动角；利用电子经纬仪的驱动机构改变经纬仪光标的位置，使经纬仪的光轴垂直于立方棱镜的端面达到十字光标和目镜上的十字刻线完全重合；完成自动精确准直工作。同时，获取精确准直状态下各设备的实际参数值，其中ω、H值不变，经纬仪精确准直水平角为γ，垂直角为δ，计算准直向量，并构造在测量仪器经纬仪坐标系下的被测单机立方镜的坐标系。
当精确准直立方镜A面时，电子经纬仪坐标系下经纬仪中心T1坐标为(0,0,0)，则由精确准直状态下的经纬仪角度参数，可以得到准直法线上任意一点I的坐标(x1,y1,z1)，其点坐标计算如下：
其中s为任意正数。
由升降支架的高度参数可知在准直状态的电子经纬仪坐标系下，初始测量经纬仪坐标系的转换参数为(0,0，-H,0,0,0)，设其旋转矩阵为MT1。则T1和I在初始测量经纬仪坐标系下的坐标分别为(xT1,yT1,zT1)和(xl1,yl1,zl1)，因此可得到：
(xT1 yT1 zT1)T＝MT1(0 0 H)T，
(xl1 yl1 zl1)T＝MT1(x y z+H)T，
由***标定的先验参数，可知在初始测量经纬仪坐标系下，初始星体坐标系的转换参数为(xR,yR,zR,Rrx,Rry,Rrz)，设其旋转矩阵MTR。设初始星体坐标系下，T1坐标为(xT2,yT2,zT2)，点I的坐标为(xl2,yl2,zl2)：
(xT2 yT2 zT2)T＝MTR(xT1-xR yT1-yR zT1-zR)T，
(xl2 yl2 zl2)T＝MTR(xl1-xR yl1-yR zl1-zR)T，
依据一维转台的旋转量ω，可以计算在初始星体坐标系下，旋转后星体坐标系的转换参数为(0,0，0,0,0,Rωz)，Rωz由转台相对于初始零位的旋转量ω计算得到，设其旋转矩阵为MR1。旋转后星体坐标系下，经纬仪中心T1坐标为(xT3,yT3,zT3)，准直法线上点I坐标为(xl3,yl3,zl3)：
(xT3 yT3 zT3)T＝MR1(xT2 yT2 zT2)T，
(xl3 yl3 zl3)T＝MR1(xl2 yl2 zl2)T，
则由电子经纬仪中心T1和准直法线上点I，可以构成一条旋转后星体坐标系下的准直向量同理，准直B面则可构成准直向量/>将两个向量单位化后并叉乘运算，可得到同时垂直于两准直向量的第三个轴的向量。这三个向量即为小卫星单机设备上被测立方镜的三个轴线。根据该三个向量可以构建立方镜坐标系，进而得到被测单机设备上的立方镜与小卫星的姿态关系。
为验证方法的可行性，本文实验采用某力学星模型，在卫星模型上安置一个四镜面皆可通视的立方镜，通过比较两组不同轴向解算得到的同一立方镜姿态参数，评估测试***的绝对精度；安置多个不同姿态立方镜，重复多次测量，比较同一立方镜的姿态参数，评估测试***的重复性精度。本次实验所用一维转台水平度为0.0025°，升降立梁垂直度为89.9953°，所用经纬仪为TM5100A，测角精度为±0.5″。
本发明说明书中未作详细描述的内容属本领域专业技术人员的公知技术。

Claims (9)

1.一种小卫星星上设备高精度姿态测量***，其特征在于，包括：电子经纬仪、升降支架、转台、CCD相机、控制终端；
升降支架包括：可移动底座(100)、立梁(200)、升降旋转机构(300)；可移动底座(100)上设置有立梁(200)，所述立梁(200)上设置有能够沿所述立梁(200)上下移动和绕所述立梁(200)轴线旋转的升降旋转机构(300)，电子经纬仪固定在所述升降旋转机构(300)上，电子经纬仪的目镜上固连有CCD相机；卫星固定在转台上，卫星上的待测设备上粘贴有立方棱镜；
控制终端用于确定转台转角、电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角；根据所述确定的电子经纬仪的竖直高度H、电子经纬仪的水平驱动角和垂直驱动角，利用升降支架改变电子经纬仪的位置，根据所述确定的转台转角改变转台位置，完成粗定位工作；在粗定位工作的基础上利用CCD相机完成精确准直工作；重复粗定位工作和精确准直工作，获取立方棱镜两个端面的法向矢量，所述两个端面的法向矢量正交，根据所述两个法向矢量确定卫星上待测设备相对于整星坐标系的姿态测量值；
所述升降旋转机构(300)包括：旋转盘(301)、支撑滑轮(302)、承力框架(303)、滑块(304)、经纬仪(305)、小齿轮(306)、电机(307)、大齿轮(308)；
承力框架(303)内部设置有用于与所述立梁(200)连接的滑块(304)，承力框架(303)通过支撑滑轮(302)固定连接旋转盘(301)，所述旋转盘(301)为截面为圆环的薄板，所述经纬仪(305)固定连接所述旋转盘(301)；所述大齿轮(308)固定在所述旋转盘(301)的端面上，所述小齿轮(306)固定连接所述承力框架(303)，所述电机(307)用于驱动所述小齿轮(306)啮合所述大齿轮(308)，使所述旋转盘(301)绕所述承力框架(303)旋转。
2.根据权利要求1所述的一种小卫星星上设备高精度姿态测量***，其特征在于，所述可移动底座(100)包括：支撑底盘(101)、地脚支撑手轮(102)、铰合(103)、控制开关(104)、立梁安装接口(105)、脚轮(106)；
支撑底盘(101)上均布设置有多个地脚支撑手轮(102)、铰合(103)、脚轮(106)；所述多个铰合(103)与所述多个脚轮(106)一一对应，所述铰合(103)用于收起或打开所述脚轮(106)，所述多个脚轮(106)打开后用于移动所述支撑底盘(101)；所述地脚支撑手轮(102)用于在所述多个脚轮(106)收起后支撑固定所述支撑底盘(101)的位置；
所述支撑底盘(101)的中心位置设置有用于连接所述立梁(200)的立梁安装接口(105)；所述支撑底盘(101)上还设置有用于控制所述升降旋转机构(300)的控制开关(104)。
3.根据权利要求2所述的一种小卫星星上设备高精度姿态测量***，其特征在于，所述支撑底盘(101)的为三棱锥结构。
4.根据权利要求3所述的一种小卫星星上设备高精度姿态测量***，其特征在于，所述地脚支撑手轮(102)、铰合(103)、脚轮(106)的个数均为3个，所述支撑底盘(101)的每个棱边上均固定有一个地脚支撑手轮(102)、一个铰合(103)、一个脚轮(106)。
5.根据权利要求2所述的一种小卫星星上设备高精度姿态测量***，其特征在于，所述立梁(200)包括：连接块(201)、立梁本体(202)、导轨(203)、滚珠丝杠(204)；
立梁本体(202)固定在所述立梁安装接口(105)上，在所述立梁安装接口(105)和所述立梁本体(202)固定连接位置设置有用于加固处理的连接块(201)；立梁本体(202)截面为矩形的杆结构，所述立梁本体(202)的一个侧面上设置有用于使所述升降旋转机构(300)沿所述立梁(200)上下移动的导轨(203)和滚珠丝杠(204)。
6.一种利用如权利要求1所述的测量***进行星上设备姿态测量的方法，其特征在于，包括步骤如下：
1)获得整星坐标系与转台坐标系之间的转换矩阵M1，作为第一转换矩阵；
2)获得电子经纬仪坐标系与转台坐标系之间的转换矩阵M2，作为第二转换矩阵；
3)根据卫星上待测设备的相对于整星坐标系的姿态设计值，确定转台转角、电子经纬仪在升降支架上的竖直高度H，电子经纬仪的水平驱动角和垂直驱动角；
4)根据步骤3)确定的转台转角改变转台位置，同时，根据步骤4)确定的电子经纬仪的竖直高度H、电子经纬仪的水平驱动角和垂直驱动角，改变电子经纬仪的位置，使其目镜能够看到立方棱镜的任意一个端面；完成粗定位工作；
5)使用CCD相机通过电子经纬仪目镜对立方棱镜的端面成像，获得十字光标和目镜上十字刻线之间的距离偏差；
6)根据步骤5)获得的距离偏差，确定电子经纬仪的水平驱动角和垂直驱动角；
7)根据步骤6)确定的水平驱动角和垂直驱动角，利用电子经纬仪的驱动机构改变经纬仪光标的位置，使经纬仪的光轴垂直于立方棱镜的端面达到十字光标和目镜上的十字刻线完全重合；完成精确准直工作；
8)利用电子经纬仪获得在电子经纬仪坐标系下的立方棱镜端面的法向矢量，作为第一法向矢量r1；
9)重复步骤3)～8)，再次获得在电子经纬仪坐标系下的立方棱镜一个端面的法向矢量，作为第二法向矢量r2；
10)根据步骤8)确定的第一法向矢量r1和步骤9)确定的第二法向矢量r2，构建坐标系OXY，作为在电子经纬仪坐标系下的立方棱镜坐标系；
11)确定电子经纬仪坐标系O′XY与步骤10)构建的立方棱镜坐标系OXY之间的转换矩阵M3×3，作为第四转换矩阵；
12)通过整星坐标系与转台坐标系之间的转换矩阵M1，和电子经纬仪坐标系与转台坐标系之间的转换矩阵M2，确定整星坐标系与电子经纬仪坐标系之间的转换矩阵M3，作为第三转换矩阵；
13)根据12)确定的第三转换矩阵和步骤11)确定的第四转换矩阵，获得卫星上待测设备相对于整星坐标系的姿态测量值M4。
7.一种根据权利要求6所述的测量***进行星上设备姿态测量的方法，其特征在于，所述步骤11)确定M3×3的方法，具体如下：
其中，(xri yri zri)为ri在电子经纬仪坐标系下的矢量坐标，r3＝r1×r2。
8.一种根据权利要求7所述的测量***进行星上设备姿态测量的方法，其特征在于，所述步骤12)确定整星坐标系与电子经纬仪坐标系之间的转换M3的方法，具体如下：
9.一种根据权利要求6～8任意之一所述的测量***进行星上设备姿态测量的方法，其特征在于，所述步骤13)确定卫星上待测设备相对于整星坐标系的姿态M4的方法，具体如下：
M4＝M3×3×M3。
CN201910576252.1A 2019-06-28 2019-06-28 一种小卫星星上设备高精度姿态测量***及方法 Active CN110285816B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910576252.1A CN110285816B (zh) 2019-06-28 2019-06-28 一种小卫星星上设备高精度姿态测量***及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910576252.1A CN110285816B (zh) 2019-06-28 2019-06-28 一种小卫星星上设备高精度姿态测量***及方法

Publications (2)

Publication Number Publication Date
CN110285816A CN110285816A (zh) 2019-09-27
CN110285816B true CN110285816B (zh) 2023-12-12

Family

ID=68019644

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910576252.1A Active CN110285816B (zh) 2019-06-28 2019-06-28 一种小卫星星上设备高精度姿态测量***及方法

Country Status (1)

Country Link
CN (1) CN110285816B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111046584B (zh) * 2019-12-27 2024-02-20 哈尔滨工业大学 星载仪器设备的精密调整方法
CN111623775B (zh) * 2020-05-15 2022-10-04 天津时空经纬测控技术有限公司 运载体姿态测量***、方法以及存储介质
CN112097731A (zh) * 2020-09-22 2020-12-18 上海格思信息技术有限公司 基于经纬仪的光学精度自动化测量装置及测量方法
CN114326831B (zh) * 2021-12-24 2024-03-29 上海卫星装备研究所 光学自准直测量***自动准直立方镜实现方法及***
CN115060227B (zh) * 2022-06-15 2023-05-12 北京信息科技大学 卫星在轨视轴指向变化高精度测量的组合夹角测量方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6490801B1 (en) * 1999-11-19 2002-12-10 Centre For Research In Earth And Space Technology Sun sensors using multi-pinhole overlays
CN103604411A (zh) * 2013-11-08 2014-02-26 北京卫星环境工程研究所 基于图像识别的经纬仪自动准直方法
CN104568374A (zh) * 2014-12-12 2015-04-29 中国航空工业集团公司北京长城计量测试技术研究所 风洞天平静校台几何量校准装置
CN105424060A (zh) * 2015-11-18 2016-03-23 湖北航天技术研究院总体设计所 一种飞行器星敏感器与捷联惯组安装误差的测量方法
CN105953771A (zh) * 2016-06-14 2016-09-21 西安中科光电精密工程有限公司 一种主动式经纬仪***及测量方法
CN106524992A (zh) * 2016-12-08 2017-03-22 上海卫星装备研究所 航天器高精度角度测量***及方法
CN106767540A (zh) * 2016-12-19 2017-05-31 北京控制工程研究所 一种交会测量相机光轴与反射镜夹角误差标定方法
CN107860401A (zh) * 2017-10-27 2018-03-30 中国科学院西安光学精密机械研究所 一种用于实时修正光电经纬仪指向值的测量装置及方法
CN109631826A (zh) * 2018-12-29 2019-04-16 航天东方红卫星有限公司 一种卫星自动化精度检测方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150098079A1 (en) * 2013-10-09 2015-04-09 Hilti Aktiengesellschaft System and method for camera based position and orientation measurement
US9557001B2 (en) * 2014-11-07 2017-01-31 Hubbs Machine & Manufacturing, Inc. Combination portable industrial/survey instrument stand with conveyance capacities

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6490801B1 (en) * 1999-11-19 2002-12-10 Centre For Research In Earth And Space Technology Sun sensors using multi-pinhole overlays
CN103604411A (zh) * 2013-11-08 2014-02-26 北京卫星环境工程研究所 基于图像识别的经纬仪自动准直方法
CN104568374A (zh) * 2014-12-12 2015-04-29 中国航空工业集团公司北京长城计量测试技术研究所 风洞天平静校台几何量校准装置
CN105424060A (zh) * 2015-11-18 2016-03-23 湖北航天技术研究院总体设计所 一种飞行器星敏感器与捷联惯组安装误差的测量方法
CN105953771A (zh) * 2016-06-14 2016-09-21 西安中科光电精密工程有限公司 一种主动式经纬仪***及测量方法
CN106524992A (zh) * 2016-12-08 2017-03-22 上海卫星装备研究所 航天器高精度角度测量***及方法
CN106767540A (zh) * 2016-12-19 2017-05-31 北京控制工程研究所 一种交会测量相机光轴与反射镜夹角误差标定方法
CN107860401A (zh) * 2017-10-27 2018-03-30 中国科学院西安光学精密机械研究所 一种用于实时修正光电经纬仪指向值的测量装置及方法
CN109631826A (zh) * 2018-12-29 2019-04-16 航天东方红卫星有限公司 一种卫星自动化精度检测方法

Also Published As

Publication number Publication date
CN110285816A (zh) 2019-09-27

Similar Documents

Publication Publication Date Title
CN110285816B (zh) 一种小卫星星上设备高精度姿态测量***及方法
CN106441117B (zh) 基于多站etalon激光跟踪***的转台误差检测方法
CN210293237U (zh) 一种小卫星星上设备高精度姿态测量***
CN103979118B (zh) 一种机翼壁板数字化定位方法以及定位装置
CN107543495A (zh) 航天器设备自动准直测量***、准直方法与测量方法
CN110542434B (zh) 星载一体快速观测***地面调试用靶标及地面调试方法
CN112476315B (zh) 一种平板阵列sar天线展开***的装配方法及***
CN113324482B (zh) 一种三维坐标间接快速测量装置及方法
CN111102918B (zh) 一种立方镜坐标系的自动化测量***
CN110262535B (zh) 一种大尺度六自由度相对位姿模拟精度的自动化标定方法
CN114184168A (zh) 光测设备实时倾斜补偿方法
CN111169664A (zh) 一种调平控制***及方法
CN109682396A (zh) 一种星敏感器的基准棱镜高效装调***及装调方法
CN105698682B (zh) 一种基于激光跟踪仪的机床空间精度全方位测量方法
CN111521167B (zh) 基于影像控制的测绘仪器自动测定对中点的对中仪及其工作方法
CN112729245B (zh) 一种自动瞄准投点器及投点方法
CN110309555B (zh) 一种构建三轴转台式天线角度标校模型的方法
CN113960542A (zh) 一种雷达伺服座体方位指向精度的测量装置及方法
CN108317967B (zh) 一种三维坐标组合扫描测量***及其使用方法
CN114383563B (zh) 航天器总装自动化指向测量方法及***
CN116295018B (zh) 目标位姿测量方法及***
CN107860309B (zh) 提高激光跟踪仪测量精度的方法和装置
CN216206412U (zh) 一种光学标定机构
CN112692798B (zh) 一种高精度13自由度自动对接装置及方法
CN219890370U (zh) 一种激光跟踪仪角位置精度校准装置

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