重力補(bǔ)償方法及裝置

基本信息

申請(qǐng)?zhí)?/td> CN202011586561.6 申請(qǐng)日 -
公開(kāi)(公告)號(hào) CN112757296A 公開(kāi)(公告)日 2021-05-07
申請(qǐng)公布號(hào) CN112757296A 申請(qǐng)公布日 2021-05-07
分類號(hào) G06F17/15(2006.01)I;B25J18/00(2006.01)I;G06F30/23(2020.01)I;B25J9/16(2006.01)I;G06F17/13(2006.01)I 分類 -
發(fā)明人 辜紀(jì)文;林嘉;辜正濤 申請(qǐng)(專利權(quán))人 江西明天高科技股份有限公司
代理機(jī)構(gòu) 北京清亦華知識(shí)產(chǎn)權(quán)代理事務(wù)所(普通合伙) 代理人 彭琰
地址 330000江西省南昌市紅谷灘新區(qū)紅谷中大道1568號(hào)紅谷凱旋商業(yè)辦公綜合樓及商業(yè)六806室(第8層)
法律狀態(tài) -

摘要

摘要 一種力反饋機(jī)械臂的重力補(bǔ)償方法及裝置,該重力補(bǔ)償方法包括:實(shí)時(shí)獲取所述每個(gè)旋轉(zhuǎn)電機(jī)中電機(jī)編碼器的輸出值,并根據(jù)旋轉(zhuǎn)電機(jī)中編碼器的當(dāng)前輸出值確定對(duì)應(yīng)的當(dāng)前轉(zhuǎn)角;根據(jù)每個(gè)旋轉(zhuǎn)電機(jī)的當(dāng)前轉(zhuǎn)角計(jì)算與其輸出軸連接的連桿與水平方向的當(dāng)前夾角;獲取每個(gè)連桿的長(zhǎng)度和重量,以及每個(gè)連桿的重心到其基部轉(zhuǎn)軸的距離,并根據(jù)每個(gè)連桿的當(dāng)前夾角、每個(gè)連桿的長(zhǎng)度和每個(gè)連桿的重量,以及每個(gè)連桿的重心到其基部轉(zhuǎn)軸的距離計(jì)算各個(gè)旋轉(zhuǎn)電機(jī)的重力補(bǔ)償力矩;將各個(gè)補(bǔ)償力矩分別發(fā)送至對(duì)應(yīng)的旋轉(zhuǎn)電機(jī),以使各個(gè)旋轉(zhuǎn)電機(jī)根據(jù)接收到的補(bǔ)償力矩進(jìn)行輸出力矩補(bǔ)償。??