| 主权项 |
一种基于wMPS的动态物体的位置姿态测量方法，其特征在于包括如下步骤：步骤一、在测量试验现场放置n个激光发射站，记为激光发射站i，i＝1，2，3…，n，然后在被测物表面任意选取m个测点安装激光接收器，记为激光接收器j，j＝1，2，3…，m，其中，n为激光发射站数量，m为激光接收器数量；步骤二、令n个激光发射站匀速自转，激光发射站i在自转周期T<sub>i</sub>的起始时刻发送同步光脉冲，同时在自转周期T<sub>i</sub>内还发送两束扫描光脉冲，其中，n个激光发射站的自转周期分别记为T<sub>1</sub>、T<sub>2</sub>、T<sub>3</sub>…T<sub>n</sub>；所述的同步光脉冲、扫描光脉冲为光平面信号，激光发射站i的同步光脉冲、两束扫描光脉冲的角度信息各不相同且n个激光发射站的同步光脉冲、两束扫描光脉冲角度信息各不相同，其中，角度信息为光平面信号与水平面的垂直面的夹角；步骤三、令m个激光接收器将接收到的多个激光发射站发送的同步光脉冲及扫描光脉冲并将其分别转换为同步电脉冲及扫描电脉冲信号；步骤四，以统一的计时基准对激光发射站i的同步电脉冲及扫描电脉冲信号按照激光发射站i的自转周期T<sub>i</sub>进行匹配计时，对于激光发射器i，将激光接收器接收到激光发射器i的同步光脉冲的时刻记为t<sub>0</sub>，将激光接收器分别接收到激光发射器i的两束扫描光脉冲的时刻分别记为t<sub>1</sub>、t<sub>2</sub>，得到在自转周期T<sub>i</sub>内激光发射器i扫过激光接收器时的旋转角度θ<sub>1i</sub>、θ<sub>2i</sub>分别为<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>θ</mi><mrow><mn>1</mn><mi>i</mi></mrow></msub><mo>=</mo><mfrac><mrow><msub><mi>t</mi><mn>1</mn></msub><mo>-</mo><msub><mi>t</mi><mn>0</mn></msub></mrow><mrow><mi>T</mi><mi>i</mi></mrow></mfrac><mo>*</mo><mn>2</mn><mi>π</mi></mrow>]]></math><img file="FDA0000798204200000011.GIF" wi="454" he="142" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>θ</mi><mrow><mn>2</mn><mi>i</mi></mrow></msub><mo>=</mo><mfrac><mrow><msub><mi>t</mi><mn>2</mn></msub><mo>-</mo><msub><mi>t</mi><mn>0</mn></msub></mrow><mrow><mi>T</mi><mi>i</mi></mrow></mfrac><mo>*</mo><mn>2</mn><mi>π</mi></mrow>]]></math><img file="FDA0000798204200000012.GIF" wi="417" he="142" /></maths>将t<sub>0</sub>作为激光发射站i的时间戳；步骤五、建立wMPS坐标系，然后在wMPS坐标系中对激光发射站i的两束扫描光平面的平面方程系数进行标定，并分别记为(a<sub>1i</sub>,b<sub>1i</sub>,c<sub>1i</sub>,d<sub>1i</sub>)与(a<sub>2i</sub>,b<sub>2i</sub>,c<sub>2i</sub>,d<sub>2i</sub>)，对激光发射站k的两束光平面的平面方程系数进行标定，并分别记为(a<sub>1k</sub>,b<sub>1k</sub>,c<sub>1k</sub>,d<sub>1k</sub>)与(a<sub>2k</sub>,b<sub>2k</sub>,c<sub>2k</sub>,d<sub>2k</sub>)，进而得到激光接收器j在t<sub>pj</sub>时刻的坐标P<sub>j</sub>(x<sub>j</sub>,y<sub>j</sub>,z<sub>j</sub>)，遍历所有激光接收器，得到各个激光接收器坐标，并分别记为P<sub>1</sub>,P<sub>2</sub>,P<sub>3</sub>,…P<sub>m</sub>，坐标解算时刻分别为t<sub>p1</sub>,t<sub>p2</sub>,t<sub>p3</sub>,……t<sub>pm</sub>，其中，k＝1,2,3…n，得到(x<sub>j</sub>,y<sub>j</sub>,z<sub>j</sub>)可由下式求得(a<sub>1i</sub>cos(θ<sub>1i</sub>)‑b<sub>1i</sub>sin(θ<sub>1i</sub>))x<sub>j</sub>+(a<sub>1i</sub>sin(θ<sub>1i</sub>)+b<sub>1i</sub>cos(θ<sub>1i</sub>))y<sub>j</sub>+c<sub>1i</sub>z<sub>j</sub>+d<sub>1i</sub>＝0(a<sub>2i</sub>cos(θ<sub>2i</sub>)‑b<sub>2i</sub>sin(θ<sub>2i</sub>))x<sub>j</sub>+(a<sub>2i</sub>sin(θ<sub>2i</sub>)+b<sub>2i</sub>cos(θ<sub>2i</sub>))y<sub>j</sub>+c<sub>2i</sub>z<sub>j</sub>+d<sub>2i</sub>＝0(a<sub>1k</sub>cos(θ<sub>1k</sub>)‑b<sub>1k</sub>sin(θ<sub>1k</sub>))x<sub>j</sub>+(a<sub>1k</sub>sin(θ<sub>1k</sub>)+b<sub>1k</sub>cos(θ<sub>1k</sub>))y<sub>j</sub>+c<sub>1k</sub>z<sub>j</sub>+d<sub>1k</sub>＝0(a<sub>2k</sub>cos(θ<sub>2k</sub>)‑b<sub>2k</sub>sin(θ<sub>2k</sub>))x<sub>j</sub>+(a<sub>2k</sub>sin(θ<sub>2k</sub>)+b<sub>2k</sub>cos(θ<sub>2k</sub>))y<sub>j</sub>+c<sub>2k</sub>z<sub>j</sub>+d<sub>2k</sub>＝0；t<sub>pj</sub>为激光接收器j接收到的所有激光发射站时间戳的均值，wMPS坐标系的Z轴竖直向上，Z轴与激光发射站1的第一束同步光脉冲的交点为原点，XOY平面过原点并垂直于Z轴，第一束同步光脉冲与XOY平面的交线为X轴，Y轴指向根据右手定则确定；步骤六、如果max(t<sub>p1</sub>,t<sub>p2</sub>,t<sub>p3</sub>,…t<sub>pm</sub>)‑min(t<sub>p1</sub>,t<sub>p2</sub>,t<sub>p3</sub>,…t<sub>pm</sub>)≤T<sub>max</sub>，则根据各个激光接收器坐标(P<sub>1</sub>,P<sub>2</sub>,P<sub>3</sub>,……P<sub>m</sub>)计算动态物体位置姿态，动态物体的位置姿态测量结束，如果max(t<sub>p1</sub>,t<sub>p2</sub>,t<sub>p3</sub>,…t<sub>pm</sub>)‑min(t<sub>p1</sub>,t<sub>p2</sub>,t<sub>p3</sub>,…t<sub>pm</sub>)>T<sub>max</sub>，则转入步骤七，其中，T<sub>max</sub>＝max(T<sub>1</sub>,T<sub>2</sub>,T<sub>3</sub>,…,T<sub>i</sub>)；步骤七、令t<sub>pq</sub>＝max(t<sub>p1</sub>,t<sub>p2</sub>,t<sub>p3</sub>,……t<sub>pm</sub>)，得到t<sub>pq</sub>时刻激光接收器k的修正坐标P"<sub>k</sub>为<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><msup><mi>P</mi><mrow><mo>′</mo><mo>′</mo></mrow></msup><mi>k</mi></msub><mo>,</mo><mo>=</mo><msub><mi>P</mi><mi>k</mi></msub><mo>+</mo><mfrac><mrow><msub><mi>t</mi><mrow><mi>p</mi><mi>q</mi></mrow></msub><mo>-</mo><msub><mi>t</mi><mrow><mi>p</mi><mi>k</mi></mrow></msub></mrow><mrow><msub><msup><mi>t</mi><mo>′</mo></msup><mrow><mi>p</mi><mi>k</mi></mrow></msub><mo>-</mo><msub><mi>t</mi><mrow><mi>p</mi><mi>k</mi></mrow></msub></mrow></mfrac><mo>·</mo><mrow><mo>(</mo><msub><mi>P</mi><mi>k</mi></msub><mo>-</mo><msub><msup><mi>P</mi><mo>′</mo></msup><mi>k</mi></msub><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000798204200000021.GIF" wi="758" he="142" /></maths>其中，P′<sub>k</sub>为激光接收器k上一自转周期的坐标，q＝1,2,3…m，t′<sub>pk</sub>为激光接收器k上一自转周期的坐标P′<sub>k</sub>的时刻；步骤八、根据各个激光接收器坐标P<sub>1</sub>”,P<sub>2</sub>”,P<sub>3</sub>”,…,P<sub>m</sub>”计算动态物体位置姿态。 |
