MATLAB - 机器人关节空间运动模型

这篇具有很好参考价值的文章主要介绍了MATLAB - 机器人关节空间运动模型。希望对大家有所帮助。如果存在错误或未考虑完全的地方,请大家不吝赐教,您也可以点击"举报违法"按钮提交疑问。

系列文章目录

 文章来源地址https://www.toymoban.com/news/detail-787291.html


前言

关节空间运动模型描述了在闭环关节空间位置控制下机械手的运动,在关节空间运动模型(jointSpaceMotionModel)对象和关节空间运动模型块中使用。

机器人机械手是典型的位置控制设备。要进行关节空间控制,需要指定关节角度或位置向量 q,以跟踪参考配置 q 参考 . 为此,您可以对机器人关节进行闭环控制,并使用运动模型模拟机器人在此控制下的行为。

MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂

要使这种方法最接近实际系统的运动,就必须准确表示控制器和被控对象的动态。本主题将介绍在闭环联合空间位置控制下的机器人行为建模方法:

  • 作为受计算扭矩控制的系统
  • 作为受 PD 控制的系统
  • 作为具有独立关节运动的系统

 


 

一、背景介绍

1.1 关节空间运动模型与任务空间运动模型

一般来说,机器人位置控制分为两类:

  • 关节空间运动控制 - 在这种情况下,机器人的位置输入被指定为一个关节角度或位置向量,即机器人的关节配置 q。 ref 这也被称为配置空间控制。
  • 任务空间运动控制 - 将位置指定为控制器的末端执行器姿势。然后,控制器驱动机器人的关节配置值将末端执行器移动到指定位置。这有时被称为操作空间控制。

下图显示了这两种运动控制中不同类型的输入/输出。

MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂

MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂

本专题页专门讨论关节空间运动控制,如 jointSpaceMotionModel 对象和关节空间运动模型块中所使用。有关任务空间运动模型,请参阅任务空间运动模型对象。如需更详细了解任务空间和联合空间控制之间的区别,请参阅使用 KINOVA Gen3 机械手计划和执行任务空间和联合空间轨迹的示例。

1.2 在 MATLAB® 和 Simulink® 中使用

关节空间运动模型可以在 MATLAB 或 Simulink 中表示。

在 Simulink 中,关节空间运动模型块接受参考输入和可选外力(如适用),并返回关节配置、速度和加速度。该程序块可处理积分,因此无需额外的积分。

在 MATLAB 中,jointSpaceJointModel 系统对象对闭环运动进行建模。导数方法返回关节配置、速度和加速度在每一时刻的导数,因此必须使用 ODE 求解器或等效的外部积分方法来模拟时间运动。

有关更具体的概述,请参阅相关文档页面。

二、状态

关节空间运动模型的状态由这些值组成:

q - 机器人关节配置,作为关节位置矢量。旋转关节以 rad 为单位,棱柱关节以 m 为单位。

- 关节速度矢量,旋转关节以 为单位,棱柱关节以 为单位。

- 关节加速度矢量,对于旋转关节,单位为 ;对于棱柱关节,单位为

三、闭环关节空间运动类型的运动方程

当需要闭环控制下系统的低保真模型,且输入指定为关节配置、速度和加速度时,可使用关节空间运动模型。运动模型包括三种整体行为建模方式:

  • 计算转矩控制下的系统 - 刚体动力学建模采用标准刚体机器人动力学,但对全身动力学进行补偿并分配误差动力学。
  • PD 控制下的系统 - 刚体动力学建模采用标准刚体机器人动力学,并通过比例-派生 (PD) 控制和重力补偿提供关节扭矩输入。该模型所代表的控制器没有对刚体运动的整体效应进行严格补偿。
  • 作为具有独立关节运动的系统 - 每个关节都被独立建模为配置不变的闭环二阶系统。该模型的保真度较低,忽略了机器人的动态特性,并假定为闭环响应。在没有外力作用的情况下,该模型可视为闭环运动的最佳表现形式,因为其动力学特性已被简化并直接规定。

要设置这些不同的运动类型,请使用 jointSpaceMotionModel 对象的 MotionType 属性。这些运动类型并不是详尽无遗的,但它们确实提供了一组在近似系统闭环行为时可以使用的选项。有关何时使用哪种模型的详细信息和建议,请参阅以下章节。

在接下来的章节中,将按照复杂程度递减的顺序介绍每种模型的运动方程。这里的复杂度是指特定运动模型的计算量。高复杂度变量通过直接模拟环路内的控制器和动力学来模拟受相当先进的控制器影响的动力学,而低复杂度模型则使用简化的动力学来表示整体误差行为。

3.1 符号和术语

