欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2020103258307
申请人: 厦门理工学院
专利类型:发明专利
专利状态:已下证
专利领域: 计算;推算;计数
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种机器人关节视觉伺服控制方法,其特征在于,包括以下步骤:S1:采集机器人图像特征作为反馈量,构建机器人图像闭环控制:es(t)=s(t)‑s*

*

其中,s表示期望图像特征,s(t)表示t时刻的图像特征,es(t)表示t时刻的图像特征与期望图像特征之间的图形误差, 为Js(t)的广义逆,Js(t)表示t时刻的图像的雅可比矩阵,上标T表示矩阵的转置,λ>0为控制系数, 表示通过机器人图像闭环控制反馈得到的机器人关节速度, 分别表示通过机器人图像闭环控制反馈得到的机器人6个方向的速度;

S2:将机器人位姿作为反馈量,构建机器人位姿闭环控制:ep(t)=p(t)‑p*

其中,p*表示期望位姿,p(t)表示t时刻的位姿,ep(t)表示t时刻的位姿与期望位姿之间的图形误差, 为Jp(t)的广义逆,Jp(t)表示t时刻的位姿的雅可比矩阵,表示通过机器人位姿闭环控制得到的机器人关节速度,分别表示通过机器人位姿闭环控制得到的机器人6个方向的速度;

S3:建立目标函数,并设定目标函数的约束条件,使得机器人图像轨迹和机器人运动轨迹同时最短;目标函数为:min(βds(t)+(1‑β)dp(t))其中,β∈(0,1)表示权重因子,ds(t)和dp(t)均为中间变量;

目标函数的约束条件包括图像误差约束和位姿误差约束:es(t+1)=es(t)‑λJs(t)Us(t)Δtep(t+1)=ep(t)‑λJp(t)Up(t)Δt||e(t+1)||≤γ||e(t)||其中,γ∈(0,1)为权重系数,Δt表示t时刻与t+1时刻之间的时间间隔,e(t)表示联合T误差,e(t)=(es(t),ep(t)) ;

目标函数的约束条件包括相机视野约束:

其中,es, 分别表示图像特征向量的取值下界和上界,Δt表示时刻t与时刻t+1之间的时间间隔;

目标函数的约束条件包括关节角约束和关节速度约束:其中,θ(t)表示t时刻机器人的关节角,θ和 分别表示机器人的关节角的上限与下限,表示t时刻机器人的关节速度, 和 分别表示机器人的关节速度的上限与下限,Δt表示t时刻与t+1时刻之间的时间间隔。

2.一种机器人关节视觉伺服控制终端设备,其特征在于:包括处理器、存储器以及存储在所述存储器中并在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如权利要求1中所述方法的步骤。

3.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于:所述计算机程序被处理器执行时实现如权利要求1中所述方法的步骤。