一种具有机械臂的力觉操作器.pdf

本发明公开了一种具有机械臂的力觉操作器，其包含六个转动关节，因此它具有六个自由度。采用类似工业机械臂的串联连杆方式布置，第一关节在最底部，第六关节在最末端。第二、三关节处采用了平行连杆机构的布置方式，将第三关节电机放置于转盘上，角度传感器放置在关节轴线上，这种方式在保证了位置精度和结构刚度的同时，也减小了结构的转动惯量。下面三个关节中，采用带有张紧装置的绳传动机构，保证无间隙的情况下，提供了大的力反馈能力；上面的三个关节采用直接传动驱动。从第一关节到第五关节的关节轴处都是采用的U型拨叉的连接方式，保证了结构强度和精度。

权利要求书
1.  一种具有机械臂的力觉操作器，其特征在于：包含六个转动关节，因此它具有六个自 由度。采用类似工业机械臂的串联连杆方式布置，第一关节在最底部，第六关节在最末端。 第二、三关节处采用了平行连杆机构的布置方式，将第三关节电机放置于转盘上，但角度传 感器任放置在关节轴线上，在保证了位置精度和结构刚度的同时，也减小了结构的转动惯量。 下面三个关节中，采用带有张紧装置的绳传动机构，保证无间隙的情况下，提供了大的力反 馈能力；上面的三个关节采用直接传动驱动。从第一关节到第五关节的关节轴处都是采用的 U型拨叉的连接方式，保证了结构强度和精度。

2.  根据权利要求1所述的一种具有机械臂的力觉操作器，其特征在于：设备最远端的 第六关节控制着末端姿态中的偏航自由度，它由操作手柄、力矩电机以及角度传感器构成， 电机与角度传感器在转轴方向上顺序连接，传动方式为直接驱动；与第六关节连接的是第五 关节；
第五关节的主体是一个U型拨叉，拨叉的两端分别固定驱动电机和角度传感器；第五关 节的轴通过螺钉与第六关节的主体部分连接。第六关节相对与第五关节的位置可调节；第五 关节采用直接驱动的方式，电机与角度传感器分别布置于转轴的两端；第五关节控制着末端 姿态的俯仰自由度；
第四关节控制着末端姿态的翻滚自由度，通过连杆与第五关节的拨叉连接，第四关节上 力矩电机与角度传感器在转轴方向上顺序连接，传动方式为直接驱动。
第三关节与第二关节分别控制着末端的两个位置自由度；第三关节与第二关节分布于平 行连杆结构的两个转轴上，第三关节处于上方位置，与第四关节靠近，第二关节在下方位置； 第三关节的角度传感器固定在关节轴向上，但是，驱动电机放置于下方的转盘上，电机的驱 动力通过绳传动机构和平行连杆结构传递到第三关节上；第二关节的角度传感器也固定于此 关节的轴线上，固定在转盘上控制电机也采用绳传动机构，将驱动力传递到第二关节的轴线 上；
第一关节位于最下面的底板上，它控制着末端位置的一个自由度；第一关节的关节轴与 安装第二关节、第三关节电机的转盘固定连接。此关节转动时，将带动整个转盘以及转盘上 各部分一起转动。第一关节采用绳传动结构，电机固定在底座上，底座是整个设备的支撑。 角度传感器于关节轴的轴线上固定；第一关节与底座紧密的联系在一起。在底座上固定有第 一关节的主体部分、手柄回零结构、电气连接件以及控制电路。