闭环系统的许多运动方程都源自标准刚体机器人动力学,后者定义了机器人的开环运动。此外,方程中还经常会使用一个斜杠来表示误差动态,例如 。

3.2 计算扭矩控制

当运动模型被定义为受计算扭矩控制的机器人时,运动模型使用标准刚体机器人动力学,但广义力输入由控制法则提供,该法则对刚体动力学进行补偿,并分配二阶误差动力学响应。

输入 - 该模型接受 作为所需的参考关节配置、速度和加速度矢量。用户还可以选择提供一个外力和扭矩矩阵 Fext,以牛顿和牛顿-米为单位,使用 externalForce 函数生成。

输出 - 模型以向量形式输出关节配置、速度和加速度 。在 MATLAB 版本的模型中,只返回加速度,用户必须选择积分器或 ODE 解算器来返回其他状态。

复杂性--这是一个高复杂性模型。运动模型使用带有可选外力的全刚体动力学,控制器作为闭环系统的一部分进行建模,控制器包含动态补偿项。

何时应用 - 当模拟的闭环系统具有可近似误差的动力学特性时,或当使用的控制器将机器人视为多体系统,且可能存在外力时,可使用该功能。

由此产生的闭环系统旨在实现第 i 个关节的以下第二误差行为:

这些参数描述了为每个关节定义的理想响应:

- 自然频率,单位为赫兹

ζ - 阻尼比,无单位

 MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂

 如图所示,整个系统由标准刚体机器人动力学和控制法则组成,控制法则通过广义力输入 Q 强化闭合误差动力学:

 

eq?Q%3Dg%20C%20T%20%7BC%7D%28%5Ctilde%7Bq%7D%2C%5Cdot%7B%5Ctilde%7Bq%7D%7D%2C%5Cddot%7B%7Bq%7D%7D_%7Bref%7D%2C%5Comega%20_n%2C%5Czeta%29%3DM%28q%29a%20_q+C%28q%2C%5Cdot%7Bq%7D%29%5Cdot%7Bq%7D+G%28q%29 

其中

M(q) - 是基于当前机器人配置的联合空间质量矩阵 使用 massMatrix 对象函数计算该矩阵。

- 科里奥利项。它与关节速度一起构成速度乘积 ,可使用速度乘积对象函数计算。

G(q) - 在指定重力条件下,由于作用在机器人上的重力重量和力量,所有关节为保持其位置所需的力矩和力量。使用重力力矩对象函数计算重力力矩。

- 关节空间运动模型(jointSpaceMotionModel)对象的自然频率(NaturalFrequency)属性中的自然频率 N 乘 N 对角矩阵,单位为 Hz()。

 - 自然频率 n 的平方乘积与 jointSpaceMotionModel 对象的 DampingRatio 属性中指定的阻尼比 ζ 的 N-by-N 对角矩阵。

ωn 和 ζ 的值可以直接设置,也可以使用 updateErrorDynamicsFromStep 方法提供,该方法根据所需的单位步响应(使用瞬态行为特征定义)计算 ωn 和 ζ 的值。

由于对动态进行了补偿,因此在没有外力输入的情况下,假设反馈项连续积分且无时间延迟,就能实现误差动态。因此,在没有外力的情况下,独立关节运动类型为相同运动提供了一种更简单的建模方式。

有关机器人动力学的更多信息,请参阅机器人动力学。

3.3 比例-微分 (PD) 控制

当机器人被定义为受 PD 控制的系统时,机器人将根据标准刚体机器人动力学建立行为模型,但其广义力输入 Q 由控制法则给出,该法则根据关节误差和重力补偿应用 PD 控制。

输入 - 该模型接受 作为所需的参考关节配置和速度(以向量形式指定)。用户还可以选择提供外力和扭矩 Fext,以牛顿和牛顿-米为单位,使用 externalForce 函数生成。

输出--模型输出  为关节配置、速度和加速度。在 MATLAB 版本的模型中,只返回加速度,用户必须选择积分器或 ODE 求解器来返回其他状态。

复杂性 - 中等复杂性。运动模型使用带有可选外力的全刚体动力学,控制器作为闭环系统的一部分建模,但控制器相对简单。

何时应用 - 当模拟的闭环系统使用将关节视为独立系统的控制器时,或使用 PD 型控制器且可能存在外力时,请使用该控制器。

MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂

与计算扭矩控制一样,该系统行为采用标准刚体机器人动力学,但使用 PD 控制法定义广义力输入 Q:

