机械臂速成小指南(十六):带抛物线过渡的线性规划

2024-02-19 14:40

本文主要是介绍机械臂速成小指南(十六):带抛物线过渡的线性规划,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

👨‍🏫🥰🥳需要机械臂相关资源的同学可以在我的CSDN主页中找到哦🤖😽🦄

指南目录📖:

🎉🎉机械臂速成小指南(零点五):机械臂相关资源🎉🎉

机械臂速成小指南(零):指南主要内容及分析方法

机械臂速成小指南(一):机械臂发展概况

机械臂速成小指南(二):机械臂的应用

机械臂速成小指南(三):机械臂的机械结构

机械臂速成小指南(四):机械臂关键部件之减速机

机械臂速成小指南(五):末端执行器

机械臂速成小指南(六):步进电机驱动器

机械臂速成小指南(七):机械臂位姿的描述方法

机械臂速成小指南(八):运动学建模(标准DH法)

机械臂速成小指南(九):正运动学分析

机械臂速成小指南(十):可达工作空间

机械臂速成小指南(十一):坐标系的标准命名

机械臂速成小指南(十二):逆运动学分析

机械臂速成小指南(十三):轨迹规划概述

机械臂速成小指南(十四):多项式插值轨迹规划

机械臂速成小指南(十五):线性规划

机械臂速成小指南(十六):带抛物线过渡的线性规划

机械臂速成小指南(十七):直线规划 

机械臂速成小指南(十八):圆弧规划

机械臂速成小指南(十九):机械臂的电路板抓取实验

机械臂速成小指南(二十):机械臂的位姿重复性实验

机械臂速成小指南(二十一):几何雅可比矩阵

机械臂速成小指南(二十二):机械臂逆运动学的数值解方法

机械臂速成小指南(二十三):Paul方法求解机械臂运动学逆解(含matlab代码) 

🦾🌏🪐以下为正文🦾🌏🪐

        在上一章文末我们提到了线性规划的缺点:在起始点与终止点处存在速度的突变。因此,为了保证机械臂在起始与终止时的作业稳定性、安全性与精准性,我们使用抛物线对关节运动曲线进行过渡,这种关节空间轨迹规划方法称为带抛物线(parabolic)过渡的线性规划,使得关节角速度能以平滑的方式进行改变。

机械臂轨迹规划之带抛物线过渡的线性规划(关节空间)matlab仿真代码icon-default.png?t=N7T8https://download.csdn.net/download/m0_53966219/87521947?spm=1001.2014.3001.5503

一、理论分析

带抛物线拟合的线性规划

注:上图仅起到便于读者理解的作用,符号可能与下文不同

        为便于计算,我们设起始拟合段与终止拟合段的持续时间一致,二者关于轨迹中点(t_mid,θ_mid) 中心对称,且拥有大小相等、符号相反的恒定角加速度。

        设 为抛物线拟合区域的角加速度,t_acc 为拟合区域的持续时间,θ_a 为起始拟合段终点角度值。由于起始拟合段终点的速度必须等于直线段的速度,则有

其中 θ_a 可表示为

 联立上方两个式子,我们可以得到

接着,求解t_acc ,得到

        我们注意到,上式可解的条件是抛物线拟合区域的加速度 满足

        当上式等号成立时,关节运动曲线将不存在直线段,而是仅由两段抛物线组成;而当 趋于无穷大时,所规划的关节运动曲线将重新变为一条直线,即回到线性规划的情况。

二、程序仿真

        使用MATLAB对由抛物线过渡的线性插值的轨迹规划方法进行仿真。

机械臂轨迹规划之带抛物线过渡的线性规划(关节空间)matlab仿真代码icon-default.png?t=N7T8https://download.csdn.net/download/m0_53966219/87521947?spm=1001.2014.3001.5503

第一步,定义机械臂的DH参数

