日韩中文字幕久久久97都市激情,久久91网,亚洲天堂最新,国产精品嫩草影院九色,亚洲午夜精品一本二本,精品少妇一区二区三区蜜桃,av一道本

一種醫(yī)學(xué)機(jī)器人控制方法、裝置及醫(yī)學(xué)機(jī)器人與流程

文檔序號(hào):42283881發(fā)布日期:2025-06-27 18:16閱讀:6來(lái)源:國(guó)知局

本技術(shù)屬于醫(yī)學(xué)機(jī)器人,尤其涉及一種醫(yī)學(xué)機(jī)器人控制方法、裝置及醫(yī)學(xué)機(jī)器人。


背景技術(shù):

1、目前,在醫(yī)學(xué)影像,如電子計(jì)算器斷層掃描(computed?tomography,ct)影像引導(dǎo)的醫(yī)學(xué)機(jī)器人中,為提高對(duì)醫(yī)學(xué)機(jī)器人的控制效率或應(yīng)對(duì)異常場(chǎng)景,醫(yī)學(xué)機(jī)器人的機(jī)械臂需具備柔順拖動(dòng)功能以使得醫(yī)生或技師能自由地將機(jī)械臂拖離患者或拖動(dòng)至指定區(qū)域。

2、然而。目前的相關(guān)技術(shù)難以滿足實(shí)際需求,降低了對(duì)醫(yī)學(xué)機(jī)器人進(jìn)行柔順拖動(dòng)的控制準(zhǔn)確率和控制成功率。


技術(shù)實(shí)現(xiàn)思路

1、本技術(shù)實(shí)施例提供了一種醫(yī)學(xué)機(jī)器人控制方法、裝置及醫(yī)學(xué)機(jī)器人,提高了對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算準(zhǔn)確率,進(jìn)而提高了對(duì)機(jī)械臂進(jìn)行柔順拖動(dòng)的控制準(zhǔn)確率和控制成功率。

2、第一方面,本技術(shù)實(shí)施例提供了一種醫(yī)學(xué)機(jī)器人控制方法,包括:

3、在檢測(cè)到醫(yī)學(xué)機(jī)器人的機(jī)械臂處于柔順拖動(dòng)狀態(tài)時(shí),獲取機(jī)械臂的目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,以及獲取設(shè)置于機(jī)械臂的力傳感器采集到的當(dāng)前數(shù)據(jù);

4、根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和當(dāng)前數(shù)據(jù),對(duì)機(jī)械臂進(jìn)行重力補(bǔ)償,得到目標(biāo)數(shù)據(jù);

5、根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,或者,根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和目標(biāo)數(shù)據(jù),確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略;

6、基于計(jì)算策略,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值;

7、基于目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,對(duì)機(jī)械臂進(jìn)行控制。

8、本技術(shù)實(shí)施例提供的一種醫(yī)學(xué)機(jī)器人控制方法,通過(guò)在檢測(cè)到醫(yī)學(xué)機(jī)器人的機(jī)械臂處于柔順拖動(dòng)狀態(tài)時(shí),獲取機(jī)械臂的目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,以及獲取設(shè)置于機(jī)械臂的力傳感器采集到的當(dāng)前數(shù)據(jù);根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和當(dāng)前數(shù)據(jù),對(duì)機(jī)械臂進(jìn)行重力補(bǔ)償,得到目標(biāo)數(shù)據(jù);根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,或者,根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和目標(biāo)數(shù)據(jù),確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略;基于計(jì)算策略,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值;基于目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,對(duì)機(jī)械臂進(jìn)行控制。與現(xiàn)有技術(shù)相比,本方法可以根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,或者目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和目標(biāo)數(shù)據(jù)靈活確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,從而提高了對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算準(zhǔn)確率,進(jìn)而提高了對(duì)機(jī)械臂進(jìn)行柔順拖動(dòng)的控制準(zhǔn)確率和控制成功率。

