CN111086003A

CN111086003A - 机器人仿型控制方法及其装置

Info

Publication number: CN111086003A
Application number: CN202010018210.9A
Authority: CN
Inventors: 曾智文
Original assignee: Beijing Xianjin Robot Co Ltd
Current assignee: Beijing Xianjin Robot Co Ltd
Priority date: 2020-01-08
Filing date: 2020-01-08
Publication date: 2020-05-01

Abstract

本发明公开了机器人仿型控制方法，其特征在于，包括如下步骤，步骤一，使操作臂的姿态发生变化；步骤二，控制器获取操作臂的姿态变化数值；步骤三，控制器根据步骤二获取的数值控制执行臂进行相应的动作；步骤四，控制器获取执行臂所受外力，并根据获取的执行臂所受外力向操作臂施加相应的力。还公开了机器人仿型控制装置，其特征在于，包括执行部分、操作部分和控制器。本发明的有益效果是：本发明的方法通过控制器得到操作部分的动作，进而根操作部分的动作控制执行部分的动作，实现机器人的仿型操作，并且能够实现对操作者手部力反馈增强操作者手部的体验感和操作的准确性。

Description

机器人仿型控制方法及其装置

技术领域

本发明涉及机器人控制领域，尤其涉及机器人仿型控制方法及其装置。

背景技术

现有的机器人仿型控制方法是控制器通过编码器获取操作臂各关节的角度变化值进而根据获取的操作臂各关节角度变化值控制执行臂进行相应的动作，完成机器人的仿型控制；由于机器人的操作臂和机器人的执行臂非机械传动连接，因此操作操作臂时，操作者手部无反馈力，操作体验感差，容易出现误动作。

发明内容

为了解决上述背景技术中提出的问题，本发明公开了机器人仿型控制方法，包括如下步骤，

步骤一，使操作臂的姿态发生变化；

步骤二，控制器获取操作臂的姿态变化数值；

步骤三，控制器根据步骤二获取的数值控制执行臂进行相应的动作；

步骤四，控制器获取执行臂所受外力，并根据获取的执行臂所受外力向操作臂施加相应的力。

所述步骤一中，只有当操作臂各关节所受的操作力大于等于最小操作力设定值且小于等于最大操作力设定值时，操作臂的姿态发生变化，否则，操作臂的姿态不发生变化。

所述步骤四中，控制器获取执行臂各关节所受外力，并根据获取的执行臂各关节所受外力向操作臂相应各关节施加相应的力。

