雷達運動目標模擬平臺解算方法

周紅峰，張友益

(中國船舶重工集團公司第七二三研究所，江蘇 揚州 225001)

雷達運動目標模擬平臺解算方法

周紅峰，張友益

(中國船舶重工集團公司第七二三研究所，江蘇 揚州 225001)

介紹了一種雷達運動目標模擬平臺，基于D-H方法建立了這種平臺的運動模型，用不同方法對平臺進行了正運動學及逆運動學分析，采用對比法對分析結果進行驗證，通過仿真驗證了建立的運動學模型的準確性。

搖臂；雷達模擬；運動目標;解算方法

0 引 言

隨著雷達技術的發展和雷達仿真試驗要求的不斷提高，需要在暗室內場條件下或者外場條件下實現雷達運動目標的模擬。根據這樣的需求，為了實現從雷達角度看到俯仰及方位的運動目標，通常采用移動的信號源方法。按照這樣的模擬原理，可采用喇叭陣列、矩形掃描架、搖臂平臺等幾種實現方案來實現信號源運動。

喇叭陣列方案采用二維平面空間排布的喇叭陣列，通過不同喇叭之間的切換模擬目標的運動。由于喇叭與喇叭之間是離散排布，目標空間覆蓋是離散的，導致模擬出來的目標軌跡也是離散的，存在較大的離散誤差。

采用掃描框架方案，需要比較大的框架以及橫豎移動機構。內場應用時，由于較小場景相對容易實現，外場應用時需要大跨度支撐框架以及橫豎移動機構，實現復雜，靈活性差。

搖臂式目標運動模擬方案相對前2個方案能夠實現連續的目標軌跡，布置靈活，安裝相對簡單，但控制相對復雜。

本文對搖臂式目標模擬方案原理及解算數學模型進行了理論分析和推導。具體的搖臂運動平臺可以依據解算模型設計伺服控制系統軟件，結合具體的平臺參數實現目標的模擬。

1 搖臂平臺目標模擬原理

圖1 目標模擬原理圖

搖臂模擬平臺布置在雷達與將要模擬的目標之間。搖臂平臺控制信號源三維運動，使信號源始終位于雷達與要模擬目標之間的連線上。模擬器的方位俯仰運動，通過圖1的關系可以轉換成模擬目標的方位俯仰運動。數學上，搖臂的運動軌跡為目標運動軌跡在搖臂運動曲面上的投影。具體投影方法為：雷達目標和雷達的連線與搖臂運動曲面相交，交點為投影點。

2 搖臂平臺運動鏈與正運動學分析

要研究搖臂系統，首先要進行搖臂運動平臺運動鏈及運動學分析研究。對搖臂平臺運動學分析是對搖臂平臺運動控制的基礎。搖臂運動平臺運動學問題包含正向解和逆向解問題。正向解問題是搖臂根據每個運動副設定關節變量值，得到信號源的空間位置和方向的解算過程。逆向解問題是根據信號源運動軌跡和方向的要求，解出各個運動副關節的變量(未知的關節參數)。本節先研究搖臂運動鏈及正向解問題，下節研究逆向解問題。

搖臂運動平臺是典型的串聯機械手結構，由簡單的運動鏈所組成。如圖2所示的搖臂運動平臺由0到5號6個桿件組成。其組成的每個桿件最多只和2個其他桿件相連。端部的2只桿件只和1個桿件相連，第0號桿件為基座，第5號桿件是末端執行器(即信號源)。除了端部的桿件，其它的桿件都包含2個運動副，而且都是轉動副(rotating pair)。1號到4號桿件為中間桿件，它們都為雙運動副桿件，其兩端轉動副分別為R1～R5。

圖2 搖臂運動模擬平臺運動鏈桿件圖

為了唯一描述運動鏈的結構，即確定相鄰2個運動副之間的相對位置與方向，這里采用Denavit-Hartenberg提出的D-H方法[1]。

圖2所示的搖臂平臺結構由5個轉動副構成。描述搖臂平臺的狀態，可以用這5個轉動副的關節變量以及表征運動副之間位置關系的關節參數表示。

根據D-H方法，在圖2中已經定義i=0,…,5號桿件，0號為基座，5號為執行器。以下為了敘述方便采用i=0,…,5計數多個連續的運動副、桿件、坐標系等。

定義0,…,5號運動副的軸Zi(i=0,…,5)。Xi同時與Zi-1和Zi垂直，方向為Zi-1到Zi，符合右手定則。Zi-1與Zi之間距離定義為ai，Xi+1與Zi的交點在Zi上的坐標為bi。Zi-1與Zi之間夾角定義為αi，Xi與Xi-1之間夾角定義為θi。對于搖臂運動鏈結構(搖臂結構的形位和姿態)，可以用每個運動副Ri的參數ai，bi，αi，θi等描述，表示為Ri(ai，bi，αi，θi)。根據上述定義，對于本文的搖臂平臺，θi是未知量，是關節變量，而其他參數在設計具體搖臂時都已確定。

