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