还公开了机器人仿型控制装置，包括执行部分、操作部分和控制器；所述执行部分包括执行臂和执行臂驱动端；所述执行臂包括n个执行关节，n为大于等于3的整数；i为1至n-1的整数，j为1至n-2的整数，p为1至n的整数；其中第i个执行关节的末端通过第i连接轴与第i+1个执行关节的首端铰接；第i个执行关节的末端配合有n-i+1个依次同轴叠放在一起的i级主动执行齿轮；第i连接轴上套置有n-i+1个i级过渡执行齿轮，第一个i级过渡执行齿轮至第n-i+1个i级过渡执行齿轮与第一个i级主动执行齿轮至第n-i+1个i级主动执行齿轮分别一一对应垂直啮合，第一个i级过渡执行齿轮与第i+1个执行关节的首端固定连接；第j+1个执行关节的首端配合有n-j个依次同轴叠放在一起j级从动执行齿轮，第一个j级从动执行齿轮至第n-j个j级从动执行齿轮与第二个j级过渡执行齿轮至第n-j+1个j级过渡执行齿轮分别一一对应垂直啮合；第n个执行关节的首端配合有一个n-1级从动执行齿轮，所述n-1级从动执行齿轮与第二个n-1 级过渡执行齿轮垂直啮合；第一个执行关节首端连接有一空心执行转轴；第i个执行关节内可转动的配合有n-i+1根自外向内依次穿套的i级空心执行转轴；第一个执行关节内的第p根一级空心执行转轴的一端分别和第p个一级主动执行齿轮连接；第j+1个执行关节末端的第一个j+1级主动执行齿轮至第n-j个的j+1级主动执行齿轮与第j+1个执行关节首端的第一个j级从动执行齿轮至第n-j个j级从动执行齿轮分别通过第j+1个执行关节内的第一根j+1级空心执行转轴至第n-j根j+1级空心执行转轴一一对应同轴连接；第n个执行关节中可转动配合有一与第n个执行关节首端的n-1级从动执行齿轮同轴连接的执行转动杆；所述执行臂驱动端包括执行电机固定板，所述执行电机固定板上固定有n+1个依次同轴叠放的空心轴执行电机；各空心轴执行电机均连接有外力检测装置；所述外力检测装置包括外力检测行星齿轮系、外力检测法兰轴套、外力检测限位块和外力检测压力传感器；所述外力检测行星齿轮系包括外力检测小太阳轮、外力检测行星轮、外力检测大太阳轮和外力检测行星架；所述外力检测法兰轴套的法兰端固定于外力检测大太阳轮的端面；所述外力检测行星架的圆周面上相向设置有两个向外凸出的外力检测压力传递块；外力检测限位块设置有向内凹陷的外力检测压力传感器固定槽；外力检测压力传感器固定槽的两侧均固定有所述外力检测压力传感器；外力检测压力传递块卡入两个外力检测压力传感器之间；第一个空心轴执行电机的输出轴通过第一个外力检测装置和空心执行转轴同轴连接；第二个空心轴执行电机的输出轴至第n+1个空心轴执行电机的输出轴分别依次通过第二个外力检测装置至第n+1个外力检测装置和第一根一级空心执行转轴至第n根一级空心执行转轴同轴连接；其中各外力检测行星架分别可转动的固定于所述执行电机固定板；各外力检测限位块分别固定于所述执行电机固定板；所述第一个空心轴执行电机至第n+1个空心轴执行电机的动作均由所述控制器进行控制；第一个外力检测装置至第n+1个外力检测装置的外力检测压力传感器的测量值均传输至所述控制器；所述操作部分包括操作臂固定座、操作臂和手持部；所述操作臂可转动的固定于所述操作臂固定座；所述手持部可转动的固定于所述操作臂；所述操作臂包括n个操作关节，其中第i个操作关节的末端通过第i铰接轴与第i+1个操作关节的首端铰接，第i个操作关节的末端配合有n-i+1个依次同轴叠放在一起的i级主动操作齿轮；第i铰接轴上套置有n-i+1个i级过渡操作齿轮，第一个i级过渡操作齿轮至第n-i+1个i级过渡操作齿轮与第一个i级主动操作齿轮至第n-i+1个i级主动操作齿轮分别一一对应垂直啮合，第一个i级过渡操作齿轮与第i+1个操作关节的首端固定连接；第j+1个操作关节的首端配合有n-j个依次同轴叠放在一起的j级从动操作齿轮，第一个j级从动操作齿轮至第n-j个j级从动操作齿轮与第二个j级过渡操作齿轮至第n-j+1个j级过渡操作齿轮分别一一对应垂直啮合；第n个操作关节的首端配合有一个n-1级从动操作齿轮，所述n-1级从动操作齿轮与第二个n-1级过渡操作齿轮垂直啮合；第一个操作关节首端连接有一空心操作转轴；第i个操作关节内可转动的配合有n-i+1根自外向内依次穿套的i级空心操作转轴；第一个操作关节内的第p根一级空心操作转轴一端分别和第p个一级主动操作齿轮连接；第j+1个操作关节末端的第一个j+1级主动操作齿轮至第n-j个的j+1级主动操作齿轮与第j+1个操作关节首端的第一个j级从动操作齿轮至第n-j个j级从动操作齿轮分别通过第j+1个操作关节内的第一根j+1级空心操作转轴至第n-j根j+1级空心操作转轴一一对应同轴连接；第n个操作关节中可转动配合有一与第n个操作关节首端的n-1级从动操作齿轮同轴连接的操作转动杆；所述操作转动杆和手持部连接；所述操作臂固定座内固定有第一个位置传感器至第n+1个位置传感器；第一个操作关节首端通过空心操作转轴可转动的固定于所述操作臂固定座；所述空心操作转轴和第p根一级空心操作转轴均连接有外力反馈装置；所述外力反馈装置包括外力反馈涡轮、外力反馈蜗杆、外力反馈传动轴、外力反馈轴套、外力反馈弹簧、外力反馈压力传递板、外力反馈压力传感器、外力反馈限位板、外力反馈联轴器和外力反馈电机；外力反馈蜗杆和外力反馈涡轮啮合；外力反馈蜗杆可滑动的套置于外力反馈传动轴且外力反馈蜗杆相对于外力反馈传动轴不能转动；外力反馈传动轴的一端依次穿过外力反馈轴套、外力反馈弹簧、外力反馈压力传递板、外力反馈限位板通过外力反馈联轴器和外力反馈电机的输出轴连接；外力反馈传动轴的另一端依次穿过外力反馈轴套、外力反馈弹簧、外力反馈压力传递板、外力反馈限位板；外力反馈轴套、外力反馈压力传递板均可沿外力反馈传动轴的轴向滑动；外力反馈限位板和外力反馈压力传递板中间设置有外力反馈压力传感器；外力反馈弹簧将外力反馈轴套压紧于外力反馈蜗杆的轴端，将外力反馈压力传递板压紧于外力反馈压力传感器；所述各外力反馈装置的外力反馈涡轮分别套置于空心操作转轴和第p根一级空心操作转轴上；各外力反馈电机均固定于操作臂固定座；各外力反馈轴套均可在操作臂固定座内转动和滑动；各外力反馈传动轴两端的两个外力反馈限位板均固定于操作臂固定座；第一个位置传感器至第n+1个位置传感器的测量值均传输至所述控制器；所述各外力反馈压力传感器的测量值均传输至所述控制器；所述各外力反馈电机均由所述控制器控制。

