发明名称 无线车联物联网定位系统
摘要 本发明涉及无线车联物联网定位系统,包括若干车辆和若干在路边的路灯,各路灯均包括微处理器、第一LTE通信模块、存储路灯地理位置的存储器、信号调制器、第一扩频码发生器、扩频调制器、第一光电信号转换器和LED光源;LED光源均匀设置若干独立编号的方形LED发光晶格;LED发光晶格内均设黑光LED、蓝光LED、绿光LED和红光LED;各车辆设处理器、蓝牙模块、第二LTE通信模块、GPS定位模块、定位信号标识生成器、光信号强度检测器、光信号接收器、滤噪器、信号比较器、第二光电信号转换器、扩频解调器、第二扩频码发生器、信号解调器、摄像头和显示屏。该系统能借助路灯光信号和附近车辆定位数据,获取车辆位置。
申请公布号 CN105246040A 申请公布日期 2016.01.13
申请号 CN201510689244.X 申请日期 2015.10.21
申请人 宁波大学 发明人 郑紫微;郭建广
分类号 H04W4/02(2009.01)I;H04W64/00(2009.01)I;H04B10/116(2013.01)I;G01S19/45(2010.01)I 主分类号 H04W4/02(2009.01)I
代理机构 宁波诚源专利事务所有限公司 33102 代理人 刘凤钦
主权项 无线车联物联网定位系统,其特征在于,包括若干车辆以及若干设置在路边的路灯,其中:所述各路灯均包括微处理器以及分别连接微处理器的第一LTE通信模块、存储路灯地理位置数据的存储器、信号调制器、第一扩频码发生器、扩频调制器、第一光电信号转换器、LED光源、蓄电模块、光电转换器和太阳能电池;第一LTE通信模块与外网连接;第一扩频码发生器分别连接信号调制器和扩频调制器,扩频调制器连接第一光电信号转换器;LED光源上均匀地设置若干具有独立编号的方形LED发光晶格;每个LED发光晶格内均设置有黑光LED、蓝光LED、绿光LED和红光LED,黑光LED、蓝光LED、绿光LED和红光LED分别连接微处理器;蓄电模块连接光电转换器,LED光源分别连接蓄电模块和太阳能电池;其中,所述微处理器,读取存储器内保存的路灯地理位置数据,并将路灯地理位置数据分别转换为光信息和多维彩码信息,并命令LED发光晶格执行发光;所述信号调制器,用以将路灯地理位置数据进行信号调制,得到包含路灯地理位置信息的调制信号;所述第一扩频码发生器,用以产生扩频码序列,并发送扩频码序列给扩频调制器;所述扩频调制器,接收扩频码,以扩展包含路灯地理位置信息的调制信号频谱,得到扩频调制信号;所述第一光电信号转换器,根据微处理器的调制命令,将扩频调制信号由电信号转换为光信号;所述LED光源,在路灯地理位置数据转换为多维彩码信息后,根据微处理器分别对黑光LED、蓝光LED、绿光LED和红光LED发光或闭光命令,发出由不同颜色组成的多维彩码图像;所述各车辆上设置有中央处理器以及分别连接中央处理器的蓝牙模块、第二LTE通信模块、GPS定位模块、定位信号标识生成器、光信号强度检测器、光信号接收器、滤噪器、信号比较器、第二光电信号转换器、扩频解调器、第二扩频码发生器、信号解调器、摄像头和显示屏;光信号接收器连接滤噪器,信号比较器连接滤噪器和第二光电信号转换器,扩频解调器分别连接第二光电信号转换器、第二扩频码发生器和信号解调器;GPS定位模块分别连接第二LTE通信模块和显示屏;显示屏连接摄像头;其中,所述蓝牙模块,用以在车辆与附近车辆之间建立通信,实现各车辆之间含有GPS定位数据以及GPS定位信号标识的相互传递;所述GPS定位模块,获取车辆的当前GPS位置数据和GPS信号强度,并发送获取的GPS位置数据和GPS信号强度值给中央处理器;所述定位信号标识生成器,用以产生具有车辆ID信息的GPS定位信号标识,并发送该GPS信号标识给中央处理器;所述光信号接收器,接收路灯发出的光信号,并发送给滤噪器处理;所述光信号强度检测器,用以分别检测附近各路灯发送来的光信号强度值,并发送给中央处理器;所述滤噪器,根据中央处理器的命令,对接收的光信号滤噪,然后发送给信号比较器作出判断:当光信号强度超过预设阈值时,则将判断结果发送给第二光电信号转换器启动光电转换;所述第二光电信号转换器,将接收的光信号转换为含有路灯地理位置的电信号,并发送给中央处理器;所述摄像头,读取路灯发出的多维彩码图像,并由中央处理器提取多维彩码图像中的路灯地理位置信息;所述中央处理器,根据接收的GPS定位信号标识、GPS位置数据、GPS信号强度值以及第二光电信号转换器发送的电信号进行融合计算,以获取车辆当前的定位数据;其中,中央处理器获取车辆当前的定位数据的过程依次包括如下步骤:(1)设待定位车辆独立获取的GPS定位数据为(x<sub>GPS</sub>,y<sub>GPS</sub>,z<sub>GPS</sub>),GPS信号强度值为p<sub>GPS</sub>,GPS信号强度预设阈值为p<sub>GPS_door</sub>;获取的附近车辆的GPS定位信号标识为<img file="FDA0000826772400000021.GIF" wi="142" he="79" />附近车辆h的GPS定位数据为(x'<sub>GPS</sub>,y'<sub>GPS</sub>,z'<sub>GPS</sub>);各路灯分别为L<sub>1</sub>、L<sub>2</sub>、L<sub>3</sub>、L<sub>4</sub>、...、L<sub>N</sub>,L<sub>1</sub>、L<sub>2</sub>、L<sub>3</sub>、L<sub>4</sub>、...、L<sub>N</sub>的坐标分别为(x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>)、(x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>)、(x<sub>3</sub>,y<sub>3</sub>,z<sub>3</sub>)、(x<sub>4</sub>,y<sub>4</sub>,z<sub>4</sub>)、...、(x<sub>N</sub>,y<sub>N</sub>,z<sub>N</sub>),在时间段T内接收到的光信号强度值分别为p<sub>11</sub>,p<sub>12</sub>,p<sub>13</sub>,...,p<sub>1M</sub>;p<sub>21</sub>,p<sub>22</sub>,p<sub>23</sub>,...,p<sub>2M</sub>;p<sub>31</sub>,p<sub>32</sub>,p<sub>33</sub>,...,p<sub>3M</sub>;...;p<sub>N1</sub>,p<sub>N2</sub>,p<sub>N3</sub>,...,p<sub>NM</sub>;待定位车辆的最终定位数据为(x<sub>R</sub>,y<sub>R</sub>,z<sub>R</sub>),N≥4,M≥1,且M∈N<sup>+</sup>;(2)当获取到GPS定位信号标识<img file="FDA0000826772400000022.GIF" wi="114" he="79" />时,则以附近车辆h的GPS定位数据(x'<sub>GPS</sub>,y'<sub>GPS</sub>,z'<sub>GPS</sub>)为待定位车辆的初始定位数据,并执行步骤(3);否则,直接执行步骤(4);(3)当GPS信号强度值p<sub>GPS</sub>高于GPS信号强度预设阈值p<sub>GPS_door</sub>时,则以获取的GPS定位数据(x<sub>GPS</sub>,y<sub>GPS</sub>,z<sub>GPS</sub>)为待定位车辆最终的定位数据;否则,执行步骤(4);(4)根据在时间段T内接收到的各路灯的光信号强度值,计算每个路灯发出的光信号强度值的信号强度均方根值p<sub>i</sub>:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>p</mi><mi>i</mi></msub><mo>=</mo><msqrt><mrow><mfrac><mn>1</mn><mi>M</mi></mfrac><munderover><mo>&Sigma;</mo><mrow><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mi>M</mi></munderover><msub><msup><mi>p</mi><mn>2</mn></msup><mrow><mi>i</mi><mi>j</mi></mrow></msub></mrow></msqrt><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><mi>N</mi><mo>;</mo></mrow>]]></math><img file="FDA0000826772400000031.GIF" wi="701" he="159" /></maths>   式(1)其中,p<sub>i</sub>表示路灯L<sub>i</sub>发出的光信号强度值的均方根值,p<sub>ij</sub>表示路灯L<sub>i</sub>发出的某一个光信号强度值;(5)根据接收到的各路灯的光信号强度均方根值的降序序列p<sub>1</sub>、p<sub>2</sub>、p<sub>3</sub>、p<sub>4</sub>、...、p<sub>N</sub>,选取光信号强度均方根值大小位于前四位的值p<sub>1</sub>、p<sub>2</sub>、p<sub>3</sub>和p<sub>4</sub>;(6)根据接收的各路灯的光信号强度均方根值p<sub>1</sub>、p<sub>2</sub>、p<sub>3</sub>和p<sub>4</sub>,分别获取路灯L<sub>1</sub>、L<sub>2</sub>、L<sub>3</sub>和L<sub>4</sub>到待定位车辆的距离d<sub>1</sub>、d<sub>2</sub>、d<sub>3</sub>和d<sub>4</sub>:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>p</mi><mi>i</mi></msub><mo>=</mo><msub><mi>p</mi><mn>0</mn></msub><mo>+</mo><mn>10</mn><mi>n</mi><mi> </mi><msub><mi>log</mi><mn>10</mn></msub><mo>&lsqb;</mo><mfrac><mrow><msub><mi>d</mi><mi>i</mi></msub><mo>+</mo><mi>&delta;</mi></mrow><msub><mi>d</mi><mn>0</mn></msub></mfrac><mo>&rsqb;</mo><mo>+</mo><mi>&xi;</mi><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>,</mo><mn>4</mn><mo>;</mo></mrow>]]></math><img file="FDA0000826772400000032.GIF" wi="910" he="142" /></maths>   式(2)<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>d</mi><mi>i</mi></msub><mo>=</mo><msub><mi>d</mi><mn>0</mn></msub><msup><mn>10</mn><mfrac><mrow><msub><mi>p</mi><mi>i</mi></msub><mo>-</mo><msub><mi>p</mi><mn>0</mn></msub><mo>-</mo><mi>&xi;</mi></mrow><mrow><mn>10</mn><mi>n</mi></mrow></mfrac></msup><mo>-</mo><mi>&delta;</mi><mo>;</mo></mrow>]]></math><img file="FDA0000826772400000033.GIF" wi="438" he="111" /></maths>   式(3)其中,p<sub>i</sub>为路灯L<sub>i</sub>发出的光信号强度均方根值,n是路径损耗指数,ξ为满足高斯分布的随机数,d<sub>i</sub>为路灯L<sub>i</sub>到待定位车辆的距离,d<sub>0</sub>为参考距离,p<sub>0</sub>为距离待定位车辆d<sub>0</sub>处的光信号强度值,δ为距离估计误差,且<img file="FDA0000826772400000034.GIF" wi="486" he="141" />(7)根据路灯L<sub>1</sub>、L<sub>2</sub>、L<sub>3</sub>和L<sub>4</sub>的坐标(x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>)、(x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>)、(x<sub>3</sub>,y<sub>3</sub>,z<sub>3</sub>)和(x<sub>4</sub>,y<sub>4</sub>,z<sub>4</sub>),以及获取的距离d<sub>1</sub>、d<sub>2</sub>、d<sub>3</sub>和d<sub>4</sub>,计算待定位车辆最终的定位数据(x,y,z):(7‑1)以三个为一组,对路灯L<sub>1</sub>、L<sub>2</sub>、L<sub>3</sub>和L<sub>4</sub>进行分组,获得四组路灯组合:L<sub>1</sub>(x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>)、L<sub>2</sub>(x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>)和L<sub>3</sub>(x<sub>3</sub>,y<sub>3</sub>,z<sub>3</sub>),L<sub>1</sub>(x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>)、L<sub>2</sub>(x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>)和L<sub>4</sub>(x<sub>4</sub>,y<sub>4</sub>,z<sub>4</sub>),L<sub>1</sub>(x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>)、L<sub>3</sub>(x<sub>3</sub>,y<sub>3</sub>,z<sub>3</sub>)和L<sub>4</sub>(x<sub>4</sub>,y<sub>4</sub>,z<sub>4</sub>),L<sub>2</sub>(x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>)、L<sub>3</sub>(x<sub>3</sub>,y<sub>3</sub>,z<sub>3</sub>)和L<sub>4</sub>(x<sub>4</sub>,y<sub>4</sub>,z<sub>4</sub>);(7‑2)根据路灯L<sub>1</sub>、L<sub>2</sub>、L<sub>3</sub>和L<sub>4</sub>的坐标(x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>)、(x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>)、(x<sub>3</sub>,y<sub>3</sub>,z<sub>3</sub>)、(x<sub>4</sub>,y<sub>4</sub>,z<sub>4</sub>)及距离d<sub>1</sub>、d<sub>2</sub>、d<sub>3</sub>和d<sub>4</sub>,分别计算待定位车辆的第一坐标(x',y',z')、第二坐标(x”,y”,z”)、第三坐标(x”',y”',z”')和第四坐标(x””,y””,z””)以及各距离对应的权重系数ω<sub>1</sub>、ω<sub>2</sub>、ω<sub>3</sub>和ω<sub>4</sub>,其中,<maths num="0004" id="cmaths0004"><math><![CDATA[<mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msup><mi>x</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msup><mi>y</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>1</mn></msub><mo>-</mo><msup><mi>z</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>2</mn></msub><mo>-</mo><msup><mi>x</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>2</mn></msub><mo>-</mo><msup><mi>y</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>2</mn></msub><mo>-</mo><msup><mi>z</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>3</mn></msub><mo>-</mo><msup><mi>x</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>3</mn></msub><mo>-</mo><msup><mi>y</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>3</mn></msub><mo>-</mo><msup><mi>z</mi><mo>&prime;</mo></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000041.GIF" wi="766" he="255" /></maths>   式(4)<maths num="0005" id="cmaths0005"><math><![CDATA[<mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>1</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>2</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>2</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>2</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>4</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>4</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>4</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000042.GIF" wi="773" he="253" /></maths>   式(5)<maths num="0006" id="cmaths0006"><math><![CDATA[<mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>1</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>3</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>3</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>3</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>4</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>4</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>4</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000043.GIF" wi="790" he="255" /></maths>   式(6)<maths num="0007" id="cmaths0007"><math><![CDATA[<mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>2</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>2</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>2</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>3</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>3</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>3</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mn>4</mn></msub><mo>-</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mn>4</mn></msub><mo>-</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mn>4</mn></msub><mo>-</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mo>)</mo></mrow><mn>2</mn></msup><mo>=</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000044.GIF" wi="803" he="251" /></maths>   式(7)<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msub><mi>&epsiv;</mi><mi>i</mi></msub><mo>=</mo><mfrac><msubsup><mi>d</mi><mrow><mn>5</mn><mo>-</mo><mi>i</mi></mrow><mn>2</mn></msubsup><mrow><munderover><mo>&Sigma;</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mn>4</mn></munderover><msubsup><mi>d</mi><mi>i</mi><mn>2</mn></msubsup></mrow></mfrac><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>3</mn><mo>,</mo><mn>4</mn><mo>;</mo></mrow>]]></math><img file="FDA0000826772400000045.GIF" wi="542" he="206" /></maths>   式(8)(7‑3)根据分别获取的待定位车辆的第一坐标(x',y',z')、第二坐标(x”,y”,z”)、第三坐标(x”',y”',z”')和第四坐标(x””,y””,z””)、以及各距离对应的权重系数,计算待定位车辆的参考坐标(x,y,z);其中,<maths num="0009" id="cmaths0009"><math><![CDATA[<mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><mi>x</mi><mo>=</mo><mfrac><mrow><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>x</mi><mo>&prime;</mo></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac></mrow></mtd></mtr><mtr><mtd><mrow><mi>y</mi><mo>=</mo><mfrac><mrow><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>y</mi><mo>&prime;</mo></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac></mrow></mtd></mtr><mtr><mtd><mrow><mi>z</mi><mo>=</mo><mfrac><mrow><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>z</mi><mo>&prime;</mo></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac><mo>+</mo><mfrac><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>&CenterDot;</mo><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup></mrow><mrow><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>3</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>d</mi><mn>4</mn><mn>2</mn></msubsup></mrow></mfrac></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000046.GIF" wi="1650" he="462" /></maths>   式(9);(7‑4)根据计算的待定位车辆的第一坐标(x',y',z')、第二坐标(x”,y”,z”)、第三坐标(x”',y”',z”')和第四坐标(x””,y””,z””)以及计算获取的待定位车辆的参考坐标(x,y,z),计算待定位车辆的最终定位数据(x<sub>R</sub>,y<sub>R</sub>,z<sub>R</sub>)的定位误差(△x,△y,△z):<maths num="0010" id="cmaths0010"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><msup><mi>x</mi><mo>&prime;</mo></msup><mo>-</mo><mi>x</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>x</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>x</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>x</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>x</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>x</mi><mn>3</mn></msub></mtd></mtr><mtr><mtd><msup><mi>x</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>x</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>x</mi><mn>4</mn></msub></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000051.GIF" wi="281" he="311" /></maths>   式(10)<maths num="0011" id="cmaths0011"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><msup><mi>y</mi><mo>&prime;</mo></msup><mo>-</mo><mi>y</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>y</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>y</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>y</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>y</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>y</mi><mn>3</mn></msub></mtd></mtr><mtr><mtd><msup><mi>y</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>y</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>y</mi><mn>4</mn></msub></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000052.GIF" wi="292" he="311" /></maths>   式(11)<maths num="0012" id="cmaths0012"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><msup><mi>z</mi><mo>&prime;</mo></msup><mo>-</mo><mi>z</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>z</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>z</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>z</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>z</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>z</mi><mn>3</mn></msub></mtd></mtr><mtr><mtd><msup><mi>z</mi><mrow><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo><mo>&prime;</mo></mrow></msup><mo>-</mo><mi>z</mi><mo>=</mo><mi>&Delta;</mi><msub><mi>z</mi><mn>4</mn></msub></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000053.GIF" wi="277" he="309" /></maths>   式(12)<maths num="0013" id="cmaths0013"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mi>&Delta;</mi><mi>x</mi><mo>=</mo><mfrac><mrow><msub><mi>&Delta;x</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&Delta;x</mi><mn>2</mn></msub><mo>+</mo><msub><mi>&Delta;x</mi><mn>3</mn></msub><mo>+</mo><msub><mi>&Delta;x</mi><mn>4</mn></msub></mrow><mn>4</mn></mfrac></mtd></mtr><mtr><mtd><mi>&Delta;</mi><mi>y</mi><mo>=</mo><mfrac><mrow><msub><mi>&Delta;y</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&Delta;y</mi><mn>2</mn></msub><mo>+</mo><msub><mi>&Delta;y</mi><mn>3</mn></msub><mo>+</mo><msub><mi>&Delta;y</mi><mn>4</mn></msub></mrow><mn>4</mn></mfrac></mtd></mtr><mtr><mtd><mi>&Delta;</mi><mi>z</mi><mo>=</mo><mfrac><mrow><msub><mi>&Delta;z</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&Delta;z</mi><mn>2</mn></msub><mo>+</mo><msub><mi>&Delta;z</mi><mn>3</mn></msub><mo>+</mo><msub><mi>&Delta;z</mi><mn>4</mn></msub></mrow><mn>4</mn></mfrac></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000054.GIF" wi="574" he="415" /></maths>   式(13)(7‑5)根据计算获取的待定位车辆的参考坐标(x,y,z)以及定位误差(Δx,Δy,Δz),计算待定位车辆的最终定位数据(x<sub>R</sub>,y<sub>R</sub>,z<sub>R</sub>):<maths num="0014" id="cmaths0014"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><msub><mi>x</mi><mi>R</mi></msub><mo>=</mo><mi>x</mi><mo>+</mo><mi>&Delta;</mi><mi>x</mi></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>R</mi></msub><mo>=</mo><mi>y</mi><mo>+</mo><mi>&Delta;</mi><mi>y</mi></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>R</mi></msub><mo>=</mo><mi>z</mi><mo>+</mo><mi>&Delta;</mi><mi>z</mi></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000826772400000055.GIF" wi="253" he="231" /></maths>   式(14)。
地址 315211 浙江省宁波市江北区风华路818号