9、在第一方面的一種可能的實(shí)施方式中,目標(biāo)關(guān)節(jié)的數(shù)量為至少一個(gè);目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度;根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,包括:

10、針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度的絕對(duì)值小于或等于設(shè)定閾值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第一策略;第一策略為根據(jù)目標(biāo)數(shù)據(jù)和當(dāng)前運(yùn)動(dòng)信息計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略;

11、針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度的絕對(duì)值大于設(shè)定閾值的絕對(duì)值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第二策略;第二策略為基于目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略。

12、上述實(shí)施方式中,針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),醫(yī)學(xué)機(jī)器人可以根據(jù)該目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度準(zhǔn)確確定該目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,從而提高了對(duì)任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算準(zhǔn)確率。

13、在第一方面的一種可能的實(shí)施方式中,目標(biāo)關(guān)節(jié)的數(shù)量為至少一個(gè);目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度;根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和目標(biāo)數(shù)據(jù),確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,包括:

14、基于目標(biāo)數(shù)據(jù)計(jì)算得到所有目標(biāo)關(guān)節(jié)各自的初始摩擦力前饋值;

15、針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度小于或等于設(shè)定閾值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第三策略;第三策略為將目標(biāo)關(guān)節(jié)的初始摩擦力前饋值確定為目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略;

16、針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度的絕對(duì)值大于設(shè)定閾值的絕對(duì)值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第二策略;第二策略為基于目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略。

17、上述實(shí)施方式中,醫(yī)學(xué)機(jī)器人可以根據(jù)目標(biāo)數(shù)據(jù)計(jì)算得到所有目標(biāo)關(guān)節(jié)各自的初始摩擦力前饋值,之后,針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),醫(yī)學(xué)機(jī)器人可以結(jié)合目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度確定是否可以直接將目標(biāo)關(guān)節(jié)的初始摩擦力前饋值確定為目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,從而提高了對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算準(zhǔn)確率以及醫(yī)學(xué)機(jī)器人的工作效率。

18、在第一方面的一種實(shí)施方式中,目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)角度;基于計(jì)算策略,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,包括:

19、當(dāng)計(jì)算策略為根據(jù)目標(biāo)數(shù)據(jù)和當(dāng)前運(yùn)動(dòng)信息計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的第一策略時(shí),確定機(jī)械臂的結(jié)構(gòu)類型;

20、根據(jù)結(jié)構(gòu)類型,確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算方式;

21、基于計(jì)算方式,根據(jù)目標(biāo)關(guān)節(jié)角度和目標(biāo)數(shù)據(jù)進(jìn)行計(jì)算,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值。

22、上述實(shí)施方式中,在計(jì)算策略為第一策略時(shí),醫(yī)學(xué)機(jī)器人可以根據(jù)機(jī)械臂的結(jié)構(gòu)類型準(zhǔn)確確定目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算方式,從而提高了在計(jì)算策略為第一策略時(shí),對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算準(zhǔn)確率。

23、在第一方面的一種實(shí)施方式中,目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度;基于計(jì)算策略,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,包括:

24、當(dāng)計(jì)算策略為基于目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的第二策略時(shí),根據(jù)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度,確定目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度對(duì)應(yīng)的方向;

25、根據(jù)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度和目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度對(duì)應(yīng)的方向,計(jì)算得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值。

26、上述實(shí)施方式中,在計(jì)算策略為第二策略時(shí),醫(yī)學(xué)機(jī)器人可以根據(jù)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度準(zhǔn)確確定目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,從而提高了在計(jì)算策略為第二策略時(shí),對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算準(zhǔn)確率。

27、在第一方面的一種實(shí)施方式中,基于目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,對(duì)機(jī)械臂進(jìn)行控制,包括:

28、基于目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,計(jì)算得到目標(biāo)關(guān)節(jié)的力矩前饋值;

29、根據(jù)機(jī)械臂所處的場(chǎng)景,確定目標(biāo)關(guān)節(jié)的其它前饋值;其中,其它前饋值指目標(biāo)關(guān)節(jié)基于需要設(shè)定需求產(chǎn)生的前饋值;

