四旋翼无人飞行器的室内定位、导航与建图.pdf

《四旋翼无人飞行器的室内定位、导航与建图.pdf》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、2014୍۽ॢफݚӱ࿐ჽ࿐Б201429ज4௹JournalofNavalAeronauticalandAstronauticalUniversityVol.29No.4໓ᅣщğ1673-1522č2014Ď04-0345-06DOI:10.7682/j.issn.1673-1522.2014.04.010ඹ࿈ၴ໭ದ٦ྛఖ൩ଽק໊aაࡹ๭aaabٚࡹđպდࣉđᅵޣӑđूდčת೶đؒն৘ܵള࣮࿹.bĠ7༢.aჽ࿐ӱ۽ॢफݚ࿵෻264001ĎᅋေğطՖđ؍ཌᆘหაᆘหऌඔࠢҐ၎૭ೡܻࠗݖ๙đห߄ܒࢲ϶࣢ߌଽ൩ऌ۴ࡹ৫ԛ൩ଽߌ࣢หᆘ๭b০Ⴈหᆘൌགྷඹ࿈ၴ໭ದקᇅඔ۱ᆘห؍ࢨ

2、གྷऌ۴ൈ๝đ໊קദሱؓଽ൩ᄝఖྛ٦ෘمđඹ࿈ၴ໭ದ٦ྛఖ٦༯၂໊ᇂൈđᄜՑࡹ৫अ๭đაՎభࡹ৫ಆअ๭ࣉྛವކđൌགྷಆअ๭۷ྍbܱ࡯Սğඹ࿈ၴ໭ದ٦ྛఖĠק໊ĠĠࡹ๭ᇏ๭োٳğV249.122໓ངѓᆽ઒ğAඹ࿈ၴ໭ದمٚൕі๭࣢ߌ1၎एҩܻࠗջེദሱݖ๙ఖྛ٦ࠆ൩ଽໃᆩߌ࣢ᇏए৖ྐ༏đᄹਈൔܒࡹ൩ଽ๭đ๝ൈ০Ⴈ෮ܒࡹ൩ଽ๭ൌགྷק໊đѩႨ෮ඹ࿈ၴ໭ದ٦ྛఖᄝໃᆩߌ࣢ᇏ۽ቔ൮༵ေࢳࠆए৖ྐ༏ა෮ܒࡹ൩ଽ๭ࣉྛbھथק໊໙ีbطק໊໙ีაԷࡹ๭൞ࢌᆮᄝ၂ఏ[4-6]࿹࣮൓Ⴟഈൗࡀ80୍սᇏ௹[1]đଢభၘႵ؟ᇕࢳथՎđᆃࣼ൞๝๭Էࡹაק໊iiSLAM໙ีb໙ีקఖྛ٦ದ໭ၴ࿈

3、ඹཙ႕ࢤᆰࡼྟಒࣚࡹԷ๭ٚ࠹ܙੱۀႿࠎބمٚੱۀ٤ওЇေᇶđمٚቔ۽࿃ުఖྛ٦ದ໭ა໊ࣚb]2-3]ੀᇶູمٚ࠹ܙੱۀႿࠎᇏఃđمߊbЧ໓ᆌ۬ᅅğᇕ3Ⴕေᇶمٚൕі๭࣢ߌభଢᆘหა؍ཌᆘห࣢ߌ߄ܒࢲ϶ଽ൩ؓ๭aбࢠ؟หđᇅקਔࠎႿหᆘ๭ק໊aაหᆘ๭ބຉ௪๭bࡹ๭ٚمbᅅ۬๭൞ႮMoravecބElfesิԛđࡼᆜ۱ߌ࣢၇ौሱദེջܻࠗೡ૭၎đඹ࿈ၴ໭ದ٦ྛఖٳӮ೏ۄ۱նཬཌྷ๝ཬᅅ۬đ۴ऌૄ۱ཬᅅ۬ᇏ൞ିܔࡼ൩ଽߌ࣢ᇏඔऌҐࠢĠᄜ๙مٚ၂ᆃb๭ࡹԷট໾θᅰႵڎمෘҩ࡟ᆘหݖႪ൞ğ①čࡆಃቋཬӰෘمaݗڏэߐaཬѯэߐĎࡼหᆘ๭Էࡹაົ޹ཌྷؓࡥֆĠ②ॖၛޓٚь۴ऌൌაห

