发明名称 一种移动蜂窝网与卫星导航系统联合卫星信号盲区定位方法
摘要 本发明属于电子通信与自动控制领域,涉及到一种移动蜂窝网与卫星导航系统联合实现卫星信号盲区内接收机定位方法。该定位方法中,接收机利用基站转发的卫星信号将首先分别采用两种不同的方法独立计算位置坐标:一种方法是接收机基于前一时刻的定位结果推导下一时刻位置坐标;另一种方法是接收机利用卫星信号测量基站到接收机的伪距,再利用三角定位原理计算位置。然后,接收机将由两种方法获取的定位结果联合起来作为观测值,利用卡尔曼滤波算法对结果进行滤波以确定最终用户位置坐标。本发明在实际应用时布署成本低且安装容易,并可获得较高定位精度。
申请公布号 CN106054226A 申请公布日期 2016.10.26
申请号 CN201610663098.8 申请日期 2016.08.12
申请人 大连理工大学 发明人 李秀魁
分类号 G01S19/46(2010.01)I 主分类号 G01S19/46(2010.01)I
代理机构 大连理工大学专利中心 21200 代理人 梅洪玉
主权项 一种移动蜂窝网与卫星导航系统联合卫星信号盲区定位方法,包括以下步骤:步骤一:采用二种定位方法进行定位第一种定位方法:首先,消除信号转发处理时间误差;记在时间t<sub>k</sub>接收机测得的信号从卫星s<sub>i</sub>经基站b<sub>j</sub>转发到接收机所经历的时间为<img file="FDA0001077371950000011.GIF" wi="163" he="78" />则<maths num="0001"><math><![CDATA[<mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mi>j</mi></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>,</mo><mi>i</mi><mo>,</mo><mi>j</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>,</mo><mn>4</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000012.GIF" wi="1566" he="79" /></maths>其中,<img file="FDA0001077371950000013.GIF" wi="102" he="79" />是信号从卫星s<sub>i</sub>到基站b<sub>j</sub>的时间;<img file="FDA0001077371950000014.GIF" wi="94" he="79" />是信号从基站b<sub>j</sub>到接收机的时间;δt<sub>c</sub>是接收机钟差;<img file="FDA0001077371950000015.GIF" wi="126" he="79" />是信号从卫星s<sub>i</sub>到基站b<sub>j</sub>再到接收机所经历的传播误差;<img file="FDA0001077371950000016.GIF" wi="69" he="71" />是信号从到达基站天线经基站处理后再从基站天线发射出去所经历的时间;<img file="FDA0001077371950000017.GIF" wi="99" he="79" />代表其它测量误差;将来自同一卫星且经同一基站转发到接收机但在不同时刻测量的信号传播时间进行差分操作,得到:<maths num="0002"><math><![CDATA[<mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mi>j</mi></msub><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mi>j</mi></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>,</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000018.GIF" wi="1534" he="79" /></maths>其中,接收机钟差δt<sub>c</sub>将被消除掉;<img file="FDA0001077371950000019.GIF" wi="918" he="79" /><img file="FDA00010773719500000110.GIF" wi="1446" he="79" />t<sub>0</sub>与t<sub>1</sub>之间间隔小于等于1秒,<img file="FDA00010773719500000111.GIF" wi="126" he="75" />和<img file="FDA00010773719500000112.GIF" wi="122" he="79" />考虑为零;接收机在对卫星数据进行解码后获得卫星坐标;接收机在接入基站时通过信令获得基站的坐标信息,<img file="FDA00010773719500000113.GIF" wi="128" he="78" />通过卫星和基站坐标计算获取;接收机分别对不同基站转发的信号在前后连续两个时刻(t<sub>0</sub>和t<sub>1</sub>)测量的传播时间进行差分操作,即<maths num="0003"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>,</mo><msub><mi>t</mi><mn>1</mn></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000114.GIF" wi="1334" he="231" /></maths>让<img file="FDA00010773719500000115.GIF" wi="990" he="79" /><img file="FDA00010773719500000116.GIF" wi="129" he="79" />表示为<img file="FDA00010773719500000117.GIF" wi="473" he="96" />其中<img file="FDA00010773719500000118.GIF" wi="539" he="77" />即在时刻t<sub>i</sub>用户的坐标;<img file="FDA00010773719500000119.GIF" wi="363" he="79" />为基站b<sub>j</sub>(j=1,2,3)的坐标,而<img file="FDA00010773719500000120.GIF" wi="1090" he="96" />代表在时刻t<sub>i</sub>从基站b<sub>j</sub>到用户接收机之间的距离;公式(3)进一步表示为:<maths num="0004"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>=</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>1</mn></msub></msub><mo>|</mo><mo>|</mo><mo>-</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>1</mn></msub></msub><mo>|</mo><mo>|</mo><mo>+</mo><msub><mi>&rho;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>e</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>l</mi><mn>2</mn></msub><mo>=</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>2</mn></msub></msub><mo>|</mo><mo>|</mo><mo>-</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>2</mn></msub></msub><mo>|</mo><mo>|</mo><mo>+</mo><msub><mi>&rho;</mi><mn>2</mn></msub><mo>+</mo><msub><mi>e</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>l</mi><mn>3</mn></msub><mo>=</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>3</mn></msub></msub><mo>|</mo><mo>|</mo><mo>-</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>3</mn></msub></msub><mo>|</mo><mo>|</mo><mo>+</mo><msub><mi>&rho;</mi><mn>3</mn></msub><mo>+</mo><msub><mi>e</mi><mn>3</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000121.GIF" wi="1254" he="254" /></maths>公式(4)进一步整理为:<maths num="0005"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>1</mn></msub></msub><mo>|</mo><mo>|</mo><mo>=</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>1</mn></msub></msub><mo>|</mo><mo>|</mo><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&rho;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>e</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>2</mn></msub></msub><mo>|</mo><mo>|</mo><mo>=</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>2</mn></msub></msub><mo>|</mo><mo>|</mo><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>+</mo><msub><mi>&rho;</mi><mn>2</mn></msub><mo>+</mo><msub><mi>e</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>3</mn></msub></msub><mo>|</mo><mo>|</mo><mo>=</mo><mo>|</mo><mo>|</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>-</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mn>3</mn></msub></msub><mo>|</mo><mo>|</mo><mo>-</mo><msub><mi>l</mi><mn>3</mn></msub><mo>+</mo><msub><mi>&rho;</mi><mn>3</mn></msub><mo>+</mo><msub><mi>e</mi><mn>3</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000021.GIF" wi="1254" he="255" /></maths>如果用户接收机在时刻t<sub>0</sub>时的位置已知,则根据公式(5),计算得出接收机在时刻t<sub>1</sub>时的位置;计算得出的用户位置为<maths num="0006"><math><![CDATA[<mrow><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>=</mo><mi>f</mi><mrow><mo>(</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mn>0</mn></mrow></msub><mo>,</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mi>i</mi></msub></msub><mo>,</mo><msub><mi>&rho;</mi><mi>i</mi></msub><mo>,</mo><msub><mi>l</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000022.GIF" wi="1182" he="71" /></maths>第二种定位方法:当用户接收机接收到来自基站的转发信号后,其利用该信号测量从卫星经基站转发到用户信号所经历的时间<img file="FDA0001077371950000023.GIF" wi="168" he="69" />在时刻t<sub>k</sub>测得的时间<img file="FDA0001077371950000024.GIF" wi="139" he="78" />将如公式(1)所示;来自同一颗卫星的信号通过不同的基站转发,其到达用户接收机所需的时间将不同;假设同一卫星(s<sub>1</sub>)信号经四个基站b<sub>j</sub>(j=1,2,3,4)转发,则有<maths num="0007"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>1</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>2</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>3</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>4</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>4</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>4</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000025.GIF" wi="1428" he="307" /></maths>让<img file="FDA0001077371950000026.GIF" wi="714" he="79" /><img file="FDA0001077371950000027.GIF" wi="139" he="78" />为测量值,而<img file="FDA0001077371950000028.GIF" wi="99" he="78" />是信号从卫星s<sub>1</sub>到基站b<sub>j</sub>传播所需时间,通过卫星s<sub>1</sub>和基站b<sub>j</sub>的坐标计算得出;<img file="FDA0001077371950000029.GIF" wi="362" he="79" />表示如下:<maths num="0008"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>1</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>1</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>2</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>2</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>3</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>3</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;</mi><mrow><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msub><mi>&delta;t</mi><mi>c</mi></msub><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>s</mi><mn>1</mn></msub><mo>,</mo><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><msub><mi>b</mi><mn>4</mn></msub><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>+</mo><msubsup><mi>&delta;t</mi><mrow><mi>m</mi><mo>,</mo><msub><mi>b</mi><mn>4</mn></msub></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000210.GIF" wi="1350" he="310" /></maths>基站b<sub>j</sub>(j=1,2,3,4)相距近,接收机同时收到来自这四个基站的转发信号;<img file="FDA00010773719500000211.GIF" wi="374" he="78" />认为是相等;每个基站的卫星信号转发处理时间<img file="FDA00010773719500000212.GIF" wi="336" he="78" />假设相等;根据公式(8),进一步获得:<maths num="0009"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>3</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&Delta;T</mi><mrow><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>=</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup><mo>-</mo><msubsup><mi>&delta;t</mi><mrow><msub><mi>b</mi><mn>4</mn></msub><mo>,</mo><mi>u</mi></mrow><mrow><mo>(</mo><msub><mi>t</mi><mi>k</mi></msub><mo>)</mo></mrow></msubsup></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000213.GIF" wi="1206" he="231" /></maths>让<img file="FDA00010773719500000214.GIF" wi="1459" he="79" />其中<img file="FDA00010773719500000215.GIF" wi="74" he="69" />为时刻t<sub>k</sub>用户接收机的坐标;<img file="FDA00010773719500000216.GIF" wi="54" he="70" />为基站b<sub>j</sub>的坐标;公式(9)写成:<img file="FDA0001077371950000031.GIF" wi="1158" he="254" />根据公式(10),计算获得用户位置坐标<img file="FDA0001077371950000032.GIF" wi="267" he="71" />的闭式解,记计算得出的用户位置为<maths num="0010"><math><![CDATA[<mrow><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mi>u</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><mi>g</mi><mrow><mo>(</mo><msub><mover><mi>x</mi><mo>&RightArrow;</mo></mover><msub><mi>b</mi><mi>i</mi></msub></msub><mo>,</mo><msub><mi>&xi;</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000033.GIF" wi="1118" he="70" /></maths>第二步:用卡尔曼滤波器将两种定位结果融合设卡尔曼滤波器的状态转移矩阵为单位阵,状态转移模型为:<maths num="0011"><math><![CDATA[<mrow><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mover><mi>w</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000034.GIF" wi="1150" he="62" /></maths>其中<img file="FDA0001077371950000035.GIF" wi="95" he="55" />代表在第k个测量时刻的用户位置坐标,而<img file="FDA0001077371950000036.GIF" wi="99" he="55" />为过程噪声向量;通过第一种定位方法和第二种定位方法测得的定位结果联合起来作为卡尔曼滤波器的观测值,也即<maths num="0012"><math><![CDATA[<mrow><mover><mi>y</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mover><mo>=</mo><mi>&Delta;</mi></mover><mo>&lsqb;</mo><msubsup><mover><mi>y</mi><mo>&RightArrow;</mo></mover><mn>1</mn><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo><msubsup><mover><mi>y</mi><mo>&RightArrow;</mo></mover><mn>2</mn><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001077371950000037.GIF" wi="1088" he="88" /></maths>其中<img file="FDA0001077371950000038.GIF" wi="292" he="63" />而<img file="FDA0001077371950000039.GIF" wi="291" he="63" />观测值与状态值之间的关系矩阵H(k)定义为:<maths num="0013"><math><![CDATA[<mrow><mi>H</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mover><mo>=</mo><mi>&Delta;</mi></mover><mo>&lsqb;</mo><msubsup><mi>H</mi><mn>1</mn><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo><msubsup><mi>H</mi><mn>2</mn><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000310.GIF" wi="1110" he="95" /></maths><img file="FDA00010773719500000311.GIF" wi="139" he="63" />和<img file="FDA00010773719500000312.GIF" wi="139" he="62" />定义为单位阵;相应的测量噪声矩阵定义为:<maths num="0014"><math><![CDATA[<mrow><mi>v</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mover><mo>=</mo><mi>&Delta;</mi></mover><mo>&lsqb;</mo><msubsup><mi>v</mi><mn>1</mn><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo><msubsup><mi>v</mi><mn>2</mn><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>15</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000313.GIF" wi="1071" he="94" /></maths>其中,v<sub>1</sub>(k)和v<sub>2</sub>(k)分别为对应测量值<img file="FDA00010773719500000314.GIF" wi="118" he="62" />和<img file="FDA00010773719500000315.GIF" wi="120" he="63" />的测量误差与噪声。观测模型为<maths num="0015"><math><![CDATA[<mrow><mover><mi>y</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>H</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mover><mi>x</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><mi>v</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>16</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010773719500000316.GIF" wi="1118" he="63" /></maths>利用标准卡尔曼滤波算法进行滤波,得出最终用户位置坐标。
地址 116024 辽宁省大连市凌工路2号