一種基于wMPS的動態物體的位置姿態測量方法
【技術領域】
[0001] 本發明涉及動態物體測量領域，特別是一種基于wMPS的動態物體的位置姿態測 量方法。
【背景技術】
[0002] 工作空間測量定位系統（wMPS 〖workspace Measurement Positioning System)是 針對航天、航空、造船等大型制造業位置姿態測量需求及全局測量控制網的特點而發展起 來的一種新型多站網絡式室內空間測量定位系統，可實現大尺度空間整體坐標系下的高精 度自動并行測量。現有技術中的工作空間測量定位系統（《掃描平面激光空間定位系統測 量網絡的構建》所描述的工作空間測量定位系統）如圖1包括多個激光發射站、多個激光接 收器（接收器）、信號處理器和解算工作站，系統采用基于光電掃描的空間角度自動測量方 法對單個接收器進行定位，其中，激光發射站在工作時不負責解算接收器坐標，而是軸系勻 速旋轉向外發射帶有角度信息的光平面信號，為測量空間內的接收器提供定位服務信號； 激光接收器接收光平面信號并轉換為電信號發送給信號處理器，信號處理器以內部晶振為 時鐘計時時間基準對發射站發出的光信號進行計時測量，并從中得到每個信號處理器自身 在每個發射站坐標系下的角度信息，角度信息在上傳給解算工作站后，通過多個發射站之 間的角度交匯關系可計算出接收器的三維坐標。在上述工作模式中，發射站單向發送信息， 連接有接收器的信號處理器以本地晶振為計時基礎完成計時測角，發送-接收之間采用廣 播模式不存在閉環，因此確認等待環節，可實現全自動多點并行的高精度三維坐標測量，并 可通過增加發射站個數來達到增加量程的目的。目前，wMPS系統在航空航天制造現場等需 要多工序并行和整體精度控制的加工裝配過程中已經獲得大量成功應用。
[0003] 但是在如航天設備對接過程全物理仿真等動態測量應用中，關注重點不僅包括多 個設備在全局坐標系下的任一時刻空間位置和姿態，還需要在統一的時間軸上重建整個運 動過程。對于wMPS系統而言，在靜態或準靜態（測量時處于相對靜止狀態）測量的應用 中，被測物的空間位置和方位角度（姿態）可通過在被測物表面安裝多個（3個以上）激光 接收器以最優化擬合算法解決被測物在全局坐標系（或wMPS坐標系）下的位置和姿態測 量。但是動態測量時，由于系統采用多個發射站發射旋轉光信號對空間進行空間掃描，被測 物的運動必然會引入動態誤差，影響物體位置姿態計算精度，主要包括以下方面：
[0004] (1)單個接收器接收多個發射站光信號不同步引入的坐標測量誤差，該誤差指在 物體運動過程中激光發射站光信號在不同位置先后到達單個接收器表面而引起的交會誤 差；
[0005] (2)多個接收器間的測量時刻不同步而引入的姿態測量誤差，由于被測物的空間 位置和方位角度（姿態）需要通過在被測物表面安裝多個（3個以上）接收器進行擬合測 量，多接收器間的測量時刻同步誤差主要指在物體運動過程中由于多個接收器空間坐標測 量時刻存在時間先后差異而引入的位姿測量誤差。該同步誤差主要來源于兩方面，一方面 由于發射站在掃描空間多個接收器過程中光信號到達接收器時間先后順序不同而引起的 坐標解算時刻差異，另一方面源于多個接收器數據在信號處理器內處理先后順序不同而解 算時刻差異。
【發明內容】
[0006] 本發明解決的技術問題是：克服現有技術的不足，提供了一種在計算結果中集成 信號處理器在本地計時信息，將激光接收器坐標測量結果同步到同一時刻，有效降低不同 激光接收器由于坐標測量時刻不同步造成被測物位置姿態測量誤差的基于wMPS的動態物 體的位置姿態測量方法。
[0007] 本發明的技術解決方案是：一種基于wMPS的動態物體的位置姿態測量方法，包括 如下步驟：
[0008] 步驟一、在測量試驗現場放置η個激光發射站，記為激光發射站i，i = 1，2,3···， n，然后在被測物表面任意選取m個測點安裝激光接收器，記為激光接收器j，j = 1，2,3···， m，其中，η為激光發射站數量，m為激光接收器數量；
[0009] 步驟二、令η個激光發射站勻速自轉，激光發射站i在自轉周期T1的起始時刻發送 同步光脈沖，同時在自轉周期T i內還發送兩束掃描光脈沖，其中，η個激光發射站的自轉周 期分別記為Tn T2、TfTn;所述的同步光脈沖、掃描光脈沖為光平面信號，激光發射站i的 同步光脈沖、兩束掃描光脈沖的角度信息各不相同且η個激光發射站的同步光脈沖、兩束 掃描光脈沖角度信息各不相同，其中，角度信息為光平面信號與水平面的垂直面的夾角；
[0010] 步驟三、令m個激光接收器將接收到的多個激光發射站發送的同步光脈沖及掃描 光脈沖并將其分別轉換為同步電脈沖及掃描電脈沖信號；
[0011] 步驟四，以統一的計時基準對激光發射站i的同步電脈沖及掃描電脈沖信號按照 激光發射站i的自轉周期T 1進行匹配計時，對于激光發射器i，將激光接收器接收到激光發 射器i的同步光脈沖的時刻記為t。，將激光接收器分別接收到激光發射器i的兩束掃描光 脈沖的時刻分別記為Vt 2，得到在自轉周期T1內激光發射器i掃過激光接收器時的旋轉角 度Θ U、Θ 21分別為
[0012]
[0013]
[0014] 將t。作為激光發射站i的時間戳；
[0015] 步驟五、建立wMPS坐標系，然后在wMPS坐標系中對激光發射站i的兩束掃 描光平面的平面方程系數進行標定，并分別記為（8Η，?3Η，(3Η，(1 Η)與（a2i，b2i，c2i，d2i)， 對激光發射站k的兩束光平面的平面方程系數進行標定，并分別記為（alk，blk，clk，d lk) 與（a2k, b2k, c2k, d2k)，進而得到激光接收器j在tw時刻的坐標P Uj, y_j，zj，遍歷所有激 光接收器，得到各個激光接收器坐標，并分別記為P1, P2, P3，…Pni,坐標解算時刻分別為 tPi, tp2, tp3,......tpm，其中，k = I, 2, 3···η，得到 Uj,乃，Zj)可由下式求得
[0016]
[0017]
[0018]
[0019] (a2kcos ( Θ 2k) -b2ksin ( Θ 2k)) Xj+ (a2ksin ( Θ 2k) +b2kcos ( Θ 2k)) yj+c2kz^d2k= 0 ；
[0020] tpj為激光接收器j接收到的所有激光發射站時間戳的均值，wMPS坐標系的Z軸豎 直向上，Z軸與激光發射站1的第一束同步光脈沖的交點為原點，XOY平面過原點并垂直于 Z軸，第一束同步光脈沖與XOY平面的交線為X軸，Y軸指向根據右手定則確定；
[0021] 步驟六、如果 max(tpl, tp2, tp3, ."tpn)-min(tpl, tp2, tp3, ."tpn) < Tnax，則根據各個 激光接收器坐標（P1J2J3,……PJ計算動態物體位置姿態，動態物體的位置姿態測量結 束，如果11^(% 1，％2，％3，...％"1)1^11("％3，一％" 1)>1'隨，則轉入步驟七，其中，1^ = max (T1, T2, T3, ···, Ti)；
[0022] 步驟七、令tpq= max (t pl, tp2, tp3,......tpm)，得到tpq時刻激光接收器k的修正坐標
P"k為
[0023]
[0024] 其中W k為激光接收器k上一自轉周期的坐標，q = 1，2, 3…m，C *為激光接 收器k上一自轉周期的坐標P',的時刻；
[0025] 步驟八、根據各個激光接收器坐標P/'，P2"，P3"，…，P/計算動態物體位置姿態。
[0026] 所述的m彡3。
[0027] 所述的統一的計時基準為信號處理器的內部晶振。
[0028] 本發明與現有技術相比的優點在于：
[0029] (1)本發明方法以現有WMPS系統信號處理器時鐘為時標，在計算結果中集成信號 處理器在本地計時信息，將連接信號處理器的多個激光接收器坐標測量結果同步到同一時 亥IJ，可有效降低不同激光接收器由于坐標測量時刻不同步而造成的被測物位置姿態測量誤 差，實現基于wMPS的工業現場實時高精度大尺寸位姿測量；
[0030] (2)本發明方法克服