所述外力反馈装置还包括外力反馈限位板调整板；远离外力反馈电机的外力反馈限位板通过外力反馈限位板调整板固定于所述操作臂固定座；通过调整所述外力反馈限位板调整板可调整远离外力反馈电机的外力反馈限位板沿着各外力反馈传动轴轴向的位置。

所述外力反馈传动轴截面可加工成多边形并且外力反馈蜗杆轴向内部也加工成适配的多边形。

所述执行臂驱动端可分拆为执行更换部和执行固定部；第一个空心轴执行电机至第n+1个空心轴执行电机均固定于所述执行固定部；第一个空心轴执行电机控制空心操作转轴的转动；第二个空心轴执行电机至第n+1个空心轴执行电机分别控制第一根一级空心操作转轴至第n根一级空心操作转轴的转动；所述执行臂和所述执行更换部连接；所述执行更换部和所述执行固定部可分离连接。

本发明的有益效果是：本发明的方法通过控制器得到操作部分的动作，进而根操作部分的动作控制执行部分的动作，实现机器人的仿型操作，并且能够实现对操作者手部力反馈增强操作者手部的体验感和操作的准确性；本发明的装置可以使操作者操作时手部感受到一定的阻力，增强操作体验感并且可以有效防止操作者误操作；本发明装置的执行臂驱动端可分拆为执行更换部和执行固定部，这样执行更换部及其连接的执行臂可进行更换，极大的降低了执行部分的更换成本。

附图说明

图1为本发明整体结构示意图。

图2为本发明操作部分结构示意图。

图3为图2的爆炸图。

图4为本发明操作臂固定座内部结构示意图。

图5为本发明操作臂的爆炸图。

图6为本发明操作臂处的剖视图。

图7为本发明执行部分的剖视图。

图8为本发明执行臂的爆炸图。

图9为图7中a处的放大图。

图10为本发明外力检测装置的爆炸图。

图11为本发明又一整体结构示意图。

图12为图11中执行部分的剖视图。

图13为图11中执行部分的分离示意图。

具体实施方式

下面对本发明的实施例进行详细阐述，以使本发明的优点和特征能更易于被本领域技术人员理解，从而对本发明的保护范围做出更为清楚明确的界定。

实施例1

机器人仿型控制方法，包括如下步骤，

步骤一，使操作臂的姿态发生变化；

步骤二，控制器获取操作臂的姿态变化数值；

实施例2

参照附图1-10，机器人仿型控制装置，包括执行部分1、操作部分2和控制器；执行部分1包括执行臂11和执行臂驱动端12，其中执行臂11包括n个执行关节A，n为大于等于3的整数；以下以n等于4为例进行说明。

参照附图7-9，执行臂11包括第一个执行关节A1、第二个执行关节A2、第三个执行关节A3、第二个执行关节A4、第一连接轴C、第二连接轴D、第三连接轴E、、一级空心执行转轴A13（第一根一级空心执行转轴A131、第二根一级空心执行转轴A132、第三根一级空心执行转轴A133和第四根一级空心执行转轴A134）、一级主动执行齿轮A11（第一个一级主动执行齿轮A111、第二个一级主动执行齿轮A112、第三个一级主动执行齿轮A113和第四个一级主动执行齿轮A114）、一级过渡执行齿轮C1（第一个一级过渡执行齿轮C11、第二个一级过渡执行齿轮C12、第三个一级过渡执行齿轮C13和第四个一级过渡执行齿轮C14）、一级从动执行齿轮A22（第一个一级从动执行齿轮A221、第二个一级从动执行齿轮A222和第三个一级从动执行齿轮A223）、二级空心执行转轴A23（第一根二级空心执行转轴A231、第二根二级空心执行转轴A232和第三根二级空心执行转轴A233）、二级主动执行齿轮A21（第一个二级主动执行齿轮A211、第二个二级主动执行齿轮A212和第三个二级主动执行齿轮A213）、二级过渡执行齿轮D1（第一个二级过渡执行齿轮D11、第二个二级过渡执行齿轮D12和第三个二级过渡执行齿轮D13）、二级从动执行齿轮A32（第一个二级从动执行齿轮A321和第二个二级从动执行齿轮A322）、三级空心执行转轴A33（第一根三级空心执行转轴A331和第二根三级空心执行转轴A332）、三级主动执行齿轮A31（第一个三级主动执行齿轮A311和第二个三级主动执行齿轮A312）、三级过渡执行齿轮E1（第一个三级过渡执行齿轮E11和第二个三级过渡执行齿轮E12）、三级从动执行齿轮A42和执行转动杆A41；执行臂11的各构件之间的连接方式和公布日为2019年10月22日，公布号为 CN110353810A，发明名称为“一种单孔径手动直驱手术机器人系统”的中国专利申请文件的实施例中关于n=4时，执行臂的各构件之间的连接方式相同，执行臂11的各构件之间的连接方式请参考上述申请文件中；其中第一个执行关节A1首端连接有空心执行转轴A14。

