3轴机器人各关节运动学建立,python编程,非常容易理解

分类:机器人学

一、问题描述

  如右图所示的三自由度机械臂,关节1和关节2相互垂直,关节2和关节3相互平行。如图所示,所有关节均处于初始状态。   要求: (1) 定义并标注出各关节的正方向; (2) 定义机器人基坐标系{0}及连杆坐标系{1},{2},{3}; (3) 求变换矩阵 , , ; (4) 根据末端腕部位置 (x, y, z) 返求出对应关节 , , ; (5) 利用软件绘制出机器人模型的三维点线图,并控制机器人腕部沿半径r=0.1的圆弧运动.  

 

二、任务求解

2.1建立坐标系

 

 

2.2 变换矩阵

2.2.1 变换求解

  (1)连杆坐标系{1}——基坐标系{0}   原点重合,可绕z轴任意旋转  

  (2)连杆坐标系{2}——连杆坐标系{1} 先绕x轴旋转90°,再绕新得到的y轴旋转90°,然后沿新得到的y轴平移 ,最后得到的坐标系可绕z轴任意旋转    3)连杆坐标系{3}——连杆坐标系{2}   绕z轴旋转-90°,再沿新得到的y轴平移 ,最后得到的坐标系可绕z轴任意旋转   

2.2.2 物理意义求解

  变换矩阵的前三列,每列值对应的数为变换坐标系的坐标轴x、y、z在基坐标系中的坐标位置,第四列为变换坐标系的原点在基坐标系中的坐标位置,第四行为齐次补行数据,则可根据坐标系的位置直接列出下式:  

  可见,两种方式的结果表达式一致。

2.2.3 变换矩阵终解

 

 

2.3 逆运动学求解

2.3.1 矩阵逆推导

  由连杆坐标系{3}到基座坐标系{0}的齐次矩阵可以表示为  

  末端执行器的位置在基座坐标系{0}中的描述为    末端执行器的位置在基座坐标系{0}中的描述为    关系为:    根据矩阵对应元素相等,由MATLAB计算可得可得下面等式:  

x=-(7*cos(a2)*sin(a1))/25-(7*cos(a2)*sin(a1)*sin(a3))/20(7*cos(a3)*
sin(a1)*sin(a2))/20
y=(7*cos(a1)*cos(a2))/25+(7*cos(a1)*cos(a2)*sin(a3))/20+(7*cos(a1)*cos(a3)*sin(a2))/20
z=(7*sin(a2))/25 + (7*sin(a2)*sin(a3))/20 - (7*cos(a2)*cos(a3))/20 + 47/100

由  

  则:    由对应元素相等,得:

(x*cos(a1))/(cos(a1)^2 + sin(a1)^2) + (y*sin(a1))/(cos(a1)^2 + sin(a1)^2)=0(y*cos(a1))/(cos(a1)^2 + sin(a1)^2) - (x*sin(a1))/(cos(a1)^2 + sin(a1)^2)=(7*cos(a2))/25+(7*cos(a2)*sin(a3))/20+(7*cos(a3)*sin(a2))/20z=(7*sin(a2))/25 + (7*sin(a2)*sin(a3))/20 - (7*cos(a2)*cos(a3))/20 + 47/100

  综上可得,  

 

2.3.2 几何推导

  在x0y平面,将末端执行器的轨迹投影到该平面,蓝色表示原位置,橘色代表移动后的位置,黑色坐标系为基坐标系,如下图:  

  由图易见, 为末端执行器投影到xoy平面x与y的夹角,(逆时针为正),    在y0z平面,将末端执行器的轨迹投影到该平面,蓝色表示原位置,橘色代表移动后的位置,黑色坐标系为基坐标系,如下图:       将末端执行器的轨迹投影到下图所示平面,蓝色表示原位置,橘色代表移动后的位置,黑色坐标系为基坐标系,如下图:    构建直角三角形,可得:    综上,得各关节角与坐标位置的关系为:   

三、D-H模型法求解

3.1 坐标系建立

  0号杆件固连在基座上,建立基坐标系  

 

3.2 D-H参数

 

 

