基于自適應(yīng)力反饋的血管介入機器人系統(tǒng)主端控制方法
基本信息
申請?zhí)?/td> | CN202210361274.8 | 申請日 | - |
公開(公告)號 | CN114442490A | 公開(公告)日 | 2022-06-24 |
申請公布號 | CN114442490A | 申請公布日 | 2022-06-24 |
分類號 | G05B13/04;A61B34/37 | 分類 | 控制;調(diào)節(jié); |
發(fā)明人 | 柏健;黃志俊;劉金勇;錢坤;鄭澤陽 | 申請(專利權(quán))人 | 杭州柳葉刀機器人有限公司 |
代理機構(gòu) | 北京常乘高知識產(chǎn)權(quán)代理事務(wù)所(特殊普通合伙) | 代理人 | 常殿國;徐健 |
地址 | 311100 浙江省杭州市余杭區(qū)中泰街道綠泰路5號4幢5樓508 | ||
法律狀態(tài) | - |
摘要
摘要 | 本發(fā)明實施例公開了一種基于自適應(yīng)力反饋的血管介入機器人系統(tǒng)主端控制方法,其中方法包括:構(gòu)建電機模型;構(gòu)建滑軌模型;獲取從端傳感器信號,對從端傳感器信號進(jìn)行濾波;構(gòu)建所述電機的參考模型,基于所述參考模型,設(shè)置控制器對所述電機模型的參數(shù)進(jìn)行實時校正;基于校正后的電機模型及所述滑軌模型,估算摩擦力,并補償所述摩擦力;基于所述處理后的傳感器信號,將還原的所述從端設(shè)備所受到的扭力、還原的所述從端設(shè)備所受到的水平方向的阻力作用于操作桿,作用于操作桿的還原后的力即為力反饋。本方法能夠?qū)崿F(xiàn)精準(zhǔn)力反饋,使血管介入機器人系統(tǒng)系統(tǒng)擁有強抗擾性和魯棒性,能夠較大程度地避免輸出的波動。 |