参照附图1、7，执行臂驱动端12包括执行电机固定板14，执行电机固定板14上固定有五个依次同轴叠放的空心轴执行电机，第一个空心轴执行电机131、第二个空心轴执行电机132、第三个空心轴执行电机133、第四个空心轴执行电机134、第五个空心轴执行电机135。

外力检测装置R包括外力检测行星齿轮系R1、外力检测法兰轴套R2、外力检测限位块R3和外力检测压力传感器R4；其中外力检测行星齿轮系R1包括外力检测小太阳轮R11、外力检测行星轮R12、外力检测大太阳轮R13和外力检测行星架R14；外力检测法兰轴套R2的法兰端固定于外力检测大太阳轮R13的端面；外力检测行星架R14可转动的固定于执行电机固定板14；外力检测行星架R14的圆周面上相向设置有两个向外凸出的外力检测压力传递块R141；两个外力检测限位块R3相向固定于执行电机固定板14，且设置有向内凹陷的外力检测压力传感器固定槽R31；外力检测压力传感器固定槽R31的两侧均固定有外力检测压力传感器R4；外力检测压力传递块R141卡入两个外力检测压力传感器R4之间。

第一个空心轴执行电机131的输出轴通过第一个外力检测装置R和空心执行转轴A14同轴连接；其中外力检测小太阳轮R11和第一个空心轴执行电机131的输出轴同轴连接；外力检测法兰轴套R2和空心执行转轴A14同轴连接。第二个空心轴执行电机132的输出轴通过第二个外力检测装置R和第一根一级空心执行转轴A131同轴连接；其中外力检测小太阳轮R11和第二个空心轴执行电机132的输出轴同轴连接；外力检测法兰轴套R2和第一根一级空心执行转轴A131同轴连接。第三个空心轴执行电机133的输出轴通过第三个外力检测装置R和第二根一级空心执行转轴A132同轴连接；其中外力检测小太阳轮R11和第三个空心轴执行电机133的输出轴同轴连接；外力检测法兰轴套R2和第二根一级空心执行转轴A132同轴连接。第四个空心轴执行电机134的输出轴通过第四个外力检测装置R和第三根一级空心执行转轴A133同轴连接；其中外力检测小太阳轮R11和第四个空心轴执行电机134的输出轴同轴连接；外力检测法兰轴套R2和第三根一级空心执行转轴A133同轴连接。第五个空心轴执行电机135的输出轴通过第五个外力检测装置R和第四根一级空心执行转轴A134同轴连接；其中外力检测小太阳轮R11和第五个空心轴执行电机135的输出轴同轴连接；外力检测法兰轴套R2和第四根一级空心执行转轴A134同轴连接。

第一个空心轴执行电机131至第五个空心轴执行电机135的动作均由控制器进行控制；第一个外力检测装置R至第五个外力检测装置R的外力检测压力传感器R4的测量值均传输至控制器。

参照附图1-6，操作部分2包括操作臂固定座21、操作臂22和手持部23；操作臂22可转动的固定于操作臂固定座21；手持部23可转动的固定于操作臂22。

参照附图5-6，操作臂22包括操作关节B（第一个操作关节B1、第二操作关节B2、第三操作关节B3和第四操作关节B4）、第一铰接轴F、第二铰接轴G、第三铰接轴H、一级主动操作齿轮B11（第一个一级主动操作齿轮B111、第二个一级主动操作齿轮B112、第三个一级主动操作齿轮B113和第四个一级主动操作齿轮B114）、一级过渡操作齿轮F1（第一个一级过渡操作齿轮F11、第二个一级过渡操作齿轮F12、第三个一级过渡操作齿轮F13和第四个一级过渡操作齿轮F14）、一级从动操作齿轮B22（第一个一级从动操作齿轮B221、第二个一级从动操作齿轮B222和第三个一级从动操作齿轮B223）、二级空心操作转轴B23（第一根二级空心操作转轴B231、第二根二级空心操作转轴B232和第三根二级空心操作转轴B233）、二级主动操作齿轮B21（第一个二级主动操作齿轮B211、第二个二级主动操作齿轮B212和第三个二级主动操作齿轮B213）、二级过渡操作齿轮G1（第一个二级过渡操作齿轮G11、第二个二级过渡操作齿轮G12和第三个二级过渡操作齿轮G13）、二级从动操作齿轮B32（第一个二级从动操作齿轮B321和第二个二级从动操作齿轮B322）、三级空心操作转轴B33（第一根三级空心操作转轴B331和第二根三级空心操作转轴B332）、三级主动操作齿轮B31（第一个三级主动操作齿轮B311和第二个三级主动操作齿轮B312）、三级过渡操作齿轮H1（第一个三级过渡操作齿轮H11和第二个三级过渡操作齿轮H12）、三级从动操作齿轮B42和操作转动杆B41；上述操作臂22的各构件之间的连接方式和公布日为2019年10月22日，公布号为 CN110353810A，发明名称为“一种单孔径手动直驱手术机器人系统”的中国专利申请文件的实施例中关于n=4时，操作臂的各构件之间的连接方式相同；其中操作转动杆B41和手持部23连接，以便转动操作转动杆B41。

