基于非線性擴(kuò)張狀態(tài)動(dòng)量觀測器的機(jī)械臂碰撞檢測
控制工程
頁數(shù): 8 2023-01-11
摘要: 針對(duì)機(jī)械臂容易在人機(jī)協(xié)作中發(fā)生碰撞的問題,提出一種基于非線性擴(kuò)張狀態(tài)動(dòng)量觀測器的碰撞檢測方法。首先,通過離線參數(shù)辨識(shí)來識(shí)別未發(fā)生碰撞時(shí)機(jī)械臂的動(dòng)力學(xué)模型;然后,在該動(dòng)力學(xué)模型基礎(chǔ)上,將碰撞外力作為系統(tǒng)狀態(tài)變量,搭建了非線性擴(kuò)張狀態(tài)動(dòng)量觀測器;其次,在線計(jì)算出機(jī)械臂工作過程中的理論力矩,并考慮建模誤差和摩擦力設(shè)定力矩的時(shí)變閾值,當(dāng)實(shí)際力矩超過時(shí)變閾值時(shí)即認(rèn)為發(fā)生碰撞;最后,對(duì)機(jī)械... (共8頁)