基于UWB方位的機器人間相對定位

摘要： 相對定位是實現(xiàn)多機器人編隊、探索救援等協(xié)作任務(wù)的前提。針對衛(wèi)星信號受阻、未知無基礎(chǔ)設(shè)施環(huán)境中機器人間的相對定位問題，提出一種基于超寬帶(ultra-wideband, UWB)方位的相對定位方法。利用滑動窗口截取一段時間內(nèi)機器人間觀測方位和運動軌跡，構(gòu)建方位代價函數(shù)，通過最小化代價函數(shù)估計機器人間的相對位姿。然而，函數(shù)的非凸性導(dǎo)致傳統(tǒng)優(yōu)化算法陷入局部最優(yōu)解，因此，采用麻雀搜索算...