参照附图3-6，操作臂固定座21内按照靠近第一个操作关节B1的方向依次固定有第一个位置传感器Q1、第二个位置传感器Q2、第三个位置传感器Q3、第四个位置传感器Q4和第五个位置传感器Q5；其中第一个位置传感器Q1到第五个位置传感器Q5均为编码器。

外力反馈装置W包括外力反馈涡轮W1、外力反馈蜗杆W2、外力反馈传动轴W3、外力反馈轴套W4、外力反馈弹簧W5、外力反馈压力传递板W6、外力反馈压力传感器W7、外力反馈限位板W8、外力反馈联轴器W9和外力反馈电机W11；外力反馈蜗杆W2和外力反馈涡轮W1啮合；外力反馈蜗杆W2可滑动的套置于外力反馈传动轴W3且外力反馈蜗杆W2相对于外力反馈传动轴W3不能转动；外力反馈传动轴W3的一端依次穿过外力反馈轴套W4、外力反馈弹簧W5、外力反馈压力传递板W6、外力反馈限位板W8通过外力反馈联轴器W9和外力反馈电机W11的输出轴连接；外力反馈传动轴W3的另一端依次穿过外力反馈轴套W4、外力反馈弹簧W5、外力反馈压力传递板W6、外力反馈限位板W8；外力反馈轴套W4和外力反馈压力传递板W6均可沿外力反馈传动轴W3的轴向滑动；外力反馈限位板W8和外力反馈压力传递板W6中间设置有外力反馈压力传感器W7；外力反馈弹簧W5将外力反馈轴套W4压紧于外力反馈蜗杆W2的轴端，将外力反馈压力传递板W6压紧于外力反馈压力传感器W7。

第一个操作关节B1首端连接有空心操作转轴B14，并通过空心操作转轴B14可转动的固定于操作臂固定座21；第一个位置传感器Q1用于检测空心操作转轴B14相对操作臂固定座21的转动角度；空心操作转轴B14连接有第一个外力反馈装置W；其中外力反馈涡轮W1套置于空心操作转轴B14上；第一个操作关节B1内可转动的配合有四根自外向内依次穿套的一级空心操作转轴B13，第一根一级空心操作转轴B131的一端和第一个一级主动操作齿轮B111连接；第二个位置传感器Q2用于检测第一根一级空心操作转轴B131相对操作臂固定座21的转动角度；第一根一级空心操作转轴B131连接有第二个外力反馈装置W；其中外力反馈涡轮W1套置于第一根一级空心操作转轴B131上；第二根一级空心操作转轴B132的一端和第二个一级主动操作齿轮B112连接；第三个位置传感器Q3用于检测第二根一级空心操作转轴B132相对操作臂固定座21的转动角度；第二根一级空心操作转轴B132连接有第三个外力反馈装置W；其中外力反馈涡轮W1套置于第二根一级空心操作转轴B132上；第三根一级空心操作转轴B133的一端和第三个一级主动操作齿轮B113连接；第四个位置传感器Q4用于检测第三根一级空心操作转轴B133相对操作臂固定座21的转动角度；第三根一级空心操作转轴B133连接有第四个外力反馈装置W；其中外力反馈涡轮W1套置于第三根一级空心操作转轴B133上；第四根一级空心操作转轴B134的一端和第四个一级主动操作齿轮B114连接；第五个位置传感器Q5用于检测第四根一级空心操作转轴B134相对操作臂固定座21的转动角度；第四根一级空心操作转轴B134连接有第五个外力反馈装置W；其中外力反馈涡轮W1套置于第四根一级空心操作转轴B134上；各外力反馈电机W11均固定于操作臂固定座21；各外力反馈轴套W4均可在操作臂固定座21内转动和滑动；各外力反馈传动轴W3两端的两个外力反馈限位板W8均固定于操作臂固定座21。

各个外力反馈电机W11均由控制器进行控制；各个外力反馈压力传感器W7测量值均传输至控制器。

各外力反馈装置W还包括外力反馈限位板调整板W12；各远离外力反馈电机W11的外力反馈限位板W8均通过外力反馈限位板调整板W12固定于操作臂固定座21；通过调整各外力反馈限位板调整板W12可调整各远离外力反馈电机W11的外力反馈限位板W8沿着各外力反馈传动轴W3轴向的位置；

各外力反馈传动轴W3截面可加工成多边形并且相应的外力反馈蜗杆W2轴向内部也加工成适配的多边形。