3.3 各关节变换矩阵

  若已知四个参数就完全确定了两连杆之间的相对关系。对此,我们建立基坐标系和连杆运动坐标系之间的变换关系。对于旋转关节可以确定以下的齐次矩阵   即先绕x轴旋转,  

  然后沿x轴移动,再沿基坐标系的z轴移动d,最后绕z轴旋转   将参数代入上式,由此可以得到各关节变换矩阵   

3.4 求逆变换

  同2.3.1  

四、软件仿真

4.1 程序代码

  用软件python(x,y)编写代码,如下:  

 

4.2 仿真结果

 

运动学建模仿真Python

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/news/251912.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

ASP.Net中页面传值的几种方式

大致概括一下,ASP.NET 页面之间传递值得方式大致可以分为如下几种:Request.QueryString["name"],Request.Form("name"),Session,Cookie,Cache,Application,Server.Transfer,Database,HttpContext的Item属性,Files,DataBa…

Win 10 源码一览:0.5T 代码、400 万文件、50 万文件夹

Windows 操作系统本身是不开源的,但是近日微软内核工程师 Axel Rietschin 发表了一篇博客,带大家一窥了 Windows 10 内核的魅力。 Axel 介绍,Windows 10 与 Windows 8.x、7、Vista、XP、2000 和 NT 的代码库是相同的,其中每一代都…

老齐python-基础3(列表)

1、定义一个列表 >>> a [] #创建一个空列表 >>> type(a) #查看数据类型 <class list> >>> bool(a) #判断非空 False >>> print(a) [] >>> a [2,3,tajzhang,] >>> a [2, 3, tajzhang] >&…

UWP 响应键盘组合快捷键

方法1&#xff1a;响应Ctrl&#xff1f;快捷键 首先在load事件或者keydown事件内注册事件 public MainPage(){this.InitializeComponent();// Register for accelerator key events used for button hotkeysWindow.Current.CoreWindow.Dispatcher.AcceleratorKeyActivated Dis…

NDK 开发实战 - 封装 java 层 sdk 模型

关于 Ndk 开发&#xff0c;网上的资料比较少&#xff0c;这方面的书籍也不多。因为其涉及的知识非常广&#xff0c;时常有哥们问我&#xff0c;东西那么多到底要学到什么程度呢&#xff1f;到底应该怎么学&#xff1f;这期我给大家来做一个简单回答&#xff0c;首先单纯站在 An…

JDK+Tomcat搭建JSP运行环境--JSP基础

一、搭建JSP运行环境之前需要了解的基本知识 配置JSP运行环境之前&#xff0c;我们需要了解JSP的运行机制。只有了解JSP运行机制后&#xff0c;我们才能知道为什么要搭建JSP运行环境?如何去搭建JSP运行环境?为什么要配置Tomcat、JDK&#xff1f; JSP(Java Sever Page)即Java服…

Docker容器的自动化监控实现

本文由 网易云 发布。 近年来容器技术不断成熟并得到应用。Docker作为容器技术的一个代表&#xff0c;目前也在快速发展中&#xff0c;基于 Docker的各种应用也正在普及&#xff0c;与此同时 Docker对传统的运维体系也带来了冲击。我们在建设运维平台的过程中&#xff0c;也需…

robotframework 常用关键字

标准库 第三方库 其他库转载于:https://www.cnblogs.com/Chamberlain/p/10729054.html

身份证的验证

var Wi [ 7, 9, 10, 5, 8, 4, 2, 1, 6, 3, 7, 9, 10, 5, 8, 4, 2, 1 ]; // 加权因子 var ValideCode [ 1, 0, 10, 9, 8, 7, 6, 5, 4, 3, 2 ]; // 身份证验证位值.10代表X function checkIdcard(idCard) { idCard trim(idCard);//去掉字符串头尾空格 if (idCard.length 15…

人工智能实战小程序之语音_前端开发

1. 人工智能实战小程序之准备工作 2. 人工智能实战小程序之语音_前端开发 今天这部分主要讲小程序前端功能的开发由于我偏后端&#xff0c;css是我的弱项&#xff0c;可能很多人和我一样开发小程序不知道如何下手&#xff0c;希望本篇文章对你有帮助我的学习路线是&#xff1a;…

