基于力/力矩傳感器的三維力反饋手柄回復(fù)力控制結(jié)構(gòu)及方法
本發(fā)明公開了一種基于力/力矩傳感器的三維力反饋手柄回復(fù)力控制結(jié)構(gòu)及方法,結(jié)構(gòu)包括底板、兩側(cè)固定架、三角板筋、Y軸電機、X軸電機、內(nèi)框、三維力傳感器、拉伸彈簧、Z軸電機、配重機構(gòu)、扭轉(zhuǎn)彈簧、力矩傳感器和手柄把手;方法為:三維力傳感器和力矩傳感器對力反饋手柄三個方向上的回復(fù)力實時檢測;將用戶當前期望的回復(fù)力值與當前手柄各自由度回復(fù)力輸出差值作為PID控制器的輸入;在調(diào)節(jié)過程中,利用各個環(huán)節(jié)對當前的手柄的回復(fù)力輸出迅速調(diào)整;若當前手柄各自由度回復(fù)力輸出值與用戶當前期望的回復(fù)力值一致時,將實現(xiàn)當前手柄各自由度回復(fù)力穩(wěn)定跟蹤輸入。本發(fā)明結(jié)構(gòu)簡單,采用PID調(diào)節(jié)方式實時穩(wěn)定控制手柄的回復(fù)力大小。
東南大學
2021-04-11