Matlab机械手碰撞检测应用

ops/2025/2/12 18:10:03/

本文包含三个部分:

  1. Matlab碰撞检测的实现
  2. URDF文件的制作
  3. 机械手STL文件添加夹爪

一.Matlab碰撞检测的实现

首先上代码

%% 检测在结构环境中机器人是否与物体之间发生碰撞情况,如何避免?
% https://www.mathworks.com/help/robotics/ug/check-for-environmental-collisions-with-manipulators.html
%% 构建环境
% Create two platforms
clc
clear
platform1 = collisionBox(0.5,0.5,0.25);
platform1.Pose = trvec2tform([-1 0 0.2]);
worldCollisionArray = {platform1};
%% 创建figure对象显示环境:可以直接用exampleHelperVisualizeCollisionEnvironment(worldCollisionArray);
ax=gca;
% 显示桌子1并上色
[~, patchObj]=show(platform1,'Parent', ax);
patchObj.FaceColor = [1 0.6 0.9];
axis([-0.8,1,-0.8,1.2,0,1.4])%调整图框范围
view(141,22)%调节视角
hold on
%% 添加机器人模型:可更改为DH方向构建。
robot=importrobot("E:\3D\3D抓取\yaskawaGP12\urdf\yaskawaGP12.urdf");
robot.Gravity=[0 0 -9.81];
robot.DataFormat="column";
%robot = loadrobot("kinovaGen3","DataFormat","column","Gravity",[0 0 -9.81]);
show(robot,homeConfiguration(robot),"Parent",ax, 'Frames','off');startConfig=[3;1;0.8;0;0;pi];%关结空间
endConfig=[3;1;0.2;0;0;pi];
endEffector="link6";
%% 使用梯形速度规划从起点到终点的轨迹【关节空间】
q= trapveltraj([startConfig,endConfig],60,"EndTime",2);hold on
axis([-1.8,1,-1.8,1.2,0,2.2])%调整图框范围
view(141,22)%调节视角
axis on
hold on
title('机器人根据起点和终点位姿直接梯形速度的运动')
for i = 1:2:length(q)show(robot,q(:,i),"PreservePlot",false);%false 不留下重影poseNow = getTransform(robot, q(:,i), endEffector);%正运动学plot3(poseNow(1,4), poseNow(2,4), poseNow(3,4),'b.','MarkerSize',5)drawnow
end%%
% 初始化输出
inCollision = false(length(q),1); %===> zeros(length(q),1)
isConfigInCollision=false(length(q),1);
worldCollisionPairIdx = cell(length(q),1); % 元胞数组,保存与环境碰撞的部件和关节配置的索引
for i = 1:length(q)isConfigInCollision(i) = checkCollision(robot,q(:,i),Exhaustive='on');[inCollision(i),sepDist] = checkCollision(robot,q(:,i),worldCollisionArray,"IgnoreSelfCollision","on","Exhaustive","on");%  sepDist为输出是机器人身体与世界碰撞对象之间的距离--->存储为矩阵[bodyIdx,worldCollisionObjIdx] = find(isnan(sepDist)); % 找到碰撞的部件。距离是空NaN,则发生碰撞worldCollidingPairs = [bodyIdx,worldCollisionObjIdx]; worldCollisionPairIdx{i} = worldCollidingPairs;  %机器人部件索引第一列,环境物体索引第二列
end
isSelfCollision = any(isConfigInCollision);
isTrajectoryInCollision = any(inCollision);
%% 检测到碰撞并可视化构型,第一个和最后一个检测到的碰撞
collidingIdx1 = find(inCollision,1);%第一个:构型索引19
if(collidingIdx1)%collidingIdx2 = find(inCollision,1,"last");%最后一个:构型索引172% Identify the colliding rigid bodies.找到机器人中的碰撞部分collidingBodies1 = worldCollisionPairIdx{collidingIdx1}*[1 0]';%取碰撞的机器人部件第一列的=矩阵乘以[1,0]'%具体看矩阵维度% collidingBodies2 = worldCollisionPairIdx{collidingIdx2}*[1 0]';%  Identify the colliding world bodies.找到环境中的碰撞部分collidingworld1 = worldCollisionPairIdx{collidingIdx1}*[0 1]';%取碰撞的机器人部件第一列的=矩阵乘以[1,0]'%具体看矩阵维度% collidingworld2 = worldCollisionPairIdx{collidingIdx2}*[0 1]';%% 显示环境,并将碰撞进行可视化exampleHelperHighlightCollisionBodies(robot,collidingBodies1 +1,ax);% hold on[~, patchObj]=show(worldCollisionArray{collidingworld1(1)},"Parent"',ax);patchObj.FaceColor = [1 0.8 0];title('发生碰撞的部分构型显示','Color', 'r')
elsetitle('未发生碰撞','Color', 'g')
end

代码中首先创建platform1箱体、robot机器手模型,后根据起点、终点规划轨迹,再图像化显示,然后进入正题判断碰撞,碰撞分自碰撞与外部碰撞;

此功能需要安装Robotics System Toolbox,下载路径:Robotics Toolbox - Peter Corke

下载后双击安装即可。

上面代码的urdf文件可以使用C:\Program Files\MATLAB\R2022a\toolbox\robotics\robotmanip\robotModels\roboturdf内的替代;

注意:loadrobot函数加载的模型文件与importrobot不同,后者需要URDF文件。

此部分可参考博客:Robotics System Toolbox中的机器人运动(6)-碰撞检测-CSDN博客

二.URDF文件制作

此处第一次接触,较艰难

参考博客:特别章节-0.1 SolidWorks导出机械臂的URDF模型各个关节坐标系设置_sw2urdf导入模型如何正确设置坐标系-CSDN博客

Solidworks_to_URDF导出教程 - 知乎

还有SW的安装:SolidWorks 2022 SP5.0 软件下载+安装教程XL

SW还需要安装转URDF插件:sw_urdf_exporter - ROS Wiki,下载后安装即可

补充:

注意图中每一处的选择,JointName内的名称不能与link1相同,JointType内需要选择对应部件,还有机械手是关节型的,link应一级一级展开

然后正常导出即可。

三.机械手STL文件添加夹爪

思路是把导出URDF里的STL文件link6加上夹爪就好,碰撞检测时就可以带夹爪判断了。

修改STL文件废了些时间,实际完全可以用Matlab写一个程序实现

目前用的时Meshlab软件修改,在文件-导入网格,打开对应文件。

右侧部件鼠标右击出现菜单,对部件的平移旋转等需要用矩阵操作,做这个的应该都了解矩阵

这就是操作界面,修改数值然后右下角Apply,注意前三个数值单位是米;

注意机械手上的link6部件不能动,动了其与机械手相对位置就不同了;

这样机械手抓取碰撞检测就完成了,后面还有Matlab导出DLL在C#语言调用的部分,问题不大,有一个Matlab函数返回多个参数需要在函数第一个参数设置返回数量,超过1则返回MWArray[]

RobotCollision matlab = new RobotCollision();
MWArray robot;
public Form1()
{InitializeComponent();robot = matlab.MyLoadRobot(@"E:\3D\3D抓取\yaskawaGP12\urdf\yaskawaGP12.urdf");
}private void button1_Click(object sender, EventArgs e)
{double z = double.Parse(textBox2.Text);MWArray boxSize = (MWNumericArray)new double[] { 0.5, 0.5, 0.25 };MWArray boxPose = (MWNumericArray)new double[] { -1, 0, 0.2 };MWArray box = matlab.GetBox(boxSize, boxPose);MWArray robotPose = new MWNumericArray(6, 2, new double[] { 3, 3, 1, 1, 0.8, z, 0, 0,             0, 0, Math.PI, Math.PI });MWArray result = matlab.RobotCollisionCheck(robot, box, robotPose);textBox1.Text = result.ToString();
}

相关资源下载:【免费】机械手碰撞检测相关资料资源-CSDN文库


http://www.ppmy.cn/ops/157826.html

相关文章

互联网企业线上业务拓展与开源AI智能名片2+1链动模式S2B2C商城小程序的创新应用

摘要:随着互联网技术的飞速发展,互联网企业不断探索线上业务的边界,寻求新的增长动力。在互联网初期,面对商业模式和盈利模式的不成熟,国内互联网企业多从借鉴国外成功经验起步,逐步摸索出适合本土市场的线…

HPM_SDK应用本地化——基于6750evkmini

文章目录 前言一、准备工作1、下载官方的SDK2、解压SDK 二、实操1、新建目标工程文件夹2、回到SDK中将相关文件复制1、Borad文件夹2、hello_world文件夹 三、实验现象总结 前言 为什么要对sdk进行应用本地化?在嵌入式开发中我们一般将官方提供的SDK作为参考&#x…

基于HarmonyOS 3.0的智能理财APP开发方案

以下是基于HarmonyOS 3.0的智能理财APP开发方案,充分利用鸿蒙系统特性实现差异化功能: 一、架构设计 技术栈: - 开发框架:ArkUI 3.0 (声明式UI) - 数据管理:分布式数据服务 - 安全架构:TEE微内核 硬件级加…

唯一值校验的实现思路(续)

本文接着上一篇文章《唯一值校验的实现思路》,在后端实现唯一值校验。用代码实现。 /*** checkUniqueException[唯一值校验]** param entity 新增或编辑的学生实体* param insert 是否新增,如果是传入true;反之传入false* return void* date…

步骤条和按钮联动(上一步下一步)

ImportMatchDrawer.vue <template><div class"import-drawer"><Drawer :title"props.titleName" ref"drawer" size"648"><!-- 内容 --><template #content><!-- 步骤条 --><CustomStep :step…

如何使用 webpack 来优化前端性能的?

Webpack 是一个强大的现代 JavaScript 应用程序的模块打包工具。它不仅可以将 JavaScript 文件打包,还可以处理 CSS、图片等资源。通过合理配置 Webpack,可以显著优化前端性能。本文将详细探讨如何使用 Webpack 来优化前端性能,包括基本概念、优化策略和实践示例。 1. Webp…

运行npm install卡住不动的

首先检查npm代理&#xff0c;是否已经使用国内镜像 // 执行以下命令查看是否为国内镜像 npm config get registry 如果不是则换成国内镜像&#xff0c;执行以下命令 npm config set registryhttps://registry.npmmirror.com //执行以下命令查看是否配置成功 npm config get …

使用Qt+opencv实现游戏辅助点击工具-以阴阳师为例

注&#xff1a;本文章技术交流使用&#xff0c;不侵犯任何著作权。 一. 阴阳师辅助软件需要实现哪些功能? 1.首先&#xff0c;对于肝绘卷拿角色而言&#xff0c;需要打困难28副本和结界突破循环刷绘卷碎片。这一功能让你每月免费悠闲地拿到最新角色&#xff0c;即使你是较新…