D-H方法可以描述搖臂平臺，用以確定信號源在桿件坐標系的結構、形位或姿態。為了進一步對搖臂平臺進行運動分析，需要定義相關信號源的笛卡爾坐標系關節坐標系，如圖3所示。

圖3 搖臂運動平臺D-H法分析

具體過程如下：定義Fi為以Oi為原點，(Xi，Yi，Zi)為軸的坐標系，Fi固定在i-1號桿件上。正向求解可以通過相關的坐標旋轉、移動等實現。設Qi為坐標系Fi(Xi，Yi，Zi)旋轉到坐標系Fi+1(Xi+1，Yi+1，Zi+1)的旋轉矩陣。設Ai為Oi到Oi+1的矢量。矩陣Qi可以按照幾何學定義，用ai，bi，αi，θi參數實現：

(1)

設Q為末端信號源的方向，A為末端執行器工作點的位置，則：

Q=Q1Q2Q3Q4Q5

(2)

A=A1+Q1A2+Q1Q2A3+Q1Q2Q3A4+

Q1Q2Q3Q4Q5A5

(3)

對于具體的搖臂平臺，在設計時相鄰軸間多采用垂直或平行關系，如Z2⊥Z1，Z3∥Z2，Z4⊥Z3，Z5⊥Z4，解耦相關運動關系，簡化旋轉矩陣復雜度，也方便最終的搖臂控制。

3 搖臂平臺逆運動學分析

對于本文中逆向解問題是按照設定好的目標軌跡要求，通過逆運動解算，獲得控制信號源的空間位置的每個運動副未知變量數值。在模擬過程中正向用這些數值控制運動副關節運動，復原出信號源空間位置，使信號源按要求正好位于雷達與模擬目標的連線上。

經前節分析每個關節運動副的參數除θi未知，其余都是已知量，所以搖臂運動平臺逆向問題就是求解未知的變量θi。具體可以采用上節D-H法得出的公式和具體的約束條件列寫相關方程進行求解。但這個逆解算過程需要通過消元后解非線性方程組得到解答，過程比較復雜，還會出現多重根的情況。

根據搖臂模擬平臺的目標模擬原理，具體的約束條件是，平臺輸入是目標的空間坐標位置，只能夠確定目標與雷達之間的連線，要求搖臂平臺控制的信號源在這條連線上，并且輻射源要方向要對準雷達。

由上分析可知，搖臂承載負載信號源的位置沒有直接給出，需根據約束要進行求解。根據搖臂平臺的具體要求得到:

(4)

式中：T為目標的位置坐標；Tr為雷達的位置坐標；第1個方程表示信號源的指向于目標與雷達的連線平行；第2個方程表示A位于雷達與目標的連線上；第3個方程表示桿3與桿1平行，都垂直于基座，這是搖臂運動的附加約束條件。

將式(1)、(2)和(3)的關系帶入式(4)，可以得到5元的非線性方程組，解這個方程組，能夠得到搖臂每個關節轉角角度θi的值。

上述方法求解比較復雜，對于簡單的結構能夠獲得閉式的解，復雜的結構有可能需要通過數值方法給出解。針對文中的搖臂平臺，本文給出了一種相對簡單的幾何解析法來求解搖臂平臺逆運動問題。該方法充分利用搖臂平臺設計特殊的空間結構，盡量多地進行運動解耦，簡化搖臂平臺的解算過程。

首先分析由這5個轉動副構成的運動學鏈。搖臂平臺模型如圖4所示。

圖4 搖臂運動平臺結構及運動副轉角定義

平臺為5軸系統，通過運動副的特殊位置設置，滿足搖臂平臺運動模擬要求，同時對5軸系統運動關系進行簡化。ψ1、β1構成一級向上叉架結構，垂直相交；ψ2、ψ3構成向下的叉架結構，垂直相交；β1、β2軸向平行，可認為是一個平面機構；β1、β2互補，保證ψ1、ψ2軸平行且與大地垂直。

對運動目標模擬的方法為控制ψ1、β1、β2、ψ2、ψ3，使信號源始終處于雷達天線與目標連線上，使信號源始終對準雷達。根據上述定義，建立相關坐標系如圖5所示。

雷達位于坐標原點，雷達與搖臂基座連線為X軸方向，Z方向垂直向上，Y方向符合右手定則。

圖5 搖臂運動平臺幾何解析法分析模型

設虛擬的圓心在O(a,b,c)，搖臂臂長R，搖臂垂直于XY平面，且垂點位于X上(為了簡化)。S(x,y,z)為信號源位置,S′是S在XY平面的投影點。T(xt,yt,zt)為模擬的目標位置。

