基于数据驱动的图像视觉伺服控制系统及方法与流程

文档序号:20919127发布日期:2020-05-29 13:54阅读:来源:国知局

技术特征:

1.一种基于数据驱动的图像视觉伺服控制系统,其特征在于,包括:六轴串联机器人、机器人控制柜、控制主机、单目rgb摄像机、数据存储模块、数据计算模块以及视觉模块。其中:

所述单目rgb摄像机固定在六轴串联机器人的末端执行器上,并与控制主机通信连接;

所述视觉模块对单目rgb摄像机采集的图像数据进行处理并提取目标的像素位置,向控制主机提供反馈信息;

所述六轴串联机器人固定在工作空间中,由机器人控制柜控制其关节运动,所述机器人控制柜与控制主机通信连接;

所述数据存储模块与控制主机数据连接,用于实时从控制主机中获取历史数据并进行存储;

所述数据计算模块与数据存储模块数据连接,用于实时从数据存储模块中获取历史数据进行计算,将计算得到的数据驱动控制补偿量提供给控制主机,用于视觉伺服控制。

2.根据权利要求1所述的基于数据驱动的图像视觉伺服控制系统,其特征在于,所述数据存储模块对操作数据进行实时存储,所述数据计算模块对获取的历史数据进行优化计算,计算所得到的结果作为视觉伺服控制补偿量,用于补偿视觉伺服控制量。

3.根据权利要求2所述的基于数据驱动的图像视觉伺服控制系统,其特征在于,所述数据计算模块对获取的历史数据进行优化计算的具体过程为:

数据计算模块求解数据驱动的最优权重系数λ为:

式中,为历史误差增量,e(k)为目标在k时刻的像素与期望像素的误差,t为矩阵转置运算;

求解数据驱动控制补偿量为:

式中,为历史控制量。

4.一种权利要求1至3中任一项所述的基于数据驱动的图像视觉伺服控制系统的控制方法,其特征在于,包括如下步骤:

s1,对系统进行初始化;

s2,在k时刻,数据计算模块从数据存储模块中获取历史数据并求解数据驱动最优权重系数以及数据驱动控制补偿量;

s3,从视觉模块获取目标当前的像素与期望像素的误差,从数据计算模块获取数据驱动控制补偿量加入传统视觉伺服反馈控制率中,计算生成新的控制量;,控制主机将单目rgb摄像机运动转换为六轴串联机器人关节运动,将新的控制量转换为机器人指令,并将机器人指令发送给机器人控制柜;

s4,将该k时刻产生的所有数据送入数据存储模块,等待下一次控制使用;如果目标当前的像素到达期望像素,则停止控制;否则返回s2。

5.根据权利要求4所述的基于数据驱动的图像视觉伺服控制系统的控制方法,其特征在于,所述s1中对系统进行初始化包括如下内容:

初始化数据存储模块和数据计算模块,包括:数据滚动窗口长度初始化为l,历史控制量的最优权重系数初始化为滚动窗口下的单目rgb摄像机历史运动速度初始化为滚动窗口下的历史误差增量初始化为

初始化控制主机的视觉伺服反馈控制率h、控制周期以及图像处理周期;获取系统控制目标的指定跟踪对象的期望图像,其中,所述控制目标为工作空间中的指定跟踪目标。

6.根据权利要求4所述的基于数据驱动的图像视觉伺服控制系统的控制方法,其特征在于,所述s2中,求解数据驱动最优权重系数的方法为:

数据存储模块提供单目rgb摄像机历史运动速度和历史误差增量其中:

式中,l为数据滚动窗口长度;

数据计算模块计算数据驱动的最优权重系数λ如下所示:

式中,e(k)为目标在k时刻的像素与期望像素的误差,t为矩阵转置运算。

7.根据权利要求4所述的基于数据驱动的图像视觉伺服控制系统的控制方法,其特征在于,所述s2中,求解数据驱动控制补偿量的方法为:

式中,h为控制主机的视觉伺服反馈控制率,为图像雅可比矩阵逆矩阵的估计。

8.根据权利要求4所述的基于数据驱动的图像视觉伺服控制系统的控制方法,其特征在于,所述s3中,生成新的控制量的求解方法为:

基于数据驱动的视觉伺服控制器求解单目rgb摄像机在当前时刻的下一个时刻的单目rgb摄像机的运动速度vc(k)为:

式中,为传统视觉伺服控制率,e(k)为目标在k时刻的像素与期望像素的误差,h为控制主机的视觉伺服反馈控制率,为图像雅可比矩阵逆矩阵的估计,λ为数据驱动的最优权重系数,为单目rgb摄像机历史运动速度,为历史误差增量;

得到当前时刻的下一个时刻的单目rgb摄像机运动速度vc(k)后,将该速度vc(k)送入数据存储模块进行保存,并将该速度vc(k)转换为六轴串联机器人期望关节速度。

9.根据权利要求5所述的基于数据驱动的图像视觉伺服控制系统的控制方法,其特征在于,所述s3中,将单目rgb摄像机运动转换为六轴串联机器人关节运动的方法为:

根据机械臂的正运动学和六轴串联机器人当前的关节角度,求解当前基坐标系和末端坐标系之间的坐标转换关系为通过手眼标定获得六轴串联机器人末端坐标系与摄像头坐标系之间的坐标转换关系为最终获得六轴串联机器人基坐标系和单目rgb摄像机坐标系的转换矩阵为:

式中,为旋转矩阵,为平移向量;

计算单目rgb摄像机运动速度和六轴串联机器人关节运动速度之间的关系为:

式中,jb为六轴串联机器人运动学雅可比矩阵,为六轴串联机器人关节速度,θ为关节角度,δθ为关节增量,i为单位矩阵;

其中式中,vc为单目rgb摄像机线速度,wc为单目rgb摄像机角速度;

得到单目rgb摄像机运动速度对应的六轴串联机器人关节速度

将该关节速度发送给机器人控制柜。


技术总结
本发明提供了一种基于数据驱动的图像视觉伺服控制系统。单目RGB摄像机固定在六轴串联机器人的末端执行器上,并与控制主机通信连接;六轴串联机器人固定在工作空间中,接收机器人控制柜的指令。机器人控制柜与控制主机通信连接;数据存储模块从控制主机中获取数据进行存储;数据计算模块与数据存储模块数据连接,从数据存储模块中获取历史数据并计算得到的数据驱动控制补偿量提供给控制主机。本发明同时提供了一种上述系统的控制方法,本发明数据计算量小,计算运行速度快,能有效避免因为计算量而影响系统实时性,并且利用了历史控制数据的最优权重组合来提升传统视觉伺服的收敛性能。

技术研发人员:李德伟;何邵颖;徐云雯
受保护的技术使用者:上海交通大学
技术研发日:2020.01.16
技术公布日:2020.05.29
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1