[发明专利]基于传感器融合技术的机器人防碰撞冲击双臂协调控制系统

说明书

技术领域

本发明涉及机器人控制领域，特别是指一种基于传感器融合技术的机器人防碰撞冲击双臂协调控制系统。

背景技术

随着工业自动化水平的不断提高，机器人的应用领域正向更深更广的方向发展，机器人的智能化在工业生产中显得尤为重要。工业生产中双臂机器人相比单臂机器人能完成更为复杂的操作任务，但是机器人要能够理解环境、适应环境、与工作环境中的障碍物无碰撞冲击的进行作业则需要高性能传感器以及多个传感器间的协调工作。

智能系统中增加和改善传感器性能是增强系统智能性的重要手段，传统的单一传感器在机械臂的防碰撞冲击系统中存在明显的缺陷，很难获取精确的环境信息，这是因为每一种传感器都存在一定的缺陷，仅仅依靠单一传感器是很难满足控制要求。因此，对来自不同传感器的信息如何进行融合处理，从而更有效的加以灵活运用以使机器人的控制更加精确，是目前研究的一个重点。

发明内容

本发明要解决的技术问题是提供一种基于传感器融合技术的机器人防碰撞冲击双臂协调控制系统，它能够对来自不同传感器的信息进行有效融合，以使机器人的控制更加精确。

为解决上述技术问题，本发明提供技术方案如下：

一种基于传感器融合技术的机器人防碰撞冲击双臂协调控制系统，包括双目相机、超声波传感器、传感器信息融合模块、路径规划模块、运动控制器、第一和第二六自由度机械臂，其中：

所述双目相机为两个且分别安装于所述第一和第二六自由度机械臂的末端，所述超声波传感器也为两个且分别安装于所述第一和第二六自由度机械臂的末端，所述双目相机和超声波传感器的输出端连接所述传感器信息融合模块的输入端；

所述传感器信息融合模块的输出端连接所述路径规划模块的输入端；

所述路径规划模块的输出端连接所述运动控制器的输入端；

所述运动控制器的输出端连接所述第一和第二六自由度机械臂；

所述双目相机和超声波传感器用于检测操作环境中的障碍物信息，将获得的障碍物信息经所述传感器信息融合模块融合处理后，得到的较为精确的障碍物位置信息并传给所述路径规划模块进行防碰撞冲击的路径规划，之后所述路径规划模块将规划的路径信息发给所述运动控制器，由所述运动控制器控制所述第一和第二六自由度机械臂的运动。

进一步的，所述双目相机进一步用于对障碍物进行标定，并在不同的角度对障碍物上的特征点采集二维图像；

所述超声波传感器进一步用于实时探测周围环境，通过不断检测超声波发射后遇到障碍物所反射的回波，测出从发射到接收回波的时间T，计算出相对距离S＝CT/2，式中C为超声波波速。

进一步的，所述传感器信息融合模块进一步用于对双目相机捕获的特征点进行融合计算，获取特征点的轨迹及特征点所在平面的空间姿态参数，经过相应的算法处理之后得到特征点在世界坐标系中的坐标P(X_w,Y_w,Z_w)，然后通过神经网络算法融合特征点的三维坐标P(X_w,Y_w,Z_w)和超声波传感器所捕获的距离信息R，得到障碍物比较精确的三维坐标P(X,Y,Z)。

进一步的，所述路径规划模块进一步用于根据所述传感器信息融合模块所获得的障碍物位置信息，校正机械臂的逆解，为机器人设计一条无障的运动轨迹，同时要求避开障碍物之后能回到原来的路径继续完成相应的操作。

进一步的，所述神经网络算法采用三层BP神经网络，输入层为P_in＝[X_W,Y_W,Z_W,R]，分别为立体视觉融合后所得的物体三维空间坐标(X_w,Y_w,Z_w)和超声波传感器所获得的距离信息R，隐含层共有9个结点，输出层T＝[X,Y,Z]为融合处理后得到的物体的三维空间坐标P(X,Y,Z)，在学习过程中采用动量算法和自适应调整学习速率算法抑制学习过程中的振荡，提高收敛速度，提高神经网络的学习效率。

进一步的，所述动量算法和自适应调整学习速率算法的公式如下所示：

ω_ij(k+1)＝ω_ij(k)+Δω_ij+α(ω_ij(k)-ω_ij(k-1))