4、ᆘཌ؍ิ౼ԛটđ۴ऌหᆘ۱ඔಒק࠽ླ౰ট۷ڿ๭ࣚĠ③๭ଆ྘бࢠࡥֆđࣼ൞აĠ੻Ҧᅰхႋཌྷקᇅ؍ཌᆘหऌ۴ѩđ੻Ҧົඔቆbಌ൞ğ①ໃᆩߌ࣢бࢠն౏๭หᆘაหᆘཌ؍൞ࠫޅ๭ࠎЧቆӮေ෍đ০Ⴈࣚေ౰бࢠۚൈđ๭ົ޹ࡼ߶э٤ӈ଴Ġ②ิ౼ԛหᆘაหᆘཌ؍ॖၛࡼअ๭Էࡹԛᅅ۬߃ٳбࢠ༥ൈđؓԩ৘ఖေ౰٤ӈۚđൌൈটđࢲކၘࣜࡹ৫ఏটಆअ๭ࣉྛหᆘ௄஥đ۴ྟ၂Ϯ҂bऌ௄஥ުࢲۋԮᄛࠏऌ۴൞๭ޅࠫၴ࿈ඹؓགྷൌđྍ۷ྛࣉ๭अಆࡼݔఖҐࠢඔऌđՖᇏิ໭ದݖ๙đჵᆀࠇa؍ཌೂбđᆘหޅࠫའԎ౼๭ܒࢲمෘ๭ࡹაa໊קđ໊קሱఖྛ٦ᆃུࠫೂ๭1෮ൕbޅหᆘট૭ඍߌ࣢bᆃ၂ٚمႪ൞ğ①ྐ༏ਈཬđ

5、ьႿթԥĠ②ൌൈྟбࢠۚđؓԩ৘ఖေ౰္ી初始化自定位ႵପહۚĠ③ॖၛࡼ؟ᇕԮۋఖඔऌವކᄝ၂ఏ特征提取局部地图创建特征匹配൐Ⴈbಌ൞ğ①۲ᇕԮۋఖҐࠢඔऌླေԩ৘避障策略全局地图更新ުҌି၂ఏ൐ႨĠ②҂ൡކ෾گᄖߌ࣢Ġ③ᄝཬ导航点的确定ߌ࣢๭ᇏđ๭ࣚॖି҂ܔb๭1مෘ๭ࡹაa໊קࢲܒ๭ຉ௪๭൞ࡼߌ࣢іൕӮ၂ᅦຉ௪๭đ๭ᇏࢫFig.1Algorithmstructureoflocalization,ؓႋႿߌ࣢ᇏ၂۱หᆘሑ෿đࢫࡗ৵ཌіൕnavigationandmapping2ࢫᆰࢤ൞ཌྷ๙bᆃ၂ٚمႪ൞ğ①бࢠൡ൬۠ರ௹ğ2014-03-20Ġྩ߭ರ௹ğ2014-05

6、-10ࠎࣁཛଢğݓࡅሱಖ॓࿐ࠎࣁሧᇹཛଢč61174031Ďቔᆀࡥࢺğٚࡹč1977-Ďđଳđࢃഽđණൖbc346c۽ॢफݚӱ࿐ჽ࿐Б29जކቓնٓຶਫ਼ܿ߃಩ༀĠ②ྐ༏ਈቋཬđ٤ӈಸYYgrၞթԥĠ③؟ޓႨ൐ၛॖđቋ౰ေఖ৘ԩؓбࢠӮ2k1ඃෆ෬ෘمbಌ൞ğ①๭ࣚቋĠ②ಸၞBX3rԛགྷ༂௄஥౦ঃĠ③ᄝ٤ࢲܒߌ࣢ᇏđᆃᇕٚمޓ4DdkYॖିാིbYrY22rg໓ང[7-8]ҐႨᅅ۬๭ؓࠏఖದࣉྛק໊đ1k-1Aak-1X31gOk-1ෙಖࣚбࢠۚđ֌൞ࣇൡކཬߌ࣢bطЧ໓ᆌؓ3r4X4r൞૫ࠒൡᇏ൩ଽߌ࣢đೂ۬ᅅႨ൐ݔ๭ޓ଴ડቀXrൌൈྟေ౰bXO໓ང[9]ҐႨਔຉ௪๭

7、קྛࣉದఖࠏ׮၍໊ؓ๭2٦ྛൕၩ๭đ֌ھٚمؓႿࢲܒྟޓ఼൩ଽߌ࣢٤ӈಸၞFig.2SchematicdiagramofflyingᄯӮ༂௄஥čႭః൞ཌ؍หᆘĎđ෮ၛቋᇔ࿊ᄴႨܻࠗҩए၎Ґࠢඔऌটࡹ৫ࠫޅหᆘ๭đൌགྷ໭ದ٦ః໊ረٚӱູğྛఖק໊აbxk=xk-1+ΔdkcosγkĠč1Ď2ඹ࿈ၴ໭ದ٦ྛఖሱק໊yk=yk-1+ΔdksinγkĠč2Ďඹ࿈ၴ໭ದ٦ྛఖ൞ᄝ೘ົॢࡗᇏᄎ׮đೂݔླ22iiiiΔdk=(xr,k-xr,k-1)+(yr,k-yr,k-1)Ġč3Ďေ૭ඍఃࣚಒ໊ረđླေႨ(x,y,z)૭ඍః໊ᇂđႨ(ψ,θ,φ)૭ඍఃᄝ೘ົቕ