操作臂22的工作原理：操作者通过手持部23主动操作操作臂22时，各操作关节B和操作转动杆B41的动作传到动空心操作转轴B14和第一根一级空心操作转轴B131至第四根一级空心操作转轴B134，由于蜗轮蜗杆传动时，若涡轮主动转动，则涡轮蜗杆具有自锁作用，因此空心操作转轴B14和第一根一级空心操作转轴B131至第四根一级空心操作转轴B134产生相应的转动趋势；以下以空心操作转轴B14及其连接的第一个外力反馈装置W为例进行说明，空心操作转轴B14产生相应的转动趋势后，外力反馈蜗杆W2沿着外力反馈传动轴W3的轴向滑动，两侧的外力反馈压力传感器W7测量值发生变化并传输至控制器，控制器通过外力反馈压力传感器W7测量值的变化值结合传动关系、操作臂22的姿态和操作臂22各部件的自重可以计算出空心操作转轴B14所受的操作力并传输至控制器；只有当空心操作转轴B14所受的操作力大于等于最小空心操作转轴操作力设定值且小于等于最大空心操作转轴操作力设定值时，空心操作转轴B14进行动作，否则空心操作转轴B14不动作。同样的，对于各一级空心操作转轴B13，只有当各一级空心操作转轴B13所受的操作力大于等于相应各最小一级空心操作转轴操作力设定值且小于等于相应各最大一级空心操作转轴操作力设定值时，各一级空心操作转轴B13进行动作，否则各一级空心操作转轴B13不动作。这样可以使操作者操作时手部感受到一定的阻力，增加操作体验感；当空心操作转轴B14或各一级空心操作转轴B13所受的操作力过大时不动作，同时控制器进行报警，提示操作力异常，这样可以有效防止操作者误操作。

另外，当操作臂22不被操作时，可对各外力反馈电机W11恢复初始位置，也就是各外力反馈电机W11的输出轴回到初始的角度，以使操作臂22恢复初始位置。

机器人仿型操作的工作原理：第一个位置传感器Q1到第五个位置传感器Q5的测量值均传输至控制器；控制器通过第一个位置传感器Q1至第五个位置传感器Q5的测量值分别得到空心操作转轴B14、第一根一级空心操作转轴B131至第四根一级空心操作转轴B134相对操作臂固定座21的转动角度S1、S2、S3、S4、S5；进而通过控制第一个空心轴执行电机131的输出轴至第五个空心轴执行电机135的输出轴分别转动角度S1、S2、S3、S4、S5，使得空心执行转轴A14、第一根一级空心执行转轴A131至第四根一级空心执行转轴A134分别转动角度S1、S2、S3、S4、S5；从而执行部分1完全模仿操作部分2的动作而动作，实现仿形操作。

外力检测-外力反馈工作原理：控制器获取第一个外力检测装置R至第五个外力检测装置R的外力检测压力传感器R4的测量值，并结合传动关系、执行臂11的姿态和执行臂11各部件的自重计算出执行臂11各执行关节A和执行转动杆A41所受到的外力，控制器根据计算出的执行臂11各执行关节A和执行转动杆A41所受到的外力控制第一个外力反馈装置W至第五个外力反馈装置W的外力反馈电机W11进行动作，通过第一个外力反馈装置W至第五个外力反馈装置W使相应的操作关节B和操作转动杆B41对操作者手部产生和相应的执行关节A和执行转动杆A41所受到的外力相应的力，以实现外力反馈，这样可以增强操作者手部的体验感和操作的准确性。

参照附图6，手持部23上设置有控制按钮231。控制按钮231的触发信号传输至控制器。当控制器接收到控制按钮231的触发信号后，控制器控制第一个外力反馈装置W至第五个外力反馈装置W的外力反馈电机W11进行动作，通过第一个外力反馈装置W至第五个外力反馈装置W使相应的操作关节B和操作转动杆B41对操作者手部产生和相应的执行关节A和执行转动杆A41所受到的外力相应的力，这样操作者一触发控制按钮231，手部就可以接受到执行臂11所受外力的反馈，进而判断出执行臂11受力状态。

实施例3

参照附图11-13，机器人仿型控制装置，实施例3和实施例2唯一的区别在于，执行臂驱动端12可分拆为执行更换部17和执行固定部16；第一个空心轴执行电机131至第五个空心轴执行电机135均固定于执行固定部16；第一个空心轴执行电机131控制空心操作转轴B14的转动；第二个空心轴执行电机132至第五个空心轴执行电机135分别控制第一根一级空心操作转轴B131至第四根一级空心操作转轴B134的转动；执行臂11和执行更换部17连接；执行更换部17和执行固定部16可分离连接；这样执行更换部17及其连接的执行臂11可进行更换，并且极大的降低了执行部分1的更换成本。

