[发明专利]一种气动软体手控制系统及其控制方法

摘要

本发明涉及一种气动软体手控制系统及控制方法，包括控制器、功率放大器、运算放大器、气压传感器、弯曲传感器以及上位机，其中，气压传感器设于与气动软体手内腔相通处，其信号线接至控制器的输入端；弯曲传感器贴覆于气动软体手弯曲部位内侧，其信号线经运算放大器接至控制器的输入端；控制器与上位机进行双向通讯连接，控制器根据上位机的控制指令输出PWM信号经功率放大器送至气动部件，驱动气动软体手动作。本发明气动软体手控制系统能够实现对抓取球形物体尺寸判断，并且能够对物体实现自适应稳定抓取，填补了气动软体手控制系统领域的空白。

主权项

1.一种气动软体手控制系统，其特征在于：包括控制器、功率放大器、运算放大器、气压传感器、弯曲传感器以及上位机，其中，气压传感器设于与气动软体手内腔相通处，其信号线接至控制器的输入端；弯曲传感器贴覆于气动软体手弯曲部位内侧，其信号线经运算放大器接至控制器的输入端；控制器与上位机进行双向通讯连接，控制器根据上位机的控制指令输出PWM信号经功率放大器送至气动部件，驱动气动软体手动作；/n手指内侧附有防止手指产生径向膨胀的不可收缩纤维层；/n弯曲传感器贴覆于气动软体手的一个手指弯曲部位内侧，与手指相对位置保持不变；/n包括上位机控制程序和气动软体手控制程序，上位机控制程序包括弯曲-压力检测子程序和弯曲-直径检测子程序，其中弯曲-直径检测子程序控制过程如下：/n上位机发送指令，控制器接收上述指令并产生PWM信号，驱动气动软体手弯曲变形；/n判断驱动气动软体手内腔压力是否达到期望值；/n如果没有达到期望值，则气动软体手继续产生弯曲运动；/n通过弯曲-压力关系模块计算预测弯曲值；/n当预测弯曲值大于实测弯曲值时，气动软体手停止运动，记录弯曲值；/n通过弯曲-直径关系模块计算得到物体直径，并在上位机显示；/n气动软体手复位到初始状态，一次弯曲-直径检测过程结束；/n弯曲-压力检测子程序控制过程如下：/n气动软体手产生弯曲运动后，判断驱动气动软体手内腔压力是否达到最大值；/n如果没有达到最大值，则气动软体手继续产生弯曲运动；/n通过弯曲-压力关系模块计算预测弯曲值；/n当预测弯曲值大于实测弯曲值时，记录实测弯曲值，通过弯曲-压力关系模块得到期望压力值，并将其乘以权重系数，得到稳态抓取压力值；/n判断是否达到需求的稳态抓取时间；/n如果达到需要的稳态抓取时间，则一次弯曲-压力检测过程结束；/n弯曲—压力关系模块通过MATLAB软件拟合得到，具有以下关系式/n (1)/n其中，为弯曲值，为压力值，、均为拟合参数值；/n或者，弯曲—直径关系模块通过MATLAB软件拟合得到，具有以下关系式/n (2)/n其中，为弯曲值、为直径值，、、均为拟合参数值。/n