欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2021110859030
申请人: 南京邮电大学
专利类型:发明专利
专利状态:已下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种机械臂点约束控制方法,其特征在于,所述方法包括如下步骤:在机械臂上设置约束点,建立约束下含有关节误差的机械臂运动学模型;

通过所述机械臂运动学模型计算约束下的机械臂末端重复性误差,建立机械臂末端重复性误差与约束点空间位置以及机械臂的约束部位之间的联系;

计算约束点在机械臂的各约束部位下,机械臂末端在任务空间满足空间精度要求时的约束点分布域,通过机械臂运动学模型确定机械臂约束部位的约束点可达空间;约束点分布域与约束点可达空间的交集为约束点可行域;控制机械臂的各约束部位约束到相应的约束点可行域。

2.根据权利要求1所述的一种机械臂点约束控制方法,其特征在于,所述约束点在机械臂的各约束部位为所述机械臂的连杆或连杆之间的关节。

3.根据权利要求1所述的一种机械臂点约束控制方法,其特征在于,建立所述机械臂运动学模型的过程包括:

建立理想状态下单个连杆的变换矩阵;

引入关节误差,建立单个连杆含关节误差的运动模型;

推导从约束点到机械臂末端的含关节误差运动模型,得到多连杆含关节误差的运动学模型;

引入约束对关节误差影响的参数,建立约束下单个连杆含关节误差的运动模型;

推导从基座到约束点的含关节误差运动模型,得到约束下多连杆含关节误差的运动学模型;

由多连杆含关节误差的运动学模型和约束下多连杆含关节误差的运动学模型,推导出约束下含关节误差的机械臂运动学模型。

4.根据权利要求3所述的一种机械臂点约束控制方法,其特征在于,建立理想状态下单个连杆的变换矩阵的过程为:

以机械臂的基座为原点建立基础坐标系,所述机械臂运动学模型借助4个参数连杆长度a、连杆偏移d、连杆扭转α、关节转角θ以描述中间连杆坐标系之间对应的变换,由此得到式(1)理想状态下单个连杆的运动模型;为:Ti=Rot(Z,θi)Rot(X,αi)Trans(ai,0,di)i=1,2....n                               (1)

4×4

其中,Trans(x,y,z)∈R 代表理想状态下单个连杆沿基础坐标系的x轴、y轴、z轴移动x、y、z的齐次变换矩阵,Rot(A,θi)代表绕转动轴绕x轴、y轴或z轴方向转动角度θi对应的齐次变换矩阵,A表示x轴、y轴或z轴方向。

5.根据权利要求4所述的一种机械臂点约束控制方法,其特征在于,建立单个连杆含关节误差的运动模型的过程为:

所述关节误差模型使用 来描述连杆i与连杆i+1之间因关节误差带来的变化,其中 分别为x、y、z轴方向上的位移量, 分别为绕x、y、z轴的旋转量,得到式(2)单个连杆关节误差的变换矩阵 为:得到单个连杆含关节误差的运动模型为

6.根据权利要求5所述的一种机械臂点约束控制方法,其特征在于,建立约束下单个连杆含关节误差的运动模型的过程为:

使用ρx、ρy、ρz、ρrx、ρry、ρrz为描述约束对关节误差模型中 参数的影响,pcx、pcy和pcz分别对应约束下关节误差模型x、y、z轴方向上的位移量;约束下关节误差模型参数pcrx、pcry和pcrz分别对应约束下关节误差模型绕x、y、z轴的旋转量;pcx、pcy、pcz、pcrx、pcry、pcrz计算公式为:对应式(5)为对应的约束下单个连杆关节误差的变换矩阵为:cc

Ti =Trans(pcx,pcy,pcz)Rot(X,pcrx)Rot(Y,pcry)Rot(Z,pcrz)i=1,2....6                              (5)得到约束下单个连杆含关节误差的运动模型

7.根据权利要求6所述的一种机械臂点约束控制方法,其特征在于,推导出约束下含关节误差的机械臂运动学模型过程为:由约束下单个连杆含关节误差的运动模型 推导得公式(6),得到从基座到约束点的含关节误差的运动学模型Tranbasic_con;由单个连杆含关节误差的运动模型为 推导得公式(7),从约束点到机械臂末端含关节误差的运动学模型Trancon_terminate;由公式(6)和公式(7)推导出公式(8),得到约束下含关节误差的机械臂运动学模型Tgeneral;

Tgeneral=Tranbasic_conTrancon_terminate                   (8)其中,k表示机械臂约束部位至基座之间的连杆数量,n表示机械臂的连杆总数量。

8.根据权利要求1或3所述的一种机械臂点约束控制方法,其特征在于,建立机械臂末端重复性误差与约束点空间位置以及机械臂的约束部位之间的联系,包括:设定约束点在机械臂上的约束部位和约束点的空间约束位置,约束部位均匀分布于机械臂上,约束点的空间约束位置均匀分布在机械臂约束部位可达空间内;在机械臂上的各约束部位约束到各空间约束位置下,获取均匀充分分布在机械臂末端工作空间中的名义位置;利用约束下含有关节误差的机械臂运动学模型,获得机械臂末端向名义位置移动过程中到达的模拟位置,重复多次,计算出相应的名义位置与模拟位置之间的位置方差,所述位置方差为末端重复性误差;

在机械臂上的各约束部位约束到各空间约束位置下,计算各名义位置到机械臂末端操作域中心的距离,得到名义位置到机械臂末端操作域中心的距离与末端重复性误差的关系,拟合机械臂上的同一约束部位约束到各空间约束位置下距离与末端重复性误差的关系,得机械臂上的各约束部位下距离与末端重复性误差的关系。

9.根据权利要求8所述的一种机械臂点约束控制方法,其特征在于,计算在机械臂的各约束部位下,机械臂末端在任务空间满足空间精度要求时的约束点分布域的过程包括:拟合给定目标任务空间为空间球体,确定球心位置与球体半径;依据给定的目标工作空间,拟合出覆盖目标任务空间的球体Stask,计算出球心位置Ps与球体半径Rs;

参考拟合得到的机械臂上的各约束部位下距离与重复性误差关系曲线,得到约束下满足精度要求的距离最大值max(dis);依据公式:Rsp_con=max(dis)‑Rs                             (9)计算约束点分布域半径Rsp_con,约束点分布域的球心为目标任务空间球心Ps,得到约束点在机械臂上的各约束部位下,并满足误差要求的作用在约束点分布域。

我要求购
我不想找了,帮我找吧
您有专利需要变现?
我要出售
智能匹配需求,快速出售