%定义关节角度限制
lim1_min = -170 * radian1; lim1_max = 170 * radian1; %关节1(-170,170)
lim2_min = -132 * radian1; lim2_max =   0 * radian1; %关节2(-132,0)
lim3_min =    1 * radian1; lim3_max = 141 * radian1; %关节3(1,141)
lim4_min = -165 * radian1; lim4_max = 165 * radian1; %关节4(-165,165)
lim5_min = -105 * radian1; lim5_max = 105 * radian1; %关节5(-105,105)
lim6_min = -155 * radian1; lim6_max = 155 * radian1; %关节6(-155,155)
%定义关节旋转范围
lim1 = lim1_max - lim1_min;
lim2 = lim2_max - lim2_min;
lim3 = lim3_max - lim3_min;
lim4 = lim4_max - lim4_min;
lim5 = lim5_max - lim5_min;
lim6 = lim6_max - lim6_min;
%D-H参数表
theta1 = 0;    d1 = 169.77;     a1 = 64.2;    alpha1 = -pi/2;    offset1 = 0;
theta2 = 0;    d2 = 0;          a2 = 305;     alpha2 = 0;        offset2 = 0;
theta3 = 0;    d3 = 0;          a3 = 0;       alpha3 = pi/2;     offset3 = pi/2;
theta4 = 0;    d4 = -222.63;    a4 = 0;       alpha4 = -pi/2;    offset4 = 0;
theta5 = 0;    d5 = 0;          a5 = 0;       alpha5 = pi/2;     offset5 = 0;
theta6 = 0;    d6 = -36.25;     a6 = 0;       alpha6 = 0;        offset6 = -pi;

第二步,运动学建模

L(1) = Link([theta1, d1, a1, alpha1, offset1], 'standard');
L(2) = Link([theta2, d2, a2, alpha2, offset2], 'standard');
L(3) = Link([theta3, d3, a3, alpha3, offset3], 'standard');
L(4) = Link([theta4, d4, a4, alpha4, offset4], 'standard');
L(5) = Link([theta5, d5, a5, alpha5, offset5], 'standard');
L(6) = Link([theta6, d6, a6, alpha6, offset6], 'standard');
% 定义关节范围
L(1).qlim=[lim1_min,lim1_max];
L(2).qlim=[lim2_min,lim2_max];
L(3).qlim=[lim3_min,lim3_max];
L(4).qlim=[lim4_min,lim4_max];
L(5).qlim=[lim5_min,lim5_max];
L(6).qlim=[lim6_min,lim6_max];  
robot = SerialLink(L,'name','AR3');

第三步,定义起始点、终止点以及储存关节角度、角速度、角加速度的数组

T1=transl(-100,-100,300);				%齐次变换矩阵
T2=transl(200,-200,400);				%齐次变换矩阵
init_ang=robot.ikine(T1);				%运动学逆解
targ_ang=robot.ikine(T2);				%运动学逆解
q = zeros(step,N);   %初始化机械臂的位置
qd = zeros(step,N);  %初始化机械臂的角速度
qdd = zeros(step,N); %初始化机械臂的角加速度

第四步,计算抛物线公式

step = 50;                      %总步长,也可看作总时间
t_mid = step / 2;               %时间中点
t_acc = 10;                     %抛物线拟合段的持续步长(时间)
middle_ang = (targ_ang - init_ang) / 2 + init_ang;      %计算角度中值
a_ang = init_ang + (targ_ang - init_ang) / 12;           %定义起始抛物线拟合段的终点角度值
a_velocity = (middle_ang - a_ang) / (t_mid - t_acc);    %终止抛物线拟合段的终点角速度值
acceleration = a_velocity / t_acc;                      %加速度

第五步,进行轨迹规划

for t = 1:step% 起始抛物线拟合段if t <= t_accq(t,:)   = acceleration * (t)^2 / 2 + init_ang;  %位置qd(t,:)  = acceleration * t;                     %角速度qdd(t,:) = acceleration;                         %角加速度% 直线段elseif (t > t_acc) && (t <= step - t_acc)q(t,:)   = a_velocity * (t - t_acc) + q(t_acc,:);%位置qd(t,:)  = a_velocity;                           %角速度qdd(t,:) = 0;                                    %角加速度% 终止抛物线拟合段elseq(t,:)   = q(step - t_acc,:) + a_velocity * (t - (step - t_acc)) - acceleration * (t - (step - t_acc))^2 / 2;%位置qd(t,:)  = a_velocity - acceleration * (t + t_acc - step);                                                   %角速度qdd(t,:) = -acceleration;                                                                                    %角加速度end
end

效果如下图所示

机械臂轨迹规划之带抛物线过渡的线性规划(关节空间)matlab仿真代码icon-default.png?t=N7T8https://download.csdn.net/download/m0_53966219/87521947?spm=1001.2014.3001.5503

