手術(shù)機(jī)械臂自動定位尋路方法、裝置、機(jī)器人及存儲介質(zhì)
基本信息
申請?zhí)?/td> | CN202210199093.X | 申請日 | - |
公開(公告)號 | CN114559432A | 公開(公告)日 | 2022-05-31 |
申請公布號 | CN114559432A | 申請公布日 | 2022-05-31 |
分類號 | B25J9/16(2006.01)I | 分類 | 手動工具;輕便機(jī)動工具;手動器械的手柄;車間設(shè)備;機(jī)械手; |
發(fā)明人 | 錢坤;黃志俊;劉金勇;陳鵬 | 申請(專利權(quán))人 | 杭州柳葉刀機(jī)器人有限公司 |
代理機(jī)構(gòu) | 北京超凡宏宇專利代理事務(wù)所(特殊普通合伙) | 代理人 | - |
地址 | 311100浙江省杭州市余杭區(qū)中泰街道綠泰路5號4幢5樓508 | ||
法律狀態(tài) | - |
摘要
摘要 | 本發(fā)明實(shí)施例公開了手術(shù)機(jī)械臂自動定位尋路方法、裝置、機(jī)器人及存儲介質(zhì),該方法包括:獲取機(jī)械臂的當(dāng)前位姿數(shù)據(jù)以及手術(shù)區(qū)域的位置數(shù)據(jù);根據(jù)所述當(dāng)前位姿數(shù)據(jù)和所述位置數(shù)據(jù)計(jì)算最短路徑;構(gòu)建對應(yīng)的雅克比矩陣,并基于所述最短路徑和當(dāng)前位姿數(shù)據(jù)對所述雅克比矩陣求解,若所述雅克比矩陣為滿秩,則求解得到所述機(jī)械臂的各個(gè)關(guān)節(jié)角度;根據(jù)所述各個(gè)關(guān)節(jié)角度控制所述機(jī)械臂到達(dá)所述手術(shù)區(qū)域。使得機(jī)械臂在確定了路徑之后,可以在多個(gè)實(shí)現(xiàn)完成該路徑的解中找到不會使得機(jī)械臂產(chǎn)生奇異位的解,保證了手術(shù)中患者的安全,提高了機(jī)械臂的安全系數(shù)。 |
