使用mocap在mujoco中实现逆运动学控制

代码地址：https://github.com/kevincheng3/mocap-control
视频地址https://www.bilibili.com/video/BV1jw411d7Aw

在mujoco中实现机械臂的逆运动学控制

前言

MuJoCo 是目前机器人动力学仿真最流行的仿真器之一
MuJoCo官网：http://mujoco.org/
博主在Mujoco反正引擎中搭建了一个UR5机械臂的仿真引擎，希望实现对机械臂末端点位置和姿态的控制（tcp control）。但是查阅了相关的api并未发现有求解逆运动求解器。于是，经过一番探索发现，通过mocap可以很容易实现末端的逆运动学控制。

提示：以下是本篇文章正文内容，下面案例可供参考

一、mocap body的建立

在worldbody下创建一个mocap的body

<body mocap="true" name="mocap" pos="0.08229997 0.10921554 1.871059"><!-- <geom conaffinity="0" contype="0" pos="0 0 0" rgba="0 0.5 0 0.7" size="0.005 0.005 0.005" type="box"></geom><geom conaffinity="0" contype="0" pos="1 0 0" rgba="1 0 0 0.1" size="1 0.005 0.005" type="box"></geom><geom conaffinity="0" contype="0" pos="0 1 0" rgba="0 1 0 0.1" size="0.005 1 0.001" type="box"></geom><geom conaffinity="0" contype="0" pos="0 0 1" rgba="0 0 1 0.1" size="0.005 0.005 1" type="box"></geom> -->
</body>

二、将mocap body固接到末端执行器的body上

<equality><weld body1="mocap" body2="ee_link" solimp="0.9 0.95 0.001" solref="0.02 1"></weld>
</equality>

三、通过设置mocap的位置和姿态实现逆运动学控制

sim.data.set_mocap_pos("mocap", pos)
self.sim.data.set_mocap_quat("mocap", quat)

结果

通过键盘指令可以对机械臂进行位置和姿态控制

"Go up/down/left/right",     "[up]/[down]/[left]/[right] arrow",
"Go forwarf/backward",       "[F]/[B]"
"ROT_X",                      "[Q]/[W]"
"ROT_Y",                     "[A]/[S]"
"ROT_Z",                     "[Z]/[X]"
"Slow down/Speed up",        "[-]/[=]"

使用mocap在mujoco中实现逆运动学控制相关推荐

3D场景中的逆运动学介绍
翻译自https://www.alanzucconi.com/2020/09/14/inverse-kinematics-in-3d/ 参考阅读 2D场景中的逆运动学逆运动学 inverse kin ...
用matlab实现机械臂正逆运动学控制
设计要求: 1.建立一个三自由度的机器人 2.建立坐标系,给出 D-H 参数表: 3.推导正运动学,并写出机器人的齐次变换矩阵: 4.推导逆运动学,并让机器人完成按要求绘制给定图形. 5.MATLAB ...
verp中的redundantRobot的逆运动学注意事项
要更详细的了解verp中的逆运动学还是要再看一看 Solving IK and FK for any type of mechanism 和Basics on IK groups and IK ele ...
柔性matlab机械臂运动空间代码,中正平和的机器人学笔记——2. 机械臂逆运动学（附MATAB代码）...
0. 预备知识(别跳过呀) 上一篇我们讲了正运动学,也就是通过齐次变换矩阵,知晓关节角后求得机械臂末端的位姿,并表示在基座标系下.这一篇我们就来讲一讲逆运动学问题--已知工具坐标系{T}相对于固定坐标 ...
中正平和的机器人学笔记——7. 一种气驱型柔性臂的逆运动学模型
1. 前言上一篇分析了Air-Octor的正运动学模型,这一篇是学习另一篇论文1的笔记,着重分析这种柔性臂的逆运动学模型,也就是通过kϕk_\phikϕ 和 ϕ\phiϕ 以及 sss 来求 l1 ...
CoppeliaSim(原Vrep)中实现多关节机械臂的逆运动学仿真(tar-tip)
文章目录 `本章在动力学建模完成的前提下进行` 1) 将所有关节的运行模式改为逆运动学模式 2)添加Tar&Tip 3)设置逆解计算模式 4)运行仿真后拖动Tar 可以看到Tip点的跟随本章 ...
Matlab Robotic Toolbox V9.10工具箱(二)：正/逆运动学
matlab机器人工具箱 robotic toolbox 做运动学分析非常方便,SerialLink 类中有现成的函数:SerialLink.fkine(theta),可以直接对已经建立的机器人模型做 ...
V-rep学习笔记：机器人逆运动学解算
IK groups and IK elements VREP中使用IK groups和IK elements来进行正/逆运动学计算,一个IK group可以包含一个或者多个IK elements: I ...
利用逆矩阵解线性方程组_机器人学导论---第四章操作臂逆运动学（一）4.1-4.11...
第四章操作臂逆运动学[(一)4.1-4.11] (一)概述 1.为求出要求的关节角以放置相对于工作台坐标系{S}的工具坐标系{T},可将这个问题分为两部分(1)进行坐标变换求出相对于基坐标{B}的腕 ...

使用mocap在mujoco中实现逆运动学控制

前言

一、mocap body的建立

二、将mocap body固接到末端执行器的body上

三、通过设置mocap的位置和姿态实现逆运动学控制

结果

使用mocap在mujoco中实现逆运动学控制相关推荐

最新文章

热门文章