30、根據(jù)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值、目標(biāo)關(guān)節(jié)的力矩前饋值以及目標(biāo)關(guān)節(jié)的其它前饋值,計(jì)算得到目標(biāo)關(guān)節(jié)的總前饋值;

31、根據(jù)目標(biāo)關(guān)節(jié)的總前饋值,對(duì)機(jī)械臂進(jìn)行控制。

32、上述實(shí)施方式中,醫(yī)學(xué)機(jī)器人可以根據(jù)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值、力矩前饋值以及其它前饋值實(shí)現(xiàn)對(duì)機(jī)械臂的柔順拖動(dòng)控制,從而提高了對(duì)機(jī)械臂柔順拖動(dòng)的控制準(zhǔn)確率。

33、在第一方面的一種實(shí)施方式中,根據(jù)機(jī)械臂所處的場(chǎng)景,確定目標(biāo)關(guān)節(jié)的其它前饋值,包括:

34、根據(jù)場(chǎng)景,確定目標(biāo)關(guān)節(jié)需要限制的參數(shù);

35、獲取與需要限制的參數(shù)對(duì)應(yīng)的限制閾值和實(shí)際數(shù)據(jù);

36、根據(jù)限制閾值和實(shí)際數(shù)據(jù),計(jì)算得到與需要限制的參數(shù)對(duì)應(yīng)的前饋值,作為目標(biāo)關(guān)節(jié)的其它前饋值。

37、上述實(shí)施方式中,醫(yī)學(xué)機(jī)器人可以根據(jù)機(jī)械臂所處的場(chǎng)景,準(zhǔn)確確定目標(biāo)關(guān)節(jié)需要進(jìn)行限制的參數(shù),并計(jì)算得到與該參數(shù)對(duì)應(yīng)的前饋值,提高了對(duì)目標(biāo)關(guān)節(jié)的其它前饋值的計(jì)算準(zhǔn)確率。

38、在第一方面的一種實(shí)施方式中,機(jī)械臂是否處于柔順拖動(dòng)狀態(tài)根據(jù)以下方式確定:

39、在檢測(cè)到預(yù)設(shè)控件被觸發(fā)時(shí),確定機(jī)械臂處于柔順拖動(dòng)模式;

40、在機(jī)械臂處于柔順拖動(dòng)模式的條件下,若檢測(cè)到用于控制機(jī)械臂運(yùn)動(dòng)的設(shè)定裝置處于第一工作狀態(tài),則確定機(jī)械臂處于柔順拖動(dòng)狀態(tài)。

41、上述實(shí)施方式中,只有在檢測(cè)到預(yù)設(shè)控件被觸發(fā),且用于控制機(jī)械臂運(yùn)動(dòng)的設(shè)定裝置處于第一工作狀態(tài)時(shí),才會(huì)確定機(jī)械臂處于柔順拖動(dòng)狀態(tài),提高了對(duì)機(jī)械臂處于柔順拖動(dòng)狀態(tài)的確定準(zhǔn)確率。

42、在第一方面的一種實(shí)施方式中,在基于目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,對(duì)機(jī)械臂進(jìn)行控制之后,還包括:

43、若檢測(cè)到設(shè)定裝置處于第二工作狀態(tài),則通過(guò)設(shè)定裝置控制機(jī)械臂處于靜止?fàn)顟B(tài)。

44、上述實(shí)施方式中,醫(yī)學(xué)機(jī)器人可以在設(shè)定裝置處于第二工作狀態(tài)時(shí),通過(guò)設(shè)定裝置及時(shí)且快速控制機(jī)械臂處于靜止?fàn)顟B(tài),提高了對(duì)機(jī)械臂處于靜止?fàn)顟B(tài)的控制準(zhǔn)確率和控制速率。

45、第二方面,本技術(shù)實(shí)施例提供了一種醫(yī)學(xué)機(jī)器人控制裝置,包括:

46、第一獲取單元,用于在檢測(cè)到醫(yī)學(xué)機(jī)器人的機(jī)械臂處于柔順拖動(dòng)狀態(tài)時(shí),獲取機(jī)械臂的目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,以及獲取設(shè)置于機(jī)械臂的力傳感器采集到的當(dāng)前數(shù)據(jù);

47、補(bǔ)償單元,用于根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和當(dāng)前數(shù)據(jù),對(duì)機(jī)械臂進(jìn)行重力補(bǔ)償,得到目標(biāo)數(shù)據(jù);

48、第一策略確定單元,用于根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略,或者,根據(jù)目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息和目標(biāo)數(shù)據(jù),確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略;

49、第一計(jì)算單元,用于基于計(jì)算策略,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值;

50、第一控制單元,用于基于目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值,對(duì)機(jī)械臂進(jìn)行控制。

51、在第二方面的一種實(shí)施方式中,目標(biāo)關(guān)節(jié)的數(shù)量為至少一個(gè);目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度;第一策略確定單元具體包括:

52、第二策略確定單元,用于針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度的絕對(duì)值小于或等于設(shè)定閾值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第一策略;第一策略為根據(jù)目標(biāo)數(shù)據(jù)和當(dāng)前運(yùn)動(dòng)信息計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略;

53、第三策略確定單元,用于針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度的絕對(duì)值大于設(shè)定閾值的絕對(duì)值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第二策略;第二策略為基于目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略。

54、在第二方面的一種實(shí)施方式中,目標(biāo)關(guān)節(jié)的數(shù)量為至少一個(gè);目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度;第一策略確定單元具體包括:

55、第二計(jì)算單元,用于基于目標(biāo)數(shù)據(jù)計(jì)算得到所有目標(biāo)關(guān)節(jié)各自的初始摩擦力前饋值;

56、第四策略確定單元,用于針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度小于或等于設(shè)定閾值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第三策略;第三策略為將目標(biāo)關(guān)節(jié)的初始摩擦力前饋值確定為目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略;

57、第五策略確定單元,用于針對(duì)任意一個(gè)目標(biāo)關(guān)節(jié),當(dāng)任意一個(gè)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度的絕對(duì)值大于設(shè)定閾值的絕對(duì)值時(shí),確定任意一個(gè)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算策略為第二策略;第二策略為基于目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的策略。

58、在第二方面的一種實(shí)施方式中,目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)角度;第一計(jì)算單元具體包括:

59、類型確定單元,用于當(dāng)計(jì)算策略為根據(jù)目標(biāo)數(shù)據(jù)和當(dāng)前運(yùn)動(dòng)信息計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的第一策略時(shí),確定機(jī)械臂的結(jié)構(gòu)類型;

60、方式確定單元,用于根據(jù)結(jié)構(gòu)類型,確定對(duì)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的計(jì)算方式;

61、第三計(jì)算單元,用于基于計(jì)算方式,根據(jù)目標(biāo)關(guān)節(jié)角度和目標(biāo)數(shù)據(jù)進(jìn)行計(jì)算,得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值。

62、在第二方面的一種實(shí)施方式中,目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息包括目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度;第一計(jì)算單元具體包括:

63、方向確定單元,用于當(dāng)計(jì)算策略為基于目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度計(jì)算目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值的第二策略時(shí),根據(jù)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度,確定目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度對(duì)應(yīng)的方向;

64、第四計(jì)算單元,用于根據(jù)目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度和目標(biāo)關(guān)節(jié)的關(guān)節(jié)速度對(duì)應(yīng)的方向,計(jì)算得到目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值。

65、在第二方面的一種實(shí)施方式中,第一控制單元具體包括:

66、第五計(jì)算單元,用于基于目標(biāo)關(guān)節(jié)的當(dāng)前運(yùn)動(dòng)信息,計(jì)算得到目標(biāo)關(guān)節(jié)的力矩前饋值;

