摘要:針對(duì)室內(nèi)全球?qū)Ш叫l(wèi)星系統(tǒng)(Global navigation satellite system,,GNSS)信號(hào)受遮擋時(shí),農(nóng)用車輛協(xié)同定位精度低,、穩(wěn)定性差,、信號(hào)丟包等問(wèn)題,,本文開(kāi)展面向超寬帶(Ultrawideband,UWB)調(diào)頻技術(shù)的室內(nèi)外農(nóng)用車輛協(xié)同定位算法研究,。首先,,搭建三基站多邊測(cè)距定位模型,實(shí)現(xiàn)主基站絕對(duì)位置標(biāo)定以及輔助基站絕對(duì)位置坐標(biāo)的變換求解,;其次,,提出全質(zhì)心加權(quán)最小二乘的高速雙邊雙向(Weighted least squares high double sided two-way ranging,,WLS-HDS-TWR)農(nóng)機(jī)協(xié)同定位算法,,基于泰勒級(jí)數(shù)展開(kāi)的WLS估計(jì)算法,求解主車位置,。同時(shí),,提出面向室內(nèi)環(huán)境的多狀態(tài)基站組合的UWB定位模塊布設(shè)模式,并驗(yàn)證其可行性,;通過(guò)飛行時(shí)間法(Time of flight,,TOF)獲取主從車距離信息,融合GNSS標(biāo)定位置信息,、主車坐標(biāo)信息以及測(cè)距信息,,實(shí)現(xiàn)主從車協(xié)同定位。最后,,基于Prescan/Simulink搭建聯(lián)合仿真平臺(tái),,驗(yàn)證提出算法的可靠性;通過(guò)農(nóng)用履帶車輛開(kāi)展室內(nèi)及室外協(xié)同定位實(shí)車試驗(yàn),,試驗(yàn)結(jié)果表明:全質(zhì)心WLS-HDS-TWR協(xié)同定位算法可有效解決室內(nèi)GNSS信號(hào)缺失問(wèn)題,,室內(nèi)環(huán)境下,定位精度較HDS-TWR及全質(zhì)心LS-HDS-TWR算法分別提高26.98%和22.03%,,滿足智能農(nóng)機(jī)協(xié)同定位作業(yè)需求,。