液压机械臂遥操作控制系统和方法
【技术领域】
[0001] 本发明设及液压机械臂控制领域，特别是指一种基于力觉和视觉临场感的液压机 械臂遥操作控制系统和方法。
【背景技术】
[0002] 作为高新科技产业的标杆，机器人行业近几年发展迅猛，应用领域不断延伸，遥操 作机器人和工业机器人都在朝着智能机器人的方向发展，W完成操作者无法到达或危险环 境下的任务。机器人遥操作的控制理念是在保证系统安全性的基础上，增强机器人的操控 性能。
[0003] 鉴于遥操作机器人系统的固有特性，操作者在整个操纵作业过程中，处于远端安 全场所而无法亲身感知机器人作业现场的真实环境，只能依据反馈回的图像、声音、力/触 觉等辅助信息来完成作业任务，然而，由于受到机构、控制、人工智能和传感技术水平的限 审IJ，在对机械臂进行遥操作时，过多地依赖于操纵人员的技能水平和熟练程度，导致操控效 率低，同时，在注意力高度集中的状态下，长时间的操作极易造成操作者疲劳，安全性与操 控性难W兼得。
【发明内容】
[0004] 本发明要解决的技术问题是提供一种液压机械臂遥操作控制系统和方法，其能够 实现操作者和环境自然交互，有效地完成遥控作业任务，提高任务的执行效率。 阳005] 为解决上述技术问题，本发明提供技术方案如下：
[0006] 一种液压机械臂遥操作控制系统，包括用于操作者现场操控的操作主手和用于远 程受控的液压从手，其中：
[0007] 所述操作主手的各关节处均安装有力矩电机和电位器，所述液压从手的各关节处 均安装有液压油缸、角度传感器和压力传感器；
[0008] 所述操作主手上设置有操作主手控制器，所述液压从手上设置有液压从手控制 器，所述操作主手控制器和液压从手控制器之间设置有通讯系统；
[0009] 操作者克服所述操作主手的各关节处力矩电机的阻力控制操作主手动作，各关节 相继联动，安装于各关节的电位器的输入轴发生位置旋转，转化成电压信号到操作主手控 制器，经过一系列的转换，控制所述液压从手的动作；同时所述操作主手控制器从所述液压 从手控制器接收所述液压从手与外界环境的相互作用力信息，通过采用力反馈技术，将所 述液压从手与外界环境的相互作用力实时反馈到所述操作主手的各关节处力矩电机上。
[0010] 一种利用上述的控制系统进行遥操作控制的方法，包括：
[0011] 步骤1 :对操作主手和液压从手所处的环境W及环境中的设备建立模型；
[0012] 步骤2:立体视觉系统采集液压从手的作业环境信息，通过双目立体视觉定位原 理W及一系列的转换，建立与操作主手的作业环境同步的虚拟环境，同时利用激光器对利 用双目立体相机定位的事物进行定位校正；
[0013] 步骤3 :操作者佩戴立体显示头盎观察所述虚拟环境，给人W视觉临场感，通过观 测虚拟环境控制操作主手的运动，电位器实时采集操作主手的位置信息并将位置信息通过 通讯系统传送给液压从手，使液压从手跟随操作主手运动；当液压从手同外界环境交互时， 液压从手的运动信息又通过通讯系统反馈给操作主手的力矩电机，给人W力觉临场感。
[0014] 本发明具有W下有益效果：
[0015] 本发明中，基于操作主手和液压从手之间的力觉反馈，能够使操作者"沉浸"到作 业环境中，实现操作者和环境自然交互，有效地完成遥控作业任务，提高任务的执行效率。
【附图说明】
[0016] 图1为本发明的液压机械臂遥操作控制系统的原理图；
[0017] 图2为本发明中的力觉临场感控制系统原理图；
[0018] 图3为本发明中的双目立体视觉定位原理图。
【具体实施方式】
[0019] 为使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具 体实施例进行详细描述。
[0020] 一方面，本发明提供一种液压机械臂遥操作控制系统1，如图1和图2所示，包括用 于操作者现场操控的操作主手11和用于远程受控的液压从手12,其中：
[0021] 操作主手11的各关节处均安装有力矩电机111和电位器112，采用电机驱动方式， 操作简单方便；液压从手12的各关节处均安装有液压油缸121、角度传感器122和压力传 感器123,采用液压驱动方式，W使末端能够承受质量很大的负载；
[0022] 操作主手11上设置有操作主手控制器110,液压从手上设置有液压从手控制器 120,操作主手控制器110和液压从手控制器120之间设置有通讯系统15 ;
[0023] 在遥操作控制开始阶段，操作主手控制器110和液压从手控制器120需进行软件 握手，成功后，液压从手控制器120不断读取液压从手各关节的油缸位置、接触力信息并通 过通信系统15向操作主手控制器110传送，完成液压从手的初始化工作，使操作者可W感 知现场液压从手所处的状态。操纵者处于安全地点，克服操作主手的各关节处力矩电机的 阻力通过操纵操作主手直接操纵液压从手，各关节相继联动，安装于各关节的电位器的输 入轴发生位置旋转，转化成电压信号到操作主手控制器110,输入控制信号经过通信系统 15传送给液压从手控制器120,经过一系列的转换，液压从手控制器120将操作者的控制指 令通过算法解释为各关节的运动转角，并对液压从手的位置、速度量进行采样、控制；同时 操作主手控制器110从液压从手控制器120接收液压从手与外界环境的相互作用力信息， 通过采用力反馈技术，将液压从手与外界环境的相互作用力实时反馈到操作主手的各关节 处力矩电机上，通过该信息锁紧力矩电机，运时，操作者必须克服力矩电机阻力才可W使操 作主手运动，W实现对液压从手带力觉的控制，实现操作人员的力觉临场感遥控作业。
[0024] 本发明中，基于操作主手和液压从手之间的力觉反馈，能够使操作者"沉浸"到作 业环境中，实现操作者和环境自然交互，有效地完成遥控作业任务，提高任务的执行效率。 [00巧]作为本发明的一种改进，如图2所示，电位器112通过A/D转换模块113连接至操 作主手控制器110,力矩电机111通过驱动模块114连接至操作主手控制器110。
[00%] 作为本发明的另一种改进，如图2所示，液压油缸121上设置有伺服阀驱动模块 124,伺服阀驱动模块124通过D/A转换模块125连接至液压从手控制器120 ;角度传感器 122和压力传感器123通过A/D转换模块126连接至液压从手控制器120。
[0027] 图2中，操作主手控制器通过A/D转换模块与操作主手各关节中的电位器连接，保 持两者之间的数据交互，获得操作主手的当前位姿；通过驱动模块与各关节中的力矩电机 连接，操作主手控制器的操作指令驱动电机运转，操作主手做出各种不同位姿；通过通讯系 统（优选无线通讯系统）与液压从手控制器连接，实时监测液压从手的运动情况及外界环 境的作用力。
[00測同时，液压从手控制器通过D/A转换模块与电液伺服阀驱动模块连接，驱动模块 控制电液伺服阀的输入电压信号，并将电压信号进行放大、转换，变成电流信号控制电液伺 服阀的开度，进而调节液压油缸开度流量使机械臂运转；通过A/D转换模块与液压从手各 关节中的电位器、压力传感器连接，实时检测运动信息，获得液压从手的当前位姿及受力情 况；通过通讯系统与操作主手控制器连接，接收操作主手控制器的运动控制指令，同时将液 压从手的运动信息、受力情况及时传输给操作主手控制器。
[0029] 本发明中，优选的，操作主手11和液压从手12的结构设计相同，W便于两者产生 相同的动作。
[0030] 进一步的，整个控制系统还优选包括立体视觉系统，该立体视觉系统包括双目立 体相机、视觉处理单元和立体显示头盎，双目立体相机用于作业环境图像采集，视觉处理单 元用于实时获取作业环境的场景立体信息，立体显示头盎用于显示立体视频图像，给人W 视觉临场感。并且，该立体视觉系统还可W包括激光器，激光器安装于双目立体相机中间， 用于液压从手对作业环境中事物的定位校正。
[0031] 另一方面，本发明提供一种利用上述的控制系统进行遥操作控制的方法，包括：
[0032] 步骤1:对操作主手和液压从手所处的环境W及环境中的设备建立模型；
[0033] 步骤2:立体视觉系统采集液压从手的作业环境信息，通过双目立体视觉定位原 理W及一系列的转换，建立与操作主手的作业环境同步的虚拟环境，同时利用激光器对利 用双目立体相机定位的事物进行定位校正，W实现对现实环境中的事物进行准确的定位， 提高遥操作的控制精度；
[0034] 步骤3:操作者佩戴立体显示头盎观察所述虚拟环境，给人W视觉临场感，通过观 测虚拟环境控制操作主手的运动，电位器实时采集操作主手的位置信息并将位置信息通过 通讯系统传送给液压从手，使液压从手跟随操作主手运动；当液压从手同外界环境交互时， 液压从手的运动信息又通过通讯系统反馈给操作主手的力矩电机，给人W力觉临场感，使 操作者对于远方的作业环境进