eq?%5Cbegin%7Baligned%7D%26%5Cfrac%20d%7Bdt%7D%5Cbegin%7Bbmatrix%7Dq%5C%5C%5Cdot%7Bq%7D%5Cend%7Bbmatrix%7D%3Df_%7Bdyn%7D%28q%2C%5Cdot%7Bq%7D%2C%5Ctau%2CF%7Bext%7D%29%5C%5C%5C%5C%26Q%3Dg_%7BPD%7D%28%5Cwidetilde%7Bq%7D%2C%5Cdot%7B%5Cwidetilde%7Bq%7D%7D%2CK_P%2CK_D%29%3D-K_P%28%5Cwidetilde%7Bq%7D%29-K_D%28%5Cdot%7B%5Cwidetilde%7Bq%7D%7D%29+G%28q%29%5C%5C%5C%5C%26%5Cwidetilde%7Bq%7D%3Dq-qref%5Cend%7Baligned%7D

其中

G(q) - 是所有关节在刚体树的重力属性中指定的重力下保持位置所需的重力扭矩和力。使用 gravityTorque 对象函数计算重力扭矩。

控制输入依赖于这些用户定义的参数:

- 比例增益,指定为 N 乘 N 矩阵,其中 N 为机械手可移动关节的数量

- 微分增益,指定为 N 乘 N 矩阵

3.4 独立关节运动

在对该系统进行独立关节运动建模时,不是将闭环系统建模为标准刚体机器人动力学加控制输入,而是将每个关节建模为二阶系统,该系统已具有所需的误差行为:

  • 输入 - 该模型接受 作为所需的参考关节配置和速度(以矢量形式给出)。没有外力输入。
  • 输出 - 模型输出 作为关节配置、速度和加速度。在该模型的 MATLAB 版本中,只返回加速度,用户必须选择积分器或 ODE 求解器来返回其他状态。
  • 复杂性 - 复杂性较低。运动模型只是规定了位置控制器可以实现的误差行为。
  • 何时应用 - 当系统具有可近似的误差动态,且不需要外力输入时使用。

该系统为第 i 个关节建立了以下闭环二阶行为模型:

- 自然频率,单位为赫兹

ζ - 阻尼比,无单位

MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂

MATLAB - 机器人关节空间运动模型,机器人,自动驾驶,ROS,matlab,关节空间,机器人控制,机械臂 

因此,整个系统的模型为

eq?%5Cdfrac%20d%7Bdt%7D%5Cbegin%7Bbmatrix%7Dq%5C%5C%5Cdot%7Bq%7D%5Cend%7Bbmatrix%7D%3DflJM%28qref%2C%5Cdot%7Bq%7Dref%2C%5Czeta%2C%5Comega%20n%29%3D%5Cbegin%7Bbmatrix%7D0%26I%5C%5C%5Cbegin%7Bbmatrix%7D-%5Comega_n%5E2%5Cend%7Bbmatrix%7D_%7Bdiag%7D%26%5B-2%5Czeta%5Comega_n%5D_%7Bdiag%7D%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7Dq%5C%5C%5Cdot%7Bq%7D%5Cend%7Bbmatrix%7D+%5Cbegin%7Bbmatrix%7D0%20%26%20I%20%5C%5C%20%5B%5Comega_%7Bn%7D%5E2%5D_%7Bdiag%7D%20%26%20%5B2%5Czeta%5Comega_%7Bn%7D%5D_%7Bdiag%7D%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7Dqref%5C%5C%5Cdot%7Bq%7Dref%5Cend%7Bbmatrix%7D 

该模型依赖于这些用户定义的参数:

- JointSpaceMotionModel 对象的 NaturalFrequency 属性中自然频率的 N-by-N 对角矩阵,单位为 Hz (s-1)。

- 自然频率平方和 ωn 与 jointSpaceMotionModel 对象的 DampingRatio 属性中指定的阻尼比 ζ 的乘积的 N-by-N 对角矩阵。

ωn 和 ζ 的值可以直接设置,也可以使用 updateErrorDynamicsFromStep 方法提供,该方法根据所需的单位步响应(使用瞬态行为特征定义)计算 ωn 和 ζ 的值。

独立关节运动模型代表了理想化行为下的闭环系统。在没有外力的情况下,假设反馈没有延迟(如连续积分),使用计算扭矩控制的运动模型会产生等效输出。

 

 

到了这里,关于MATLAB - 机器人关节空间运动模型的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处: 如若内容造成侵权/违法违规/事实不符,请点击违法举报进行投诉反馈,一经查实,立即删除!

领支付宝红包 赞助服务器费用

