[发明专利]模块化主从操作机械臂控制主手

说明书

技术领域

本发明专利涉及模块化主从操作机械臂控制主手，尤其涉及一种用于主从操作机械臂控制指令采集与输出的模块化主从操作机械臂控制主手。

背景技术

主从操作是古老的操作方式，机器人是由此方式发展演变而来的。最早期的主从操作机器人，是结构相同的两套机构，分别放置在不同的地方，其中主机器人放置在一个安全或方便的地方，从机器人放在人不宜接近的地方，如有强辐射、高温、水下等环境。操作者根据传感器信息，如视觉、接触力觉、接近觉等来操作主机器人，主机器人与从机器人之间存在着机械耦合，并将主机器人运动传递给从机器人，从机器人就跟随主机器人的运动。

主从操作方式极大地延伸了机器人的应用空间，在许多危险的或极限环境下，采用机器人代替人是唯一可行办法。因此，人类在外层空间开发、海洋深水作业及核电站的检测与维护方面，都离不开主从式机器人。主从式机器人已成为上述领域不可缺少的设备。此外，在一些危险的、有毒有害的工业生产环境中，也是主从遥控机器人用武之地。

主从遥控机器人系统由三大部分组成:主机器人、从机器人和两者之间的关连部分。具体讲就是主手、从手和两者之间的通讯。

从手就是机械臂，它可以是关节式的或直角坐标式，取决于不同作业任务的需要。主手的功能是提供人机界面，操作人员通过主手施加控制命令。主手有着操作直观、控制系统简单等优点。它的缺点是不具有通用性，即一种类型的主手只能控制一种从手。针对不同的从手需要设计、制造不同类型的主手。

发明内容

本发明为了解决现有技术存在的上述不足，提供了一种模块化主从操作机械臂控制主手；本专利主手采用模块化设计，该主手能够根据从手（机械臂）结构进行调整，满足不同种类从手的主从控制要求，大大减少了主手设计、制造的难度与成本。

为实现上述目的，本发明专利采用如下技术方案：

一种模块化主从操作机械臂控制主手，包括操作手柄、控制系统、小臂连杆、大臂连杆、多个关节传感器，所述关节传感器内置线性电位计，操作手柄上设有按钮，所述关节传感器、按钮通过线缆与控制系统连接，所述控制系统与从机械臂通讯，所述操作手柄与六轴关节传感器的输入轴连接，所述六轴关节传感器的壳体与五轴关节传感器的输入轴接，所述五轴关节传感器壳体与小臂连杆一端连接，小臂连杆另一端与四轴传感器连接，所述四轴传感器的壳体与三轴关节传感器的输入轴连接，所述三轴关节传感器的壳体与大臂连杆一端连接，大臂连杆的另一端与二轴关节传感器输入轴连接，二轴关节传感器壳体与二轴机架连接，整个主手与一轴关节传感器连接。线缆将各关节传感器的电位信号和手柄按钮操作信号传递给控制盒，经处理后通过并口、或串口与从机械臂通讯。所述控制系统采用嵌入式控制系统。

四轴传感器的壳体与小平衡锤连接，由小平衡锤达到平衡小臂的自重的目的。

大臂连杆的另一端与大配重锤连接，由大配重锤达到平衡主手的自重和部分平衡力的目的。

关节传感器的数量和安装位置与从机械臂自由度一致。

关节传感器通过间隙可调的滑动轴承与输出轴连接。关节传感器能够承受轴向、径向载荷。关节传感器具有两种安装方式：外壳固定、输出轴旋转；输出轴固定、外壳旋转，以适合不同主手结构要求。

控制系统采用设于控制盒内的嵌入式控制系统。通过嵌入式控制系统采集各关节传感器的电压信号，并根据通信协议与从机械臂通讯。

关节传感器与并口连接，以并口方式直接输出电压。

操作手柄通过长条孔与螺纹连接，其中长条孔可以改变手柄的位置，螺纹可以调整手柄沿自身轴线的角度。通过调整这两个零件，可以自由调节手柄位置，适应不同操作习惯的要求。

本发明的工作原理：

使用时，操作人员操作手柄，操作手柄带动各个连杆与关节传感器运动，主手连杆尺寸与从机械臂尺寸成比例。关节传感器的数量和安装位置与从机械臂自由度一致。关节传感器内置线性电位计，将主手各关节的位置/速度信号转化成电压信号，该电压信号经处理后形成从机械臂各自由度控制指令。模块化主从操作机械臂控制主手只要通过改变连杆连接位置，或调整关节传感器的数量和安装位置，就可以实现不同结构尺寸的从机械臂主从控制。

本发明的有益效果：