说明书一种具有机械臂的力觉操作器
技术领域
本发明涉及一种力学操作器，具体来说，是一种多自由度的、带有力反馈能力的握持式 机械臂通用力觉操作器。
背景技术
随着通信技术、计算机技术以及大规模集成电子技术在上世纪的70年代后期的充分发 展，使得遥操作技术的需求得到了增强，主从设备的发展也渐渐的成为热门方向，随着虚拟 现实技术的快速的崛起，主从式遥操作也发生了一些实质性的变化。今天，遥操作技术和虚 拟交互技术已经相互融合，而且迅速的发展。而本设备的发明也正是依托了主从式遥操作技 术和虚拟交互技术发展的成果。
一般的力觉操作器按照结构形式的特点可划分：①基于串联连杆的力觉操作器；②基于 并联连杆的力觉操作器；③基于直线运动副的力觉操作器；④基于外骨骼式的力觉操作器； ⑤基于线牵引式的力觉操作器。
但是，一般的遥操作设备和力觉交互操作器的控制对象多是一些较少自由度、小惯量的 实物设备或者是虚拟环境中的虚拟物体，这些被控对象本身可以反馈位置、速度或者力的信 息给操作器，实现精确的力觉临场感和力反馈精度。这也导致了这些力觉交互操作器的工作 空间小、力反馈能力有限，不利于握持的缺点。而如果要控制的设备都是具有大质量、大惯 量、大刚度和低速低频的机械臂或起重机。而且这些大型设备上往往也没法安装能够反馈自 身状态的传感器。因此，一般的操作器设备很难应用于该领域。本设备发明正是为了弥补传 统的力觉操作设备在这些方面的不足。由于控制对象的不同，所以此设备在设计过程中所关 注的各种性能指标，也异于其他的设备。尤其是在工作空间、反馈力大小、握持方式以及通 用性等方面，传统的力觉操作器多没法满足要求，同时，关注指标的不同也导致了结构形式 的差异。
发明内容
本发明的目的是设计一种多自由度的，带有力反馈能力的机械臂通用力觉操作器，是一 种基于串联连杆结构的，采用手掌握持方式操作的，具有大工作空间，具有大反馈力的多自 由度通用型的力觉操作器，主要运用在大型机械臂操作、大型多自由起重机操作以及虚拟环 境交互仿真等领域。
本发明具有机械臂的力觉操作器，包含六个转动关节，因此它具有六个自由度。采用类 似工业机械臂的串联连杆方式布置，第一关节在最底部，第六关节在最末端。第二、三关节 处采用了平行连杆机构的布置方式，将第三关节电机放置于转盘上，但角度传感器任放置在 关节轴线上，在保证了位置精度和结构刚度的同时，也减小了结构的转动惯量。下面三个关 节中，采用带有张紧装置的绳传动机构，保证无间隙的情况下，提供了大的力反馈能力；上 面的三个关节采用直接传动驱动。从第一关节到第五关节的关节轴处都是采用的U型拨叉的 连接方式，保证了结构强度和精度。
本发明中最远端的第六关节控制着末端姿态中的偏航自由度，它由操作手柄、力矩电机 以及角度传感器构成，电机与角度传感器在转轴方向上顺序连接，传动方式为直接驱动；与 第六关节连接的是第五关节。
第五关节的主体是一个U型拨叉，拨叉的两端分别固定驱动电机和角度传感器；第五关 节的轴通过螺钉与第六关节的主体部分连接。第六关节相对与第五关节的位置可调节；第五 关节采用直接驱动的方式，电机与角度传感器分别布置于转轴的两端；第五关节控制着末端 姿态的俯仰自由度。
第四关节控制着末端姿态的翻滚自由度，通过连杆与第五关节的拨叉连接，第四关节上 力矩电机与角度传感器在转轴方向上顺序连接，传动方式为直接驱动。
第三关节与第二关节分别控制着末端的两个位置自由度；第三关节与第二关节分布于平 行连杆结构的两个转轴上，第三关节处于上方位置，与第四关节靠近，第二关节在下方位置； 第三关节的角度传感器固定在关节轴向上，但是，驱动电机放置于下方的转盘上，电机的驱 动力通过绳传动机构和平行连杆结构传递到第三关节上；第二关节的角度传感器也固定于此 关节的轴线上，固定在转盘上控制电机也采用绳传动机构，将驱动力传递到第二关节的轴线 上。
第一关节位于最下面的底板上，它控制着末端位置的一个自由度；第一关节的关节轴与 安装第二关节、第三关节电机的转盘固定连接。此关节转动时，将带动整个转盘以及转盘上 各部分一起转动。第一关节采用绳传动结构，电机固定在底座上，底座是整个设备的支撑。 角度传感器于关节轴的轴线上固定；第一关节与底座紧密的联系在一起。在底座上固定有第 一关节的主体部分、手柄回零结构、电气连接件以及控制电路。
本发明的优点在于：
1、本发明力觉操作器采用六自由度的串联结构，使得具有了全空间的位置姿态的感知能 力，同时在每个关节上都安装了电机，实现了全空间位置姿态的力觉反馈能力；
2、本发明力觉操作器中第二关节与第三关节采用采用平行连杆形式的结构方式布置，使 得操作器在不减小工作空间的情况下，获得了更大的结构刚度和更灵活的驱动器布置方式；
3、本发明力觉操作器采用绳驱动的优点在于增加传递扭矩的同时也可以消除结构的间 隙，实现真正的无间隙传动；且直接驱动的方式更是将传动环节的误差完全消除，更进一步 的提高的设备的精度。
附图说明
图1为本发明力觉操作器整体结构图示意图；
图2为本发明力觉操作器中第一关节结构示意图；
图3为本发明力觉操作器中转动盘底面所安装结构示意图；
图4为第一关节张紧机构结构示意图；
图5为本发明力觉操作器中第二关节结构示意图；
图6为本发明力觉操作器中第三关节及第四关节结构示意图；
图7为本发明力觉操作器中第五关节及第六关节结构示意图；
图8为本发明力觉操作器安装外壳后的结构示意图。
图中：
1-第一关节               2-第二关节               3-第三关节
4-第四关节               5-第五关节               6-第六关节
7-静平衡机构             8-套筒                   9-回零定位杆
10-保护壳                101-转动盘               102-第一关节转轴
103-第一关节驱动机构     104-第一关节角度传感器   103a-第一关节驱动电机
103b-第一关节扇形传动盘  103c-第一关节驱动传动轮  103d-第一关节驱动钢丝绳
103e-第一关节张紧机构    103b1-安装座A            103b2-安装座B
103e1-连接头             103e2-张紧调节螺母       103e3-张紧调节螺栓
103e4-止动螺钉           103e5-导向柱             201-左支架
202-右支架               203-第二关节转轴         204-传动轴
205-大臂连杆             206-第二关节连接架       207-第二关节驱动机构
208-角度测量轴           209-第二关节角度传感器   207a-第二关节驱动电机
207b-第二关节扇形传动盘  207c-第二关节驱动传动轮  207d-第二关节驱动钢丝绳
207e-第二关节张紧机构    301-第三关节连接架       302-摇臂
303-第三关节转轴         304-第三关节驱动机构     305-第三关节角度传感器
304a-第三关节驱动电机    304b-第三关节扇形传动盘  304c-第三关节驱动传动轮
304d-第三关节驱动钢丝绳  304e-第三关节张紧机构    304f-曲柄
304g-小臂连杆            304h-连接块              304i-驱动连接架
304j-驱动转轴            304k-连接轴              401-第四关节驱动电机
402-第四关节转轴         403-旋转臂               404-旋转臂连接件
405-第四关节角度传感器   501-第五关节连接架；     502-第五关节驱动电机
503-第五关节电机外壳     504-连接转轴             505-第五关节角度传感器
601-第六关节驱动电机     602-第六关节电机外壳     603-操作手柄
604-第六关节角度传感器   605-连接板
具体实施方式
下面将结合附图对本发明做进一步的详细说明。
本发明具有机械臂的力觉操作器具有六个关节，整体结构为带有平行连杆的串联连杆结 构，每个关节控制着机械臂末端执行器的一个自由度。如图1所示，六个关节中，第一关节 1、第二关节2与第三关节3为底部三关节；第一关节1用来控制被控机械臂的末端执行器水 平转动，第二关节2用来控制被控机械臂的末端执行器前后摆动，第三关节3用来控制被控 机械臂的末端执行器上下摆动。第四关节4、第五关节5与第六关节6为末端三关节；第四 关节4用来控制被控机械臂的末端执行器翻滚；第五关节5控制被控机械臂的末端执行器俯 仰姿态，第六关节6控制被控机械臂末端执行器的偏航。
所述第一关节1安装在底座11上，包括转动盘101、第一关节转轴102与第一关节驱动 机构103，如图2、图3所示。其中，第一关节转轴102与转动盘101同轴固连。第一关节转 轴102通过上下两个深沟球轴承安装在底座7上表面同轴设计的套筒8内，使转动盘101与 底座7平行。两个深沟球轴承中，位于下方的深沟球轴承外圈通过套筒8内壁周向上设计的 台肩实现定位；两个深沟球轴承内圈间通过第一关节转轴102上套接的轴圈定位；位于上方 的深沟球轴承外圈通过套筒8顶部安装挡圈定位；第一关节转轴102通过周其顶端周向上设 计的台肩，固定于上方深沟球轴承内圈；由此可使转动盘101相对底座7转动，通过第一关 节驱动机构103实现。第一关节转轴102底端安装有第一关节角度传感器104，通过第一关 节角度传感器104测量第一关节1的转动角度。第一关节转轴102上设计有一个突耳A，在 套筒顶端周向上设计有两个突耳B，通过突耳A与两个突耳B在转动盘101转动过程中的干 涉，实现第一关节1的转动限位。
上述第一关节驱动机103构采用绳传动的驱动方式，包括第一关节驱动电机103a、第一 关节扇形传动盘103b、第一关节传动轮103c、第一关节驱动钢丝绳103d与第一关节张紧机 构103e，如图3所示。其中，第一关节驱动电机103a固定安装在底座7上表面，输出轴轴线 垂直于水平面，输出轴上同轴固定安装有第一关节传动轮103c。第一关节驱动钢丝绳103d 为两根，均缠绕在第一关节传动轮103c外壁周向上的设计的螺旋槽内，且通过第一关节传动 轮103c轴向中部设计的环形隔板相隔，使两根第一关节驱动钢丝绳103d不会在缠绕过程中 发生干涉。两根第一关节驱动钢丝绳103d的固定端均固定于第一关节传动轮103c上，传动 端用来连接镂空设计的第一关节扇形传动盘103b。第一关节扇形传动盘103b的扇面固定安 装在转动盘101下表面，圆心角靠近转动盘101中心位置。第一关节扇形传动盘103b的两侧 面(半径所在平面)上各安装有一套第一关节张紧机构103e；两根第一关节驱动钢丝绳103d 的传动端分别沿第一关节扇形转动盘103b弧形面，由第一关节驱动钢丝绳103d弧形面两端 固定于第一关节张紧机构103e上，且使第一关节驱动钢丝绳103d平行于水平面；由此通过 第一关节驱动电机103a带动第一关节传动轮103c转动，使两根第一关节驱动钢丝绳103d中 的一个在第一关节传动轮103c上缠绕，另一个释放，拉动第一关节扇形传动盘103b转动， 进而实现转动盘101的转动。上述第一关节驱动钢丝绳103d位于第一关节扇形传动盘103b 弧形面上沿弧向设计的凹槽内，实现第一关节驱动钢丝绳10的限位，使第一关节扇形传动盘 103b转动过程中，第一关节驱动钢丝绳103d不会脱离第一关节扇形传动盘103b。
上述第一关节张紧机构103e用来固定第一关节驱动钢丝绳103d的传动端，同时实现第 一关节驱动钢丝绳103d的张紧；第一关节张紧机构103e包括连接头103e1、张紧调节螺母 103e2与张紧调节螺栓103e3，如图4所示。其中，张紧调节螺栓103e3沿第一关节扇形传动 盘103b半径方向设置，螺纹安装在第一关节扇形传动盘103b侧面上设计的一体化安装座 A103b1上，轴线与第一关节扇形传动盘103b侧面平行。张紧调节螺母103e2具有轴向上的 长度，一端螺纹安装在张紧调节螺栓103e3上，另一端螺纹连接有连接头103e1，通过连接头 103e1上设计的轴肩实现与张紧调节螺母103e2间的定位；通过旋拧张紧调节螺栓103e3或张 紧调节螺母103e2，可实现第一关节驱动钢丝绳103d的张紧力控制。为了使第一关节扇形传 动盘两端受第一关节驱动钢丝绳103d牵引力位置对称，因此将第一关节扇形传动盘103b上 的两侧面上的第一关节张紧机构103e中连接头位于同一水平位置；但由于两根第一关节驱动 钢丝绳103d伸出端位于不同水平面上，若直接将两根第一关节驱动钢丝绳103d与两个第一 关节张紧机构103e，会使第一关节扇形传动盘103b的一侧受到第一关节驱动钢丝绳103d牵 引力的同时还受到其他方向的分力。因此，本发明中在保证一根第一关节驱动钢丝绳103d与 第一关节张紧机构103e连接后处于平行水平面状态时，另一根第一关节驱动钢丝绳103d由 安装于第一关节扇形传动盘侧面上的导向柱103e5绕过，进行导向后，再连接第一关节张紧 机构103e，进而使两根第一关节驱动钢丝绳103d连接后均与水平面平行。
本发明中在在进行装配时，第一关节驱动钢丝绳103d与连接头103e1固定前，先由钢丝 绳穿孔穿过第一关节扇形传动盘103b侧面设计的一体化安装座B103b2上的钢丝绳穿孔；钢 丝绳穿孔与竖直螺钉孔连通，螺钉孔用来安装止动螺钉103e4，使止动螺钉103e4轴线垂直于 第一关节扇形传动盘103b侧面，且与张紧调节螺栓103e3轴线相交；由此，在进行装配时， 第一关节驱动钢丝绳103d先由钢丝绳穿孔穿过，通过拧紧止动螺钉103e4将第一关节驱动钢 丝绳103d压紧，锁定第一关节驱动钢丝绳103d位置，进而可方便第一关节驱动钢丝绳103d 与连接头103e1间的连接。装配完毕后，即可松开止动螺钉103e4，进行第一关节驱动钢丝绳 103d张紧力调节。
所述第二关节2与第三关节3分别通过第二关节驱动机构207与第三关节驱动机构304 驱动运动，如图5、图6所示，采用平行连杆形式的结构方式布置。所述第二关节2包括左 支架201、右支架202、第二关节转轴203、传动轴204、大臂连杆205、第二关节连接架206； 第三关节3包括第三关节连接架301、摇臂302与第三关节转轴303。
第二关节中，左支架201与右支架202固定安装在转动盘101上表面两侧，左支架201 上安装有第二关节转轴203，使第二关节转轴203轴线与水平面平行。第二关节转轴203通 过周向上设计的台肩分隔为第二关节转轴安装端与第二关节转轴连接段；第二关节转轴连接 段插入左支架201上开设的安装孔内，通过台肩实现与左支架201间的定位；第二关节转轴 安装段上套接深沟球轴承，通过深沟球轴承安装在U型拨叉结构的第二关节连接架206左端 上开设的安装孔内，通过台肩实现深沟球轴承内圈的定位。传动轴204通过周向上设计的台 肩分隔为传动轴安装段与传动轴连接段；传动轴连接段上套有两个深沟球轴承，通过两个深 沟球轴承安装在右支架202上开设的安装孔内，使传动轴204与第二关节转轴203筒同轴设 置；且两个深沟球轴承中，位于外侧的深沟球轴承内圈两端分别通过传动轴204上台肩以及 传动轴连接段上两个深沟球轴承间套接的轴圈定位，外圈通过右支架202上安装孔内壁周向 上设计的台肩定位；位于内侧的深沟球轴承两端分别通过轴圈以及右支架202内侧壁安装孔 处安装的端盖定位。传动轴安装段上套接有一个深沟球轴承；通过深沟球轴承安装在第二关 节连接架206右端开设的安装孔内，通过传动轴204上的台肩实现深沟球轴承内圈的定位。 大臂连杆205底端固定安装在第二关节连接架206顶部。
第三关节中，第三关节连接架301为U型拨叉结构，底端与大臂连杆205顶端固定；第 三关节连接架301两端通过深沟球轴承安装有第三关节转轴303，两个第三关节转轴303分 别与摇臂302两侧固连。
上述第二关节驱动机构207与第三关节驱动机构304中，均具有与第一关节驱动机构103 组成部份，且各部分之间的连接方式也与第一关节驱动机构103相同，即第二关节驱动机构 207包括第二关节驱动电机207a、第二关节扇形传动盘207b、传动轮207c、第二关节驱动钢 丝绳207d与第二关节张紧机构207e；第三关节驱动机构304包括第三关节驱动电机304a、 第三关节扇形传动盘304b、第三关节驱动传动轮304c、第三关节驱动钢丝绳304d与第三关 节张紧机构304e；区别仅在于第二关节扇形连接盘207b与第三关节扇形连接盘304b的两侧 面相交位置设计有一体化的连接法兰盘。同时，第三关节驱动机构304还具有曲柄304f与小 臂连杆304g、连接块304h、驱动连接架304i与驱动转轴304j。
其中，第二关节驱动机构207中，第二关节扇形传动盘207b竖直设置，连接法兰盘固定 安装在第二关节连接架206左端外侧，通过连接法兰盘周向上设计的台肩实现第二关节转轴 安装端上深沟球轴承外圈的定位，且通过连接法兰盘与左支架201外侧面实现第二关节连接 架206左端的定位。第二关节驱动电机207a通过支撑架安装在转动盘101上表面。
第三关节驱动机构304中，第三关节扇形传动盘304b竖直设置，连接盘固定安装在传动 轴204外端，通过连接盘周向上设计的台肩实现传动轴安装段上的深沟球轴承外圈的定位。 曲柄304f一端与传动轴204内端固定；另一端具有一体结构的连接轴304k，连接轴304k轴 线与水平面平行；连接轴304k插入连接块304h，与连接块间通过深沟球轴承相连。小臂连 杆304g底端与连接块304h固定，顶端与U型拨叉结构驱动连接架304i底端固定。驱动连接 架304i两端通过深沟球轴承安装有驱动转轴304j，两根驱动转轴304j分别与摇臂302两侧固 连；且保证小臂连杆304g与大臂连杆205轴线平行。上述摇臂302作为第四关节4的安装主 体，一方面用来安装第四关节4的第四关节驱动电机与第四关节转轴，另一方面与大臂连杆 205和小臂连杆304g间构成了平行四边形机构。
上述第二关节驱动机构207中第二关节驱动电机207a驱动第二关节驱动钢丝绳207d拉 动第二关节扇形传动盘207b，将扭矩传递至大臂连杆205中，实现被控机械臂末端执行器的 前后摆动控制，过程中小臂连杆304g与大臂连杆205相对位置不变。本发明中在第二关节转 轴采用空心转轴，内部同轴设置有角度测量轴208，角度测量轴208两端设计有连接法兰， 其中连接法兰与第二关节扇形传动盘207b外侧固定；另一端固定安装有角度传感器，用来实 现第二关节转角测量。第三关节驱动机构304中第三关节驱动电机304a驱动第三关节驱动钢 丝绳304d拉动第三关节扇形传动盘304b转动，将扭矩传递到传动轴204，经曲柄304f与小 臂连杆304g最终传递到摇臂302上，实现被控机械臂末端执行器的上下摆动控制。第三关节 驱动电机304a的输出轴通过联轴器连接有第三关节角度传感器305，用来实现第三关节3转 角测量。上述左支架201与右支架202的外侧面上安装有限位销，分别通过与第二关节扇形 传动盘207b、第三关节扇形传动盘304b侧面的干涉，实现第二关节转轴203与传动轮204 的转动范围限制，进而实现第二关节2与第三关节3的摆动限制。
所述第四关节4包括第四关节驱动电机401、第四关节转轴402与旋转臂403，如图7所 示。其中，第四关节驱动电机401同轴安装在摇臂302内，第四关节驱动电机401的输出轴 通过联轴器与摇臂302内同轴设置的第四关节转轴402后端相连，第四关节转轴前端通过旋 转臂连接件404同轴连接旋转臂403。第四关节转轴402前后两端套有深沟球轴承，前端深 沟球轴承内圈通过第四关节转轴402端部设计的台肩实现定位；外圈通过摇臂302前端内壁 设计的台肩定位。后端深沟球轴承内圈由旋转臂连接件404端部周向定位，外圈通过摇臂302 后端内壁设计的台肩定位。由此，通过第四关节驱动电机401带动旋转臂403，进而实现被 控机械臂的末端执行器翻滚姿态控制。上述第四关节驱动电机401的输出轴还通过联轴器连 接有第四关节角度传感器405，用来测量第四关节4旋转角度；同时，摇臂302侧面设计有 两个限位突耳A，同时在小臂连杆304g上安装也限位突耳B，由此在第四关节4转动过程中， 通过两个限位突耳A分别与限位突耳B间干涉，限制第四关节4的转角范围。
所述第五关节5、第六关节6轴线与第四关节轴线相交于一点，如图7所示，其中，第 六关节6包括第六关节驱动电机601、第六关节电机外壳602与操作手柄603；第六关节驱动 电机601安装在第六关节电机外壳602内，输出轴由第六关节电机外壳602顶部开设的轴孔 伸出，与轴孔间通过两个深沟球轴承固定，输出轴上固定安装操作手柄603；由此，通过第 六关节驱动电机601向操作手柄603传递扭矩，实现被控机械臂的末端执行器偏航控制。上 述第六关节驱动电机601的输出轴通过联轴器安装有第六关节角度传感器604，用来测量第 六关节运动角度；同时，在第六关节电机外壳602上部轴孔处设计有两个限位块，两个限位 块分别位于操作手柄底部开设的凹槽内，由此通过两个限位块分别与凹槽两端配合限制操作 手柄603的运动范围。
第五关节5包括第五关节连接架501、第五关节驱动电机502、第五关节电机外壳503与 连接转轴504；其中，第五关节连接架501同样为U型拨叉结构连接架，两端通过深沟球轴 承安装有连接转轴504，两个连接转轴504同轴，分别与第六关节电机外壳602两端，其中 一个连接转轴504与第五关节驱动电机502的输出轴同轴固定，第五关节驱动电机502安装 在第五关节电机外壳503内，第五关节电机外壳503固定安装在第五关节连接架501上。由 此通过第五关节驱动电机向操作手柄603传递扭矩，实现被控机械臂的末端执行器俯仰姿态 控制。上述另一个连接转轴504上安装有第五关节角度传感器505，用来实现第五关节5转 动角度的测量。为了限制第五关节的转角范围，在第五关节连接架501一端的内侧加装限位 销，通过限位销与第六关节电机外壳602的运动干涉，实现第五关节5转角的限制作用。本 发明中两个连接转轴504与第六关节电机外壳602间的连接采用可调节方式相连，具体为： 在第六关节电机外壳602两侧设计有两个连接板605，两个连接板605上均设计有竖直方向 的长孔。两个连接转轴504端部设计有通孔，分别对应两个连接板605上的长孔，通过螺钉 穿过，由螺母固定；由此，很方便的实现第六关节6相对于第五关节旋转轴线的重心位置调 节，实现第六关节6的静平衡。
由此通过上述结构力觉操作器，实现对被控机械臂的末端执行器三个方向的位置和姿态， 并通过各个关节处安装的角度传感器来获取末端执行器运动角度；同时通过被控机械臂反馈 的力信号，控制各个关节驱动电机转动，实现力反馈。
本发明力觉操作器上还设计有回零定位杆9，用来对各个初始姿态(零位)的定位。如 图1所示，回零定位杆9一端固定安装在底座11边缘位置，另一端顶部具有定位突起，通过 在第六关节6中第六关节电机外壳602底端面上设计定位凹槽，通过控制操作手柄603将定 位凹槽与定位突起配合对接，此时力觉操作器的姿态为初始姿态。同时，可通过加装保护壳 10对各个第一、二、三关节驱动机构进行保护如图8所示。