相关文章

  • 使用贝叶斯滤波器通过运动模型和嘈杂的墙壁传感器定位机器人研究(Matlab代码实现)

     💥💥💞💞 欢迎来到本博客 ❤️❤️💥💥   🏆博主优势: 🌞🌞🌞 博客内容尽量做到思维缜密,逻辑清晰,为了方便读者。 ⛳️ 座右铭: 行百里者,半于九十。 📋📋📋 本文目录如下: 🎁🎁🎁 目录 💥1 概述 📚2 运行结果 🎉3 参考文献 🌈4 Matlab代码实现 使用

    2024年02月14日
    浏览(47)
  • Matlab机器人的仿真(八):绘制机器人运动轨迹(复现)

    跑一得出运动轨迹的动图结果: 跑二得出的绘出6个关节的角度,角速度,角加速度的信息图: 跑三得出的结果:末端点轨迹(x-y-z视图)

    2024年02月11日
    浏览(52)
  • matlab中画有重影的机器人运动过程【给另一个机器人设置透明度】

    1、前言如题 2、参考连接如下 How to plot two moving robot in the same figure and change one of them transparency? - MATLAB Answers - MATLAB Central (mathworks.cn)3、代码:【找到figure中对应对象并设置属性】 4、结果【同样的轨迹,实影的先运动几个步数,虚影后续运动】    

    2024年02月17日
    浏览(50)
  • Matlab机器人运动学与正逆解算法学习笔记

    关于机器人正逆解的原理、算法、代码什么的,在网上一找一大堆,其本身也是关于机器人的知识里面最基础的,其实没什么好写的,这里只是把我理解的内容整理一下,方便自己和需要的人查看。 另外这里要感谢赵而阳师弟,之前我在弄有限元分析的内容,把机器人相关的

    2024年02月08日
    浏览(66)
  • 【Matlab】非对称3-SPR并联机器人正逆运动学

    省流说明: 本文提供球铰的非对称布置情况下其正逆运动学的求解,但需要有额外的输入参数 S :球铰 P :移动副 R :转动副 3-SPR并联机器人即包含三条独立的SPR运动支链 输入 :三个移动副(P)的伸长量 输出 :系统末端参考点(一般是动平台的中心点) 运动学模型如下:

    2024年01月17日
    浏览(50)
  • MATLAB的rvctools工具箱熟悉运动学【机械臂机器人示例】

    rvctools下载地址:rvctools下载 截图如下,点击红色箭头指示的 “ Download Shared Folder ” 即可下载 下载之后进行解压,解压到 D:MATLABtoolbox 这个工具箱目录,这个安装路径根据自己的情况来选择,没有安装MATLAB,感兴趣的可以查阅:MatLab的下载、安装与使用(亲测有效) 然后我们

    2024年02月05日
    浏览(56)
  • 非对称3-SPR并联机器人正逆运动学(Matlab源码)

    省流说明: 本文提供球铰的非对称布置情况下其正逆运动学的求解,但需要有额外的输入参数 S :球铰 P :移动副 R :转动副 3-SPR并联机器人即包含三条独立的SPR运动支链 输入 :三个移动副(P)的伸长量 输出 :系统末端参考点(一般是动平台的中心点) 运动学模型如下:

    2024年02月02日
    浏览(51)
  • 建模分析 | 差速轮式移动机器人运动学建模(附Python/Matlab仿真)

    🔥附C++/Python/Matlab全套代码🔥课程设计、毕业设计、创新竞赛必备!详细介绍全局规划(图搜索、采样法、智能算法等);局部规划(DWA、APF等);曲线优化(贝塞尔曲线、B样条曲线等)。 🚀详情:图解自动驾驶中的运动规划(Motion Planning),附几十种规划算法 差速轮式移动机器人

    2024年02月05日
    浏览(46)
  • MATLAB - 机器人逆运动学设计器(Inverse Kinematics Designer APP)

          通过逆运动学设计器,您可以为 URDF 机器人模型设计逆运动学求解器。您可以调整逆运动学求解器并添加约束条件,以实现所需的行为。使用该程序,您可以 从 URDF 文件或 MATLAB 工作区导入 URDF 机器人模型。 调整逆运动学求解器和约束条件。 创建关节配置并导出航点

    2024年04月14日
    浏览(30)
  • Matlab 机器人工具箱 (一)DH参数和正逆运动学

    作者为大三学生,本博客为边学习边使用,如有错误,请见谅。 在文章结束附加代码。 前置坐标系对应改进版:modified 后置坐标系对应标准版:standard 因为学习过程中大部分为前置坐标系,故本文仅讨论前置坐标系。 用的最习惯的是如下的代码: 参数‘alpha’代表扭转角

    2024年02月02日
    浏览(57)

觉得文章有用就打赏一下文章作者

支付宝扫一扫打赏

博客赞助

微信扫一扫打赏

请作者喝杯咖啡吧~博客赞助

支付宝扫一扫领取红包,优惠每天领

二维码1

领取红包

二维码2

领红包