本发明使用时，通过控制操作臂22实现对执行臂11的控制；当执行臂11的数量大于等于2时，需要对控制器进行切换设置，以实现一个操作臂22控制两个及以上执行臂11的动作；控制器和执行部分1或操作部分2中的一个为无线连接时，本发明即可实现远程操作、远程控制。

上述实施例和图式并非限定本发明的产品形态和式样，任何所属技术领域的普通技术人员对其所做的适当变化或修饰，皆应视为不脱离本发明的专利范畴。

Claims

1.机器人仿型控制方法，其特征在于，包括如下步骤，

步骤一，使操作臂的姿态发生变化；

步骤二，控制器获取操作臂的姿态变化数值；

2.根据权利要求1所述机器人仿型控制方法，其特征在于，所述步骤一中，只有当操作臂各关节所受的操作力大于等于最小操作力设定值且小于等于最大操作力设定值时，操作臂的姿态发生变化，否则，操作臂的姿态不发生变化。

3.根据权利要求1所述机器人仿型控制方法，其特征在于，所述步骤四中，控制器获取执行臂各关节所受外力，并根据获取的执行臂各关节所受外力向操作臂相应各关节施加相应的力。

4.机器人仿型控制装置，其特征在于，包括执行部分、操作部分和控制器；

所述执行部分包括执行臂和执行臂驱动端；所述执行臂包括n个执行关节，n为大于等于3的整数；i为1至n-1的整数，j为1至n-2的整数，p为1至n的整数；其中第i个执行关节的末端通过第i连接轴与第i+1个执行关节的首端铰接；第i个执行关节的末端配合有n-i+1个依次同轴叠放在一起的i级主动执行齿轮；第i连接轴上套置有n-i+1个i级过渡执行齿轮，第一个i级过渡执行齿轮至第n-i+1个i级过渡执行齿轮与第一个i级主动执行齿轮至第n-i+1个i级主动执行齿轮分别一一对应垂直啮合，第一个i级过渡执行齿轮与第i+1个执行关节的首端固定连接；第j+1个执行关节的首端配合有n-j个依次同轴叠放在一起j级从动执行齿轮，第一个j级从动执行齿轮至第n-j个j级从动执行齿轮与第二个j级过渡执行齿轮至第n-j+1个j级过渡执行齿轮分别一一对应垂直啮合；第n个执行关节的首端配合有一个n-1级从动执行齿轮，所述n-1级从动执行齿轮与第二个n-1 级过渡执行齿轮垂直啮合；第一个执行关节首端连接有一空心执行转轴；第i个执行关节内可转动的配合有n-i+1根自外向内依次穿套的i级空心执行转轴；第一个执行关节内的第p根一级空心执行转轴的一端分别和第p个一级主动执行齿轮连接；第j+1个执行关节末端的第一个j+1级主动执行齿轮至第n-j个的j+1级主动执行齿轮与第j+1个执行关节首端的第一个j级从动执行齿轮至第n-j个j级从动执行齿轮分别通过第j+1个执行关节内的第一根j+1级空心执行转轴至第n-j根j+1级空心执行转轴一一对应同轴连接；第n个执行关节中可转动配合有一与第n个执行关节首端的n-1级从动执行齿轮同轴连接的执行转动杆；

所述执行臂驱动端包括执行电机固定板，所述执行电机固定板上固定有n+1个依次同轴叠放的空心轴执行电机；各空心轴执行电机均连接有外力检测装置；所述外力检测装置包括外力检测行星齿轮系、外力检测法兰轴套、外力检测限位块和外力检测压力传感器；所述外力检测行星齿轮系包括外力检测小太阳轮、外力检测行星轮、外力检测大太阳轮和外力检测行星架；所述外力检测法兰轴套的法兰端固定于外力检测大太阳轮的端面；所述外力检测行星架的圆周面上相向设置有两个向外凸出的外力检测压力传递块；外力检测限位块设置有向内凹陷的外力检测压力传感器固定槽；外力检测压力传感器固定槽的两侧均固定有所述外力检测压力传感器；外力检测压力传递块卡入两个外力检测压力传感器之间；

第一个空心轴执行电机的输出轴通过第一个外力检测装置和空心执行转轴同轴连接；第二个空心轴执行电机的输出轴至第n+1个空心轴执行电机的输出轴分别依次通过第二个外力检测装置至第n+1个外力检测装置和第一根一级空心执行转轴至第n根一级空心执行转轴同轴连接；其中各外力检测行星架分别可转动的固定于所述执行电机固定板；各外力检测限位块分别固定于所述执行电机固定板；

所述第一个空心轴执行电机至第n+1个空心轴执行电机的动作均由所述控制器进行控制；第一个外力检测装置至第n+1个外力检测装置的外力检测压力传感器的测量值均传输至所述控制器；

所述操作部分包括操作臂固定座、操作臂和手持部；所述操作臂可转动的固定于所述操作臂固定座；所述手持部可转动的固定于所述操作臂；