計算S(x,y,z)點：

(5)

a2+b2+c2-R2=0

(6)

(7)

這里取較小的根，即：

(8)

根據圖5 模型可解出ψ1、ψ2、ψ3、β1、β2等角度。

4 模型驗證

為了驗證前述不同模型的正確性，采用2種模型相互驗證的方法來實現。具體思路為：設置搖臂平臺的基本參數、目標位置、雷達位置，根據這些輸入參數代入逆運動幾何解析法模型，得到搖臂平臺的控制參數及信號源位置坐標。將搖臂的控制參數代入，用D-H法得出正向解算模型，得到信號源位置坐標，驗證兩模型信號源位置坐標是否相同，由此來驗證2個模型的一致性。

設置搖臂參數，如圖2中桿1長2 m，桿2長2 m，桿3長5 m；圖3中Z3到Z5距離2 m，X1到X2距離2 m，Z2到Z3距離5 m，X4到X5距離2 m。

目標在以雷達為原點的坐標系中的位置為(20 000,500,2 000)，單位m。雷達到搖臂平臺距離100 m。

逆運動幾何解析法模型計算如下：

根據第3節中描述的模型以及搖臂輸入參數，得出模型的輸入參數：a=100 m,b=0 m,c=2 m,R=5 m,xt=20 000 m,yt=500 m,zt=2 000 m。計算得到：信號源位置為S(95.715 4，0.957 2，2.392 9)，ψ1=12.592 7°，ψ2=13.165 7°，ψ3=1.432 2°，β1=118.592 5°，β2=61.407 5°。

D-H法正運動模型計算：根據搖臂輸入參數、第2節中相關定義和圖3得到模型的輸入參數α1=0°，α2=90°，α3=0°，α4=90°，α5=90°；A1到A5矢量為A1=(0,0,2)′，A2=(-5cosθ2, -5sinθ2,0)′，A3=(0, 0,0)′，A4=(0, 0,-2)′，A5=(0, 0,0)′。

根據圖3和圖5的模型，以及第1節描述的方法，依據逆運動模型計算結果，可得到：θ1=-12.592 7°,θ2=-28.592 5°,θ3=151.407 5°,θ4=13.165 7°,θ5=1.432 2°。各旋轉副的關節參數為：

R1(a1=0 m,b1=2 m,α1=0°,θ1=-12.592 7°)；

R2(a2=0 m,b2=0 m,α2=90°,θ2=-28.592 5°)；

R3(a3=5 m,b3=0 m,α3=0°,θ3=151.407 5°)；

R4(a4=0 m,b4=-2 m,α4=90°,θ4=13.165 7°)；

R5(a5=0 m,b5=0 m,α5=90°,θ5=1.432 2°)。

根據公式(2)、(3) 得到：

A=(-4.284 6,0.957 2,2.392 9)′

A為信號源位置矢量，由于圖3和圖5之間坐標系原點X方向差100 m，換算到圖5坐標系中：

(-4.284 6+100,0.957 2,2.392 9)=(95.715 4，0.957 2，2.392 9)

結果與S相等，驗證了這2種模型的正確性。

5 結束語

搖臂式運動平臺的運動學分析是搖臂平臺設計的基礎，也是目標模擬的基本模型。本文給了搖臂式雷達目標模擬平臺的模擬原理，分析了搖臂式運動平臺的運動鏈并進行了運動學分析，給出了相關仿真驗證。在搖臂平臺具體技術設計過程中必須進行動力學分析，即研究搖臂平臺在運動過程中速度、加速度等問題。動力學問題可以以運動學研究為基礎，利用運動學研究的結果和相關公式。另外搖臂平臺的伺服控制也是建立在搖臂運動學和動力學分析的基礎上。本文的研究為搖臂雷達目標模擬器的控制研究提供了基礎的運動學解算模型和方法，更深入的研究還需要進一步開展。

[1] 宋偉剛.機器人學[M].北京：科學出版社，2007.

[2] 數學手冊編寫組.數學手冊[M].北京：人民教育出版社，1979.

SolvingMethodofSimulationPlatformofRadarMovingTarget

ZHOU Hong-feng,ZHANG You-yi

(The 723 Institute of CSIC,Yangzhou 225001,China)

This paper introduces a simulation platform of radar moving target,builds the moving model of the platform based on D-H method,performs the analysis of forward kinematics and inverse kinematics to the platform through different methods,adopts comparison method to validate the analyzing result,validates the veracity to build moving dynamatic model through simulation.

rocker arm;radar simulation;moving target;solving method

TN955.2

A

CN32-1413(2017)05-0040-04

10.16426/j.cnki.jcdzdk.2017.05.008

2017-09-10