全向輪運動平臺分析-資料下載頁
2025-06-25 04:11本頁面
【正文】 θn+1分別為在采樣時間間隔內(nèi)起始點與終點的位姿坐標(biāo)，AB為采樣期間的圓弧軌跡，利用圖中幾何關(guān)系可以得到運動軌跡為圓弧時的推算公式如下：xn+1=xn+L?SR+?SL2?SR?SLsinθn+?SR?SLLsinθnyn+1=ynL?SR+?SL2?SR?SLcosθn+?SR?SLLcosθnθn+1=θn+?SR?SLL 當(dāng)?SR?SL較小時可采用直線模型xn+1=xn+?SR+?SL2cosθn+?SR?SLLyn+1=yn+?SR+?SL2sinθn+?SR?SLLθn+1=θn+?SR?SLL 隨著移動距離的增加，誤差逐漸加大，其誤差的來源主要包括系統(tǒng)誤差和非系統(tǒng)誤差。系統(tǒng)誤差跟實際采用的器件的精度和測量上的誤差等方面產(chǎn)生的；非系統(tǒng)誤差是在移動過程中隨機發(fā)生的誤差，主要包括：測位輪子的打滑、路況等。由于非系統(tǒng)誤差不容易消除，因此，這里將通過實驗的方法來校準(zhǔn)機構(gòu)的安裝精度，減小因系統(tǒng)誤差對定位精度產(chǎn)生較大影響。影響測量誤差的主要參數(shù)是編碼器輸出一個脈沖對應(yīng)輪子運動的距離r和兩個定位輪之間的距離L，r和L精度校正的具體方法和實現(xiàn)步驟如下：編碼器一個脈沖代表定位輪運行的距離r校正方法：使兩個定位輪在室內(nèi)平面上沿著一條 5 米長度的直線運行，編寫軟件程序，對與定位輪同軸相連的兩個自由編碼器的輸出脈沖進行計數(shù)，將該數(shù)值記錄左右自由編碼器輸出脈沖個數(shù)NL和NR，根據(jù)公式r=5000(NL+NR)/2mm求出每次測量計算得到r的值，再取平均值即可。經(jīng)過多次測試實驗結(jié)果列表。定位輪之間的距離L校正方法：在平地上，使測位裝置從某一起始位置出發(fā)，順時針或逆時針旋轉(zhuǎn)n周后再回到該出發(fā)位置，記下在該過程與左右定位輪相連的編碼器輸出的脈沖數(shù)分別為NL，NR，根據(jù)公式L=NLNR*r2πn求出每次測量計算得到 L的值，再取平均值即可。經(jīng)過多次測試兩定位輪之間距離 L校正實驗列表。 參考文獻：[1][M].北京：清華大學(xué)出版社，2005.[2] Y. Kanayama, Y. Kimura, F. Miyazaki, T. Noguchi. A stable tracking control method for anautonomous mobile robot[C]. Proceedings 1990 IEEE International Conference on Robotics andAutomation, Cincinnati, OH, 1990, 384389.[3][D].長沙: 長沙理工大學(xué),2010.[4]于金霞,王璐,[M].北京:電子工業(yè)出版社,2011.[5][D].贛州市: 江西理工大學(xué),2014.[6][D].南京市:東南大學(xué),2014.
數(shù)學(xué)相關(guān)推薦
鄂ICP備17016276號-1