專利名稱：基于線陣ccd的空間目標姿態測量系統及其測量方法
技術領域：
本發明涉及光電式幾何量測量技術領域，具體涉及一種空間目標姿態測量方法。(二) 背景技術實現對空間目標的姿態測量也就是對其姿態角(俯仰角a、偏航角P和滾動角Y)的測 量，可以廣泛應用于機器人研究、柔性制造系統、精密機械裝配及含有內部姿態敏感裝置 飛行器的出廠檢驗等領域。目前主要采用兩種方式 一種是基于激光干涉技術的姿態測量 方式，代表產品為API的第三代激光跟蹤儀，可以實現對運動目標高精度的姿態測量，但 合作目標復雜，適用性差，不易于實現動態測量，而且價格昂貴；另一種是基于機器視覺 的姿態測量方式，根據是否在被測物體上安裝合作目標，或是采用攝像機的數量，姿態測 量模型各不相同，但均采用基于面陣圖像傳感器的攝像機進行測量，多存在速度和精度的 矛盾。(三) 發明內容本發明的目的在于提供一種技術、結構簡單，成本低，在同等測量精度的前提下，其 測量范圍可以做的很大，且易于滿足實時測量要求的基于線陣CCD的空間目標姿態測量系 統及其測量方法。本發明的目的是這樣實現的本發明提出的基于線陣CCD的空間目標姿態測量系統包括一路雙點目標三維坐標重構 子系統S3DCRDPT、 一路點目標三維坐標重構子系統S3DCRPT及布置于被測物體上的且 與相應坐標重構光學子系統中濾光片波長相對應的3個LED作為PCT的姿態測量裝置和9 路并行的含有CPLD單元、線陣CCD單元、抗串擾的高速模/數(A/D)轉換單元、FIFO 存儲單元、分ARM單元的1DIUS控制板對應1個含有3個從ARM單元和1個主ARM單 元的主控板的多CPU并行的流水線式的實時信息采集和處理的硬件結構、時鐘和電源。本發明的基于線陣CCD的空間目標姿態測量系統還包括這樣一些技術特征1、 所述雙點目標三維坐標重構子系統S3DCRDPT是由三個雙點目標一維成像子系統 1DISDPT彼此光軸成一定交角且在三個等間距位置上固定組成；2、 所述雙點目標一維成像子系統1DISDPT由一個分光棱鏡及共軛位置的兩個含有不 同波長范圍的選擇性一維成像單元1DIUS組成；3、 所述選擇性一維成像單元1DIUS由一個濾光片、一個柱面鏡頭及位于鏡頭焦平面上 且與其軸心線垂直的一個線陣CCD構成；4、 所述點目標三維坐標重構子系統S3DCRPT是由三個選擇性一維成像單元1DIUS彼 此光軸成一定交角且在三個等間距位置上固定組成；5、 所述硬件結構為采用AT91RM9200為主ARM單元，擴展鍵盤、LCD單元、SD卡 單元、USB單元、SDRAM單元、FLASH單元、JTAG單元、RS232外設和接口的專用嵌 入式結構；6、 所述9路1DIUS控制板上的線陣CCD單元、A/D轉換單元及FIFO存儲單元均連 接CPLD單元，CPLD單元連接主控板的主ARM單元。本發明提出的基于線陣CCD的空間目標姿態測量方法為首先采用一組由一個濾光片、 一個柱面鏡頭及位于鏡頭焦平面上且與其軸心線垂直的一個線陣CCD構成的選擇性一維成 像單元1DIUS組合而成的空間目標姿態測量系統，即采用三個由一個分光棱鏡及共軛位置 的兩個含有不同波長范圍的選擇性一維成像單元1DIUS組成的雙點目標一維成像子系統 1DISDPT彼此光軸成一定交角且在三個等間距位置上固定而成的雙點目標三維坐標重構子 系統S3DCRDPT和三個選擇性一維成像單元1DIUS彼此光軸成一定交角且在三個等間距位 置上固定而成的點目標三維坐標重構子系統S3DCRPT，分別實時重構按一定規則布置于被 測物體上攜帶其姿態信息且分別與重構光學子系統中濾光片波長范圍一一對應的兩個和一 個點合作目標(PCT)的三維坐標，再經過實時空間解算，確定被測物體姿態角，它依次含 有以下步驟(1) 標定1DIUS的7個/參數；(2) 布置PCT;(3) 1DIUS分別實時捕捉被測物體上與其相對應的PCT的像坐標；(4) 采用7系數直接變換(DLT)法重構各PCT的空間三維坐標；(5) 采用空間解算求解被測物體的姿態角(俯仰角ct、偏航角(3和滾動角y);(6) 判斷測量是否結束若否，則返回步驟(3);若是，則結束測量。 本發明的基于線陣CCD的空間目標姿態測量方法還包括這樣一些技術特征-1、所述的標定lDIUS的7個/參數依次含有如下步驟(1) 在含有滑動標尺座的平面校準模板上均勻布置x、 y坐標已知，且與PCT相同 的3種標志點，在縱深方向調解滑動標尺給出z坐標，實現測量空間內標志點的均勻布置；(2) 分別用S3DCRDPT和S3DCRPT中的1DIUS捕捉對應波長范圍標志點的像坐標；(3) 根據多于7個的測量空間內均勻布置的標志點已知的三維坐標和它們對應的一維像坐標，采用最小二乘法求解二者所確定平面方程7個/系數的最優解。2、 所述的布置PCT依次含有如下步驟-(1) 取被測物體軸心線與兩端面的交點分別布置兩個波長范圍不同的LED;(2) 在其中一個端面內過交點且與被測物體軸心線垂直的直線上遠離該交點的一點 處布置另一波長范圍的LED。3、 所述的1DIUS分別實時捕捉被測物體上與其相對應的PCT的像坐標依次含有如下步驟(1) 主ARM驅動LED控制板點亮放置于被測物體上的PCT;(2) 主ARM輸出一路可編程時鐘分為9路分送9個1DIUS控制板上的CPLD以產生 該路CCD的驅動時序、A/D的采樣時序及FIFO的寫時序等；(3) 主ARM驅動各從ARM，各從ARM驅動相應分ARM,均進入姿態測量程序；(4) 各線陣CCD分別實時捕捉放置于被測物體上攜帶其姿態信息且與其所在1DIUS 相對應的PCT;(5) 各分ARM將對A/D轉換的幀數據處理后的一維像點坐標傳給相應從ARM;(6) 各分ARM判斷姿態測量是否結束若否，則返回步驟(4);若是，則結束。4、 所述的采用7系數DLT法重構各PCT的空間三維坐標是通過以下方法實現的-(1) 3個從ARM分別對應3個分ARM接收3個1DIUS獲取的對應PCT當前時刻的 一維像點坐標An、義12和義13;(2) 在每個從ARM內，根據上述求得的每3個1DIUS固有參數的最小二乘解A'、 /2 '和/3'及每個1DIUS當前時刻實時獲取的一維像點坐標聯立求解當前時刻對應PCT的空間 三維坐標,21 - ^12^25 ,22 -^12"6 ~3-^12,27 "1 一 ^3"5 ,32 - 、"6 "3 - ^3義375、 所述的采用空間解算求解被測物體的姿態角，包括俯仰角a、偏航角p和滾動角y 是通過以下方法實現的(1) 3個從ARM分別將各對應PCT a、PCT b和PCT c的三維坐標0ca, ya， za) ， 0cb,_yb， zb)和0ceJe，Ze)分傳給主ARM;(2) 主ARM通過如下空間解算確定被測物體姿態角，<formula>formula see original document page 7</formula><formula>formula see original document page 8</formula>其中，PCTb和PCTc位于被測物體的同一端面，且<formula>formula see original document page 8</formula>
本發明基于線陣CCD的空間目標姿態測量方法就是采用一路雙點目標三維坐標重構子 系統(subsystems for 3D coordinate reconstruction of double point target, 簡稱S3DCRDPT) 禾口一路點目標三維坐標重構子系統(subsystem for 3D coordinate reconstruction of point target,簡稱S3DCRPT)分別實時重構按一定規則布置于被測物體上的兩個和一個波長范圍 均不相同的點合作目標(point cooperation target,簡稱PCT)的三維坐標，通過實時空間解 算確定被測物體的姿態角。含有濾光片2、柱面鏡頭3和位于其焦平面且與其軸心線垂直的 線陣CCD 4構成的選擇性一維成像單元(ID imaging unit with selectivity,簡稱1DIUS)如 圖1所示，它可以檢測遠處與其濾光片波長范圍相對應的光點1在垂直于柱面鏡頭軸心線 方向上的一維運動，5為光點的線狀像斑。非共軸、非平行的3個含有相同波長范圍濾光片 的1DIUS，引出三個平面相交于一點，可以唯一確定遠處相應波長范圍光點的空間位置， 我們稱其為S3DCRPT，如圖2所示。圖3為雙點目標一維成像子系統(1D imaging subsystem ofdouble point targets,簡稱1DISDPT)，它借助于一個分光棱鏡6，和共軛位置的兩個含有 不同波長范圍濾光片的1DIUS，實現對遠處兩個相應波長范圍光點的同時捕捉;3個非共軸、 非平行的1DISDPT，引出六個平面相交于兩點，構成S3DCRDPT，可以同時實現對兩個光 點的三維定位，它相當于兩個S3DCRPT的組合。運動中不產生形變的物體上的三個點可以 確定其姿態角，取被測物體軸心線與其端面的兩個交點及在其中一個端面內過交點且與其 軸心線垂直的直線上遠離該交點的一點處分別布置3個不同波長范圍的發光二極管(LED) 作為PCT，它們分別與含有相應波長范圍濾光片的坐標重構子系統相呼應，通過實時的坐 標重構和空間解算，則被測物體的姿態角可求。本發明系統的主要特點為1. 該姿態測量系統是多個基于線陣CCD單元的選擇性一維成像單元(1DIUS)的組合， 克服了采用面陣CCD作為信息輸入設備時存在的速度和精度的矛盾；2. 所設計的雙點目標三維坐標重構子系統(S3DCRDPT)相當于兩個點目標三維坐標重構子系統(S3DCRPT)的組合，提高測量精度的同時節省了測量空間；3. 按一定規則布置于被測物體之上攜帶其姿態變化信息的PCT分別與相應坐標重構光 學子系統中濾光片的波長范圍一一對應，解決了多PCT與多成像單元間的目標干擾問題；4. 線陣CCD單元采用東芝公司的線陣CCD TCD1708D，它在擁有高分辨率的同時還 降低了對光學鏡頭尺寸的要求，且PCT和濾光片的波長范圍與它的光譜敏感區間相對應；5. 設計了帶有滑動標尺座的平面校準模板，通過依次點亮各標志點(給出x,少坐標)及 調節滑動標尺在縱深方向(給出z坐標)的變化，方便實現在測量空間內均勻布置高密度 的標志點；6. 各1DIUS和各1DISDPT光軸間的夾角及位置根據測量空間和測量精度要求等因素 被綜合考慮并固定，校準一次后，不需要再重新校準，僅當測量空間改變時，需要重新考 慮、調整固定和校準；7. 采用9個分ARM單元、3個從ARM單元、1個主ARM單元的多CPU并行的流 水線式的硬件結構，有利于數據的實時處理；8. 選用AT91RM9200為主ARM單元，擴展鍵盤、LCD單元、SD卡單元、USB單元、 SDRAM單元、FLASH單元、JTAG單元、RS232外設和接口的專用嵌入式結構，提高了系 統的工作效率。本發明克服了采用面陣圖像傳感器作為信息輸入設備用于空間目標姿態測量時存在的 速度和精度的矛盾，在同等測量精度的前提下，其測量范圍可以做的很大，且易于滿足空 間運動目標姿態測量實時性的要求，使用方便。實驗證明，本發明測量系統可以對運動的 空間目標的姿態進行方便的測量，且具有很好的實時性。(四)
圖l為選擇性一維成像單元(1DIUS)結構和成像示意圖；圖2為點目標三維坐標重構子系統(S3DCRPT)結構示意圖；圖3為雙點目標一維成像子系統(1DISDPT)結構示意圖；圖4為本發明提出的空間目標姿態測量系統裝置示意圖；圖5為雙點目標一維成像子系統(1DISDPT)的簡化結構示意圖；圖6為帶有滑動標尺座的平面校準模板示意圖；圖7為本發明提出的空間目標姿態測量系統硬件結構框圖；圖8為基于線陣CCD的空間目標姿態測量方法的主控程序流程框圖。
具體實施方式
下面結合附圖對本發明作進一步的說明針對一個圓柱體被測對象，根據基于線陣CCD的姿態測量原理，設計出典型的姿態測 量裝置如圖4所示。取被測物體軸心線與兩端面的交點及過第二個交點的圓端面半徑上的 非圓心端點處分別布置可見光波段內的波長范圍分別為580~595nm、 615~635nm和 515 530nm的LED作為PCTa7、 PCT b 8禾n PCT c 9，初始時刻，該三點確定的平面應與 水平面平行；3個1DISDPT按照光軸方向成30°交角在等間距的位置上固定，構成 S3DCRDPT 10; 3個1DIUS按照光軸方向成30°交角在等間距的位置上固定，構成 S3DCRPT11，這相當于3個S3DCRPT或9個1DIUS的一個組合；上述裝置中，1DIUS中 濾光片與不同波長范圍PCT的對應，解決了多三維坐標重構子系統與多PCT —一對應時的 目標干擾問題；位于S3DCRDPT中間的1DISDPT和位于S3DCRPT中間的1DIUS的主光 軸分別垂直于被測物體運動空間的前端面，S3DCRDPT這種新光學構架的設計，提高了測 量精度，節省了測量空間，當焦距與光學鏡頭的其它特性參數相協調且不會影響成像質量 時，可以采用圖5所示的結構，即把圖3中共軛位置的兩個1DIUS進一步合并，二者共用 一個柱面鏡頭。設計光學鏡頭的分辨率大于線陣CCD的分辨率，則1DIUS的分辨率由CCD的分辨率 確定。因此，像元大小為4.7pm，有效像元數為7450，且在可見光波段范圍內反應均敏感 的東芝公司的TCD1708D被選擇，它在擁有高分辨率的同時還降低了對光學鏡頭尺寸的要 求。對放置于被測物體上且攜帶其姿態變化信息的LED的選擇是一個關鍵問題。根據CCD 的光敏范圍及布置原則確定3種不同波長范圍的LED，它們既要對應CCD光譜反應的敏感 區間又要有一定的光譜間隔以避免各LED與對應坐標重構子系統中濾光片波長范圍一一對 應時彼此間的相互干擾；LED的發光位置體現的是點位置，它的管芯要盡量小，發光功率 要足夠高，但為了保證特征點的提取精度，要求其在線陣CCD上的像點至少大于7個像元； 同時，為了避免目標脫靶，它們還應具有較大的發散角，此裝置中LED的發散角為120° 。為了讓在1DIUS視場內運動的PCT的一維位置信息被線陣CCD捕捉，應該選擇含有 柱面透鏡的鏡頭，又因為光學鏡頭的理論分辨率與相對孔徑成正比，而雙高斯物鏡是目前 大孔徑照相物鏡的基礎。因此，首先根據測量空間、測量精度和所選線陣CCD的有效感光 面的長度確定各一維成像單元鏡頭的光學特性參數，然后從ZEMAX軟件的鏡頭庫中找出 與所需特性參數相近的鏡頭結構，用一片或多片柱面透鏡對其中的球透鏡單元做替換，再 根據光線追跡結果做優化，從而確定各柱面鏡頭的結構參數。在基于機器視覺實現對空間運動目標的動態測量系統中，校準是一個很重要的環節。 對應本發明提出的姿態測量系統，發明人設計了帶有滑動標尺座的、可拆卸的平面校準模板，它上面均勻布置x、 y坐標已知，且與PCT相同的3種標志點，通過調節滑動標尺給出 z坐標，從而方便實現測量空間內高密度標志點的均勻布置，見圖6。校準計算時，滑動標 尺給出的標志點的z坐標與其真實值的補償系數(設計模版時已知)需要被考慮。與上述測量裝置對應的結構框圖如圖7所示，它體現兩個方向的信號走向。 一方面， 主控板上的主ARM的可編程時鐘信號分成9路經LVDS傳輸，送入各1DIUS控制板上的 CPLD以為該路線陣CCD、 A/D和FIFO提供時序信號，而控制信號則是用戶通過鍵盤與 主ARM進行對話產生，而后主ARM驅動各從ARM，從ARM驅動相應分ARM;另一方 面，體現了多CPU響應控制命令并行處理數據的走向，該系統采用9個基于線陣CCD的 1DIUS (3個1DIUS對應1個PCT)實時進行圖像采集，9路空間上離散的模擬信號分別經 前端信號調理電路、抗串擾的高速A/D電路、FIFO數據存儲器，送入9個分ARM單元進 行處理；所得PCT的一維像坐標經并/串轉換和LVDS傳輸后，3個一組分別送主控板上的 從ARM1、從ARM2和從ARM3，它們分別聯立方程組求解3個PCT的空間三維坐標；3 路三維坐標再經SPI串行傳輸后送總ARM，經過空間解算以確定當前時刻的姿態角，結果 被存儲并送往LCD顯示終端。基于線陣CCD的姿態測量方法的主控程序流程框圖如圖8所示，主ARM響應鍵盤輸 入的命令相應進入各程序l)校準程序，首先，主ARM根據當前鍵盤子命令驅動LED控 制板點亮校準模板上與S3DCRDPT或S3DCRPT對應的第一對或第一個標志點；然后，輸 出可編程時鐘分送相應CPLD，以產生所在1DIUS控制板所需時鐘信號；而后，驅動相應 從ARM進入校準程序并等待其響應，判斷采集的標志點是否是當前z坐標下對應校準模板 上的最后一對或一個，若是，則等待移動校準模板滑動標尺座給出標志點新的z坐標后的 鍵盤子命令ready，給出next信號驅動LED控制板熄滅校準模板上當前標志點并點亮對應 的下一對或下一個標志點，若否，直接給出next信號；最后，判斷是否有鍵盤結束命令？ 若否，重新啟動一次校準，若是，則轉向結束程序。2)姿測程序，首先，主ARM驅動LED 控制板點亮布置于被測物體上的PCT，然后，輸出可編程時鐘分送各路CPLD，以產生各 路1DIUS控制板所需時鐘信號；而后，驅動各從ARM進入姿測程序并等待接收當前時刻 三個PCT的三維坐標以進行姿態角的解算，結果被存儲后送LCD顯示；最后，判斷是否有 鍵盤結束命令？若否，等待依次接收下一時刻PCT的三維坐標，若是，則轉向結束程序。3) 結束程序，首先，驅動各從ARM進入結束程序；然后，驅動LED控制板進入結束程序； 最后退出主控程序。對于所設計的小視場1DIUS的光學鏡頭，采用基于針孔模型的7系數DLT法，則被測 PCT的空間三維坐標(;c，乂z)與它們相應線狀像和線陣CCD的交點坐標義之間的關系可以用下面的平面方程進行描述/jjc + /2_y + /3z + /4 -義/5x _ A/6_y _ A/7z = A. (1)其中，/i (1=1，2，...，7)為該平面方程的系數，也即1DIUS的固有參數，根據被測物體運動空 間范圍內均勻布置的n(n^7)個標志點的三維坐標(jc，乂z)和它們相應的一維像坐標，釆 用最小二程法求解這7個系數，表達式如下<formula>formula see original document page 13</formula>綜上所述，該姿態測量系統的工作步驟如下-首先，根據該被測物體的運動空間范圍和姿態測量精度的要求確定、調整并固定好各 1DISDPT和各1DIUS間的夾角；其次，通過鍵盤啟動校準程序，主ARM驅動LED控制板依次點亮平面校準模板上的 與PCT a或PCT b和PCT c相同的標志點，并通過調節其滑動標尺座在縱深方向的位移， 在測量空間內均勻布置標志點，分別校準構成S3DCRDPT或S3DCRPT的各1DIUS單元， 所得各1DIUS的固有參數(7個/系數)將保存在主控板上相應的從ARM中；再次，通過鍵盤啟動姿測程序，主ARM驅動LED控制板點亮布置于被測物體上的PCT a、 PCT b和PCT c，則9路線陣CCD分別實時捕捉與它們對應的PCT，各分ARM將處理 后的一維像點坐標信息經并/串轉換，LVDS傳輸給主控板上的3個從ARM，聯立方程求解 后的PCT的三維空間坐標再經SPI串行傳輸給主ARM，進行空間解算，則姿態角可求，并 且當前時刻及姿態角被送往LCD顯示終端輸出。
權利要求
1、一種基于線陣CCD的空間目標姿態測量系統，其特征在于它包括一路雙點目標三維坐標重構子系統S3DCRDPT、一路點目標三維坐標重構子系統S3DCRPT及布置于被測物體上的且與相應坐標重構光學子系統中濾光片波長相對應的3個LED作為PCT的姿態測量裝置和9路并行的含有CPLD單元、線陣CCD單元、抗串擾的高速模/數A/D轉換單元、FIFO存儲單元、分ARM單元的1DIUS控制板對應1個含有3個從ARM單元和1個主ARM單元的主控板的多CPU并行的流水線式的實時信息采集和處理的硬件結構、時鐘和電源。
2、 根據權利要求1所述的基于線陣CCD的空間目標姿態測量系統，其特征在于所述雙點 目標三維坐標重構子系統S3DCRDPT是由三個雙點目標一維成像子系統1DISDPT彼此光軸 成一定交角且在三個等間距位置上固定組成，雙點目標一維成像子系統1DISDPT由一個分光 棱鏡及共軛位置的兩個含有不同波長范圍的選擇性一維成像單元1DIUS組成。
3、 根據權利要求1所述的基于線陣CCD的空間目標姿態測量系統，其特征在于所述選擇 性一維成像單元1DIUS由一個濾光片、 一個柱面鏡頭及位于鏡頭焦平面上且與其軸心線垂直 的一個線陣CCD構成。
4、 根據權利要求1所述的基于線陣CCD的空間目標姿態測量系統，其特征在于所述點目 標三維坐標重構子系統S3DCRPT是由三個選擇性一維成像單元1DIUS彼此光軸成一定交角 且在三個等間距位置上固定組成。
5、 一種基于線陣CCD的空間目標姿態測量方法，其特征在于首先采用一組由一個濾光片、 一個柱面鏡頭及位于鏡頭焦平面上且與其軸心線垂直的一個線陣CCD構成的選擇性一維成 像單元1DIUS組合成的空間目標姿態測量系統，即采用三個由一個分光棱鏡及共軛位置的兩 個含有不同波長范圍的選擇性一維成像單元1DIUS組成的雙點目標一維成像子系統 1DISDPT彼此光軸成一定交角且在三個等間距位置上固定而成的雙點目標三維坐標重構子系 統S3DCRDPT和三個選擇性一維成像單元1DIUS彼此光軸成一定交角且在三個等間距位置 上固定而成的點目標三維坐標重構子系統S3DCRPT，分別實時重構按一定規則布置于被測物 體上攜帶其姿態信息且分別與重構光學子系統中濾光片波長范圍一一對應的兩個和一個點合 作目標PCT的三維坐標，再經過實時空間解算，確定被測物體姿態角，它依次含有以下步驟(1) 標定1DIUS的7個/參數；(2) 布置PCT;(3) 1DIUS分別實時捕捉被測物體上與其相對應的PCT的像坐標；(4) 采用7系數直接變換DLT法重構各PCT的空間三維坐標；(5) 采用空間解算求解被測物體的姿態角，包括俯仰角a、偏航角(3和滾動角Y;(6) 判斷測量是否結束若否，則返回步驟(3);若是，則結束測量。
6、 根據權利要求5所述的基于線陣CCD的空間目標姿態測量方法，其特征在于，所述的標 定1DIUS的7個/參數的步驟依次含有如下步驟(1) 在含有滑動標尺座的平面校準模板上均勻布置x、；;坐標已知，且與PCT相同的3 種標志點，在縱深方向調解滑動標尺給出z坐標，實現測量空間內標志點的均勻布置；(2) 分別用S3DCRDPT和S3DCRPT中的1DIUS捕捉對應波長范圍標志點的像坐標；(3) 根據多于7個的測量空間內均勻布置的標志點已知的三維坐標和它們對應的一維 像坐標，采用最小二乘法求解二者所確定平面方程7個/系數的最優解。
7、 根據權利要求5所述的基于線陣CCD的空間目標姿態測量方法，其特征在于，所述的布 置PCT的步驟依次含有如下步驟(1) 取被測物體軸心線與兩端面的交點分別布置兩個波長范圍不同的LED;(2) 在其中一個端面內過交點且與被測物體軸心線垂直的直線上遠離該交點的一點處 布置另一波長范圍的LED。
8、 根據權利要求5所述的基于線陣CCD的空間目標姿態測量方法，其特征在于，所述的 1DIUS分別實時捕捉被測物體上與其相對應的PCT的像坐標的步驟依次含有如下步驟(1 )主ARM驅動LED控制板點亮放置于被測物體上的PCT;(2) 主ARM輸出一路可編程時鐘分為9路分送9個1DIUS控制板上的CPLD以產生 該路CCD的驅動時序、A/D的采樣時序及FIFO的寫時序等；(3) 主ARM驅動各從ARM，各從ARM驅動相應分ARM,均進入姿態測量程序；(4) 各線陣CCD分別實時捕捉放置于被測物體上攜帶其姿態信息且與其所在1DIUS相 對應的PCT;(5) 各分ARM將對A/D轉換的幀數據處理后的一維像點坐標傳給相應從ARM;(6) 各分ARM判斷姿態測量是否結束若否，則返回步驟(4);若是，則結束。
9、 根據權利要求5所述的基于線陣CCD的空間目標姿態測量方法，其特征在于，所述的 采用7系數DLT法重構各PCT的空間三維坐標是通過以下方法實現的(1) 3個從ARM分別對應3個分ARM接收3個1DIUS獲取的對應PCT當前時刻的一 維像點坐標義u、義12和義13;(2) 在每個從ARM內根據上述求得的每3個lDIUS固有參數的最小二乘解/r、 /2'和 /3'及每個1DIUS當前時刻實時獲取的一維像點坐標聯立求解當前時刻對應PCT的空間三維 坐標，<formula>formula see original document page 4</formula>
10、根據權利要求5所述的基于線陣CCD的空間目標姿態測量方法，其特征在于，所述的 采用空間解算求解被測物體的姿態角，包括俯仰角a、偏航角p和滾動角y這一步驟是通過 以下方法實現的(1 ) 3個從ARM分別將各對應PCT a、 PCT b和PCT c的三維坐標0ca， _ya, za) ， 0cb, zb)和(A, & Ze)分傳給主ARM;(2)主ARM通過如下空間解算確定被測物體姿態角，<formula>formula see original document page 4</formula>其中，PCTb和PCTc位于被測物體的同一端面，且<formula>formula see original document page 4</formula>
全文摘要
本發明提供了一種基于線陣CCD的空間目標姿態測量系統及其方法，它是一種采用基于9個含有濾光片的選擇性一維成像單元組合的3個三維坐標重構子系統分別實時重構按一定規則布置于被測物體上攜帶其姿態信息且與其所含濾光片波長范圍一一對應的3個點合作目標的空間三維坐標，通過空間解算確定被測物體姿態角的方法，相應提出了由上述組合裝置、各一維成像單元控制板、主控板、擴展LCD和鍵盤的多CPU并行的流水線式的專用嵌入式系統。本發明克服了采用面陣圖像傳感器作為信息輸入設備用于空間目標姿態測量時存在的速度和精度的矛盾，易于滿足空間運動目標姿態測量實時性的要求，使用方便。
文檔編號G01B11/00GK101216289SQ20081006384
公開日2008年7月9日 申請日期2008年1月11日 優先權日2008年1月11日
發明者丁振良, 艾莉莉, 峰 袁 申請人:哈爾濱工業大學