所述操作臂包括n个操作关节，其中第i个操作关节的末端通过第i铰接轴与第i+1个操作关节的首端铰接，第i个操作关节的末端配合有n-i+1个依次同轴叠放在一起的i级主动操作齿轮；第i铰接轴上套置有n-i+1个i级过渡操作齿轮，第一个i级过渡操作齿轮至第n-i+1个i级过渡操作齿轮与第一个i级主动操作齿轮至第n-i+1个i级主动操作齿轮分别一一对应垂直啮合，第一个i级过渡操作齿轮与第i+1个操作关节的首端固定连接；第j+1个操作关节的首端配合有n-j个依次同轴叠放在一起的j级从动操作齿轮，第一个j级从动操作齿轮至第n-j个j级从动操作齿轮与第二个j级过渡操作齿轮至第n-j+1个j级过渡操作齿轮分别一一对应垂直啮合；第n个操作关节的首端配合有一个n-1级从动操作齿轮，所述n-1级从动操作齿轮与第二个n-1级过渡操作齿轮垂直啮合；第一个操作关节首端连接有一空心操作转轴；第i个操作关节内可转动的配合有n-i+1根自外向内依次穿套的i级空心操作转轴；第一个操作关节内的第p根一级空心操作转轴一端分别和第p个一级主动操作齿轮连接；第j+1个操作关节末端的第一个j+1级主动操作齿轮至第n-j个的j+1级主动操作齿轮与第j+1个操作关节首端的第一个j级从动操作齿轮至第n-j个j级从动操作齿轮分别通过第j+1个操作关节内的第一根j+1级空心操作转轴至第n-j根j+1级空心操作转轴一一对应同轴连接；第n个操作关节中可转动配合有一与第n个操作关节首端的n-1级从动操作齿轮同轴连接的操作转动杆；所述操作转动杆和手持部连接；

所述操作臂固定座内固定有第一个位置传感器至第n+1个位置传感器；第一个操作关节首端通过空心操作转轴可转动的固定于所述操作臂固定座；

所述空心操作转轴和第p根一级空心操作转轴均连接有外力反馈装置；所述外力反馈装置包括外力反馈涡轮、外力反馈蜗杆、外力反馈传动轴、外力反馈轴套、外力反馈弹簧、外力反馈压力传递板、外力反馈压力传感器、外力反馈限位板、外力反馈联轴器和外力反馈电机；外力反馈蜗杆和外力反馈涡轮啮合；外力反馈蜗杆可滑动的套置于外力反馈传动轴且外力反馈蜗杆相对于外力反馈传动轴不能转动；外力反馈传动轴的一端依次穿过外力反馈轴套、外力反馈弹簧、外力反馈压力传递板、外力反馈限位板通过外力反馈联轴器和外力反馈电机的输出轴连接；外力反馈传动轴的另一端依次穿过外力反馈轴套、外力反馈弹簧、外力反馈压力传递板、外力反馈限位板；外力反馈轴套、外力反馈压力传递板均可沿外力反馈传动轴的轴向滑动；外力反馈限位板和外力反馈压力传递板中间设置有外力反馈压力传感器；外力反馈弹簧将外力反馈轴套压紧于外力反馈蜗杆的轴端，将外力反馈压力传递板压紧于外力反馈压力传感器；

所述各外力反馈装置的外力反馈涡轮分别套置于空心操作转轴和第p根一级空心操作转轴上；各外力反馈电机均固定于操作臂固定座；各外力反馈轴套均可在操作臂固定座内转动和滑动；各外力反馈传动轴两端的两个外力反馈限位板均固定于操作臂固定座；

第一个位置传感器至第n+1个位置传感器的测量值均传输至所述控制器；所述各外力反馈压力传感器的测量值均传输至所述控制器；所述各外力反馈电机均由所述控制器控制。

5.根据权利要求4所述的机器人仿型控制装置，其特征在于，所述外力反馈装置还包括外力反馈限位板调整板；远离外力反馈电机的外力反馈限位板通过外力反馈限位板调整板固定于所述操作臂固定座；通过调整所述外力反馈限位板调整板可调整远离外力反馈电机的外力反馈限位板沿着各外力反馈传动轴轴向的位置。

6.根据权利要求4所述的机器人仿型控制装置，其特征在于，所述外力反馈传动轴截面可加工成多边形并且外力反馈蜗杆轴向内部也加工成适配的多边形。

7.根据权利要求4所述的机器人仿型控制装置，其特征在于，所述执行臂驱动端可分拆为执行更换部和执行固定部；第一个空心轴执行电机至第n+1个空心轴执行电机均固定于所述执行固定部；第一个空心轴执行电机控制空心操作转轴的转动；第二个空心轴执行电机至第n+1个空心轴执行电机分别控制第一根一级空心操作转轴至第n根一级空心操作转轴的转动；所述执行臂和所述执行更换部连接；所述执行更换部和所述执行固定部可分离连接。