当TFS/VSTS遇上Power BI

引言众所周知&#xff0c;要对TFS进行深入的图表分析&#xff0c;往往需要依赖于SQL Server Analysis Service和SQL Server Reporting Service。虽然随着TFS对敏捷项目的支持&#xff0c;内置了诸如累积流图、燃尽图等快捷图表&#xff1b;并且在最新的版本中还可以在仪表盘和查…

HashMap深度解析:一文让你彻底了解HashMap

写在前面HashMap是Map族中最为常用的一种&#xff0c;也是 Java Collection Framework 的重要成员。本文首先给出了 HashMap 的实质并概述了其与 Map、HashSet 的关系&#xff0c;紧接着给出了 HashMap 在 JDK 中的定义&#xff0c;并结合源码分析了其四种构造方式。最后&#…

Bzoj3628: [JLOI2014]天天酷跑

3628: [JLOI2014]天天酷跑 Time Limit: 20 Sec Memory Limit: 128 MBSubmit: 121 Solved: 44[Submit][Status][Discuss]Description 在游戏天天酷跑中&#xff0c;最爽的应该是超级奖励模式了吧&#xff0c;没有一切障碍&#xff0c;可以尽情的吃金币&#xff0c;现在请你控制…

python_线程、进程和协程

线程 Threading用于提供线程相关的操作&#xff0c;线程是应用程序中工作的最小单元。 1 #!/usr/bin/env python2 #codingutf-83 __author__ yinjia4 5 6 import threading,time7 8 def show(arg):9 time.sleep(2) 10 print(线程: str(arg)) 11 12 for i in range(…

AppDelegate瘦身之服务化

有没有觉得你的AppDelegate杂乱无章&#xff1f;代码几百行上千行&#xff1f;集成了无数的功能&#xff0c;如推送、埋点、日志统计、Crash统计等等&#xff0c;感觉AppDelegate无所不能。 来一段一般的AppDelegate代码&#xff0c;来自网上一篇文章&#xff1a; UIApplicatio…

第四章:手机平板要兼顾-探究碎片

碎片是什么&#xff1f; 碎片&#xff08;Fragment&#xff09;是一种可以嵌入在活动&#xff08;Activity&#xff09;中的 UI 片段&#xff0c;它能让程序更加合理和充分的利用大屏幕的空间&#xff0c;因而在平板上应用的非常广泛。 碎片的使用方式 静态嵌入动态加载碎片和活…

Android Studio 3.4增可视化资源管理工具 可管理和预览项目资源

经过6个月的开发时间&#xff0c;网络大厂17日发布了最新版的App开发IDE Android Studio 3.4&#xff0c;现在就能够下载使用&#xff0c;除了有超过300个错误修护和稳定度增强之外&#xff0c;在开发、建置和测试App阶段&#xff0c;都推出了一些小的新功能和工具&#xff0c;…

Python安装、使用MySQL数据库

本机安装的python版本为Python 2.7(win32 bit) 从http://www.codegood.com/archives/129下载MySQL-python-1.2.3.win32-py2.7.exe&#xff0c;点击安装 如果是win版还需要下载&#xff1a;libguide40.dll 和 libmmd.dll这两个文件&#xff0c;下载后放入到到C:\WINDOWS/syste…

pytorch 安装

安装pytorch时&#xff0c;官网不能选择版本。原以为是浏览器问题&#xff0c;换了几个浏览器都不行。 后来FQ之后&#xff0c;就能选择版本了。 sudo pip install torch torchvision转载于:https://www.cnblogs.com/rabitvision/p/8908757.html

《JavaScript 高级程序设计》精读笔记

本系列读书笔记是我通过学习《Javascript 高级程序设计》第3版时结合自己的理解、概括、精炼然后加以一定的拓展&#xff0c;总结而来的&#xff0c;非常适合具有一定基础&#xff0c;同时又想把 JS 基础学更好的童鞋&#xff0c;当然更希望得到大家的反馈于建议&#xff0c;比…