67、前饋值確定單元,用于根據(jù)機(jī)械臂所處的場(chǎng)景,確定目標(biāo)關(guān)節(jié)的其它前饋值;其中,其它前饋值指目標(biāo)關(guān)節(jié)基于需要設(shè)定需求產(chǎn)生的前饋值;

68、第六計(jì)算單元,用于根據(jù)目標(biāo)關(guān)節(jié)的目標(biāo)摩擦力前饋值、目標(biāo)關(guān)節(jié)的力矩前饋值以及目標(biāo)關(guān)節(jié)的其它前饋值,計(jì)算得到目標(biāo)關(guān)節(jié)的總前饋值;

69、第二控制單元,用于根據(jù)目標(biāo)關(guān)節(jié)的總前饋值,對(duì)機(jī)械臂進(jìn)行控制。

70、在第二方面的一種實(shí)施方式中,前饋值確定單元具體包括:

71、參數(shù)確定單元,用于根據(jù)場(chǎng)景,確定目標(biāo)關(guān)節(jié)需要限制的參數(shù);

72、第二獲取單元,用于獲取與需要限制的參數(shù)對(duì)應(yīng)的限制閾值和實(shí)際數(shù)據(jù);

73、第七計(jì)算單元,用于根據(jù)限制閾值和實(shí)際數(shù)據(jù),計(jì)算得到與需要限制的參數(shù)對(duì)應(yīng)的前饋值,作為目標(biāo)關(guān)節(jié)的其它前饋值。

74、在第二方面的一種實(shí)施方式中,第一獲取單元具體包括:

75、模式確定單元,用于在檢測(cè)到預(yù)設(shè)控件被觸發(fā)時(shí),確定機(jī)械臂處于柔順拖動(dòng)模式;

76、狀態(tài)確定單元,用于在機(jī)械臂處于柔順拖動(dòng)模式的條件下,若檢測(cè)到用于控制機(jī)械臂運(yùn)動(dòng)的設(shè)定裝置處于第一工作狀態(tài),則確定機(jī)械臂處于柔順拖動(dòng)狀態(tài)。

77、在第二方面的一種實(shí)施方式中,醫(yī)學(xué)機(jī)器人控制裝置還包括:

78、第三控制單元,用于若檢測(cè)到設(shè)定裝置處于第二工作狀態(tài),則通過(guò)設(shè)定裝置控制機(jī)械臂處于靜止?fàn)顟B(tài)。

79、第三方面,本技術(shù)實(shí)施例提供了一種醫(yī)學(xué)機(jī)器人,包括:存儲(chǔ)器、處理器以及存儲(chǔ)在所述存儲(chǔ)器中并可在所述處理器上運(yùn)行的計(jì)算機(jī)程序,上述處理器執(zhí)行所述計(jì)算機(jī)程序時(shí)實(shí)現(xiàn)如上述第一方面中任一項(xiàng)所述的醫(yī)學(xué)機(jī)器人控制方法。

80、第四方面,本技術(shù)實(shí)施例提供了一種計(jì)算機(jī)可讀存儲(chǔ)介質(zhì),所述計(jì)算機(jī)可讀存儲(chǔ)介質(zhì)存儲(chǔ)有計(jì)算機(jī)程序,所述計(jì)算機(jī)程序被處理器執(zhí)行時(shí)實(shí)現(xiàn)如上述第一方面中任一項(xiàng)所述的醫(yī)學(xué)機(jī)器人控制方法。

81、第五方面,本技術(shù)實(shí)施例提供了一種計(jì)算機(jī)程序產(chǎn)品,當(dāng)計(jì)算機(jī)程序產(chǎn)品在醫(yī)學(xué)機(jī)器人上運(yùn)行時(shí),使得醫(yī)學(xué)機(jī)器人可執(zhí)行上述第一方面中任一項(xiàng)所述的醫(yī)學(xué)機(jī)器人控制方法。

當(dāng)前第1頁(yè)1 2 
網(wǎng)友詢問(wèn)留言 已有0條留言
  • 還沒(méi)有人留言評(píng)論。精彩留言會(huì)獲得點(diǎn)贊!
1