三、编程实现

        机械臂在运行过程中较为平稳,且在作往复运动时,臂体振动幅度变小。

这篇关于机械臂速成小指南(十六):带抛物线过渡的线性规划的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/724990

相关文章

CentOS7更改默认SSH端口与配置指南

《CentOS7更改默认SSH端口与配置指南》SSH是Linux服务器远程管理的核心工具,其默认监听端口为22,由于端口22众所周知,这也使得服务器容易受到自动化扫描和暴力破解攻击,本文将系统性地介绍... 目录引言为什么要更改 SSH 默认端口?步骤详解:如何更改 Centos 7 的 SSH 默认端口1

SpringBoot多数据源配置完整指南

《SpringBoot多数据源配置完整指南》在复杂的企业应用中,经常需要连接多个数据库,SpringBoot提供了灵活的多数据源配置方式,以下是详细的实现方案,需要的朋友可以参考下... 目录一、基础多数据源配置1. 添加依赖2. 配置多个数据源3. 配置数据源Bean二、JPA多数据源配置1. 配置主数据

python中各种常见文件的读写操作与类型转换详细指南

《python中各种常见文件的读写操作与类型转换详细指南》这篇文章主要为大家详细介绍了python中各种常见文件(txt,xls,csv,sql,二进制文件)的读写操作与类型转换,感兴趣的小伙伴可以跟... 目录1.文件txt读写标准用法1.1写入文件1.2读取文件2. 二进制文件读取3. 大文件读取3.1

SpringBoot中配置Redis连接池的完整指南

《SpringBoot中配置Redis连接池的完整指南》这篇文章主要为大家详细介绍了SpringBoot中配置Redis连接池的完整指南,文中的示例代码讲解详细,具有一定的借鉴价值,感兴趣的小伙伴可以... 目录一、添加依赖二、配置 Redis 连接池三、测试 Redis 操作四、完整示例代码(一)pom.

Linux内核参数配置与验证详细指南

《Linux内核参数配置与验证详细指南》在Linux系统运维和性能优化中,内核参数(sysctl)的配置至关重要,本文主要来聊聊如何配置与验证这些Linux内核参数,希望对大家有一定的帮助... 目录1. 引言2. 内核参数的作用3. 如何设置内核参数3.1 临时设置(重启失效)3.2 永久设置(重启仍生效

Python列表去重的4种核心方法与实战指南详解

《Python列表去重的4种核心方法与实战指南详解》在Python开发中,处理列表数据时经常需要去除重复元素,本文将详细介绍4种最实用的列表去重方法,有需要的小伙伴可以根据自己的需要进行选择... 目录方法1:集合(set)去重法(最快速)方法2:顺序遍历法(保持顺序)方法3:副本删除法(原地修改)方法4:

PyInstaller打包selenium-wire过程中常见问题和解决指南

《PyInstaller打包selenium-wire过程中常见问题和解决指南》常用的打包工具PyInstaller能将Python项目打包成单个可执行文件,但也会因为兼容性问题和路径管理而出现各种运... 目录前言1. 背景2. 可能遇到的问题概述3. PyInstaller 打包步骤及参数配置4. 依赖

Nginx中配置HTTP/2协议的详细指南

《Nginx中配置HTTP/2协议的详细指南》HTTP/2是HTTP协议的下一代版本,旨在提高性能、减少延迟并优化现代网络环境中的通信效率,本文将为大家介绍Nginx配置HTTP/2协议想详细步骤,需... 目录一、HTTP/2 协议概述1.HTTP/22. HTTP/2 的核心特性3. HTTP/2 的优

在React中引入Tailwind CSS的完整指南

《在React中引入TailwindCSS的完整指南》在现代前端开发中,使用UI库可以显著提高开发效率,TailwindCSS是一个功能类优先的CSS框架,本文将详细介绍如何在Reac... 目录前言一、Tailwind css 简介二、创建 React 项目使用 Create React App 创建项目

SpringBoot3实现Gzip压缩优化的技术指南

《SpringBoot3实现Gzip压缩优化的技术指南》随着Web应用的用户量和数据量增加,网络带宽和页面加载速度逐渐成为瓶颈,为了减少数据传输量,提高用户体验,我们可以使用Gzip压缩HTTP响应,... 目录1、简述2、配置2.1 添加依赖2.2 配置 Gzip 压缩3、服务端应用4、前端应用4.1 N