机器人学:物体转动角度变化率与其世界坐标系下角速度的关系推导
本文结构
- 引言
- 推导
- Matlab代码
- 输出结果
- 相关函数
- 总结
引言
一个物体在空间中的六个自由度中有三个旋转角度,如下图所示所有坐标系遵循右手规则。我们定义该物体的欧拉角[r p y]
表示:绕x轴的为r (roll)
即翻滚角,绕y轴的为p (pitch)
即俯仰角,绕y轴的为y (yaw)
即偏航角。那么物体在世界坐标系中的角速度是不是:
w = [dr dp dy]
推导
我们定义物体欧拉角的旋转轴rax,pax,yax
,通过物体在世界坐标系中的旋转矩阵R
,即可以表示出物体角度变化率与角速度之间的关系。这里最要的一点是定义物体位姿传递给世界坐标系的顺序,我们规定物体先翻滚再俯仰最后偏航传递到世界坐标系。用到坐标变换的知识,我们通过matlab的符号解推导。
Matlab代码
clear
clcsyms p r y dp dr dyrax = [1,0,0]'; pax = [0,1,0]';yax = [0,0,1]';R1 = Ryaw(y);
R2 = Ryaw(y)*Rpitch(p);
R3 = Ryaw(y)*Rpitch(p)*Rroll(r);w = R1*yax*dy+R2*pax*dp+R3*rax*drT = jacobian(w,[dr,dp,dy])invT = simplify(inv(T))
输出结果
其结果表示为矩阵形式
相关函数
其中用到的函数分别为:
function R = Rroll(a)R = [1 0 0;0 cos(a) -sin(a);0 sin(a) cos(a)];
end
function R = Ryaw(a)R = [cos(a) -sin(a) 0;sin(a) cos(a) 00 0 1];
end
function R = Rpitch(a)R = [cos(a) 0 sin(a);0 1 0;-sin(a) 0 cos(a)];
end
总结
上述即物体角度变化率与其在世界坐标系中的角速度的关系。用到的坐标变换关系你可以参考Kajita教授编著的《仿人机器人》一书,其中有对旋转关节旋转轴变换到其他坐标系的描述与推导,作者这里直接应用了这一知识点。
机器人学:物体转动角度变化率与其世界坐标系下角速度的关系推导相关推荐
- unity物体自身轴旋转_unity3D实现物体任意角度自旋转
本文实例为大家分享了unity3D实现物体任意角度自旋转的具体代码,供大家参考,具体内容如下 主要涉及函数: Input.GetAxis("Mouse x") 可取得鼠标横向(x轴 ...
- 全权:从多旋翼角度看新时代下的航空人才需求
全权:从多旋翼角度看新时代下的航空人才需求 我要评论 2016年04月20日 16:41:15 来源: 新华网 评论0 打印 字大 字小 北京航空航天大学自动化科学与电气工程学院自控系副教授.可靠飞行 ...
- 相机光心在世界坐标系下的坐标(相机坐标系原点在世界坐标系下的坐标与c2w的关系)
例子 如下图所示,右边的坐标系是相机坐标系,左边的是世界坐标系. 假设他们只有 x 轴方向上的平移. 相机坐标系原点在相机坐标系下的坐标是 (0,0,0), 假设相机坐标系在世界坐标系沿 x 轴正方向 ...
- 相机标定总结(像素坐标系、图像坐标系、相机坐标系和世界坐标系之间的转换关系说明)
近期做了一些机器手臂和摄像头之间手眼标定的内容,在这里对相机的标定做一下总结,手眼标定内容后续更新. 关于三维重建基础知识可以关注更新:MVS学习(一):综述论文阅读记录 1. 相机成像原理说明 数码 ...
- 复杂语境下的实体关系抽取
复杂语境下的实体关系抽取 https://mp.weixin.qq.com/s/NAyuYMLDyx9Fut2blpvbRA
- 解决Ubuntu下软件包依赖关系的若干方法
解决Ubuntu下软件包依赖关系的若干方法 参考文章: (1)解决Ubuntu下软件包依赖关系的若干方法 (2)https://www.cnblogs.com/elnino/archive/2012/ ...
- 【Android 屏幕适配】屏幕适配基础概念 ② ( 像素 px 与 密度无关像素 dip | 像素 px 与 密度无关像素 dip 在不同屏幕像素密度 dpi 下的换算关系 )
文章目录 一.像素 px 与 密度无关像素 dip 二.像素 px 与 密度无关像素 dip 在不同屏幕像素密度 dpi 下的换算关系 参考文档 : 设备兼容性概览 屏幕兼容性概览 支持不同的像素密度 ...
- 欧拉角变化率和机体角速度的关系
写在前面:这篇blog中如果有阐述或理解不对的地方请大佬在评论区批评指正,我将及时改正错误,谢谢!!! 首先需要介绍一下建立无人机数学模型时常说欧拉角.我的理解是:机体坐标系转换到惯性坐标系时每个坐标 ...
- 81.游戏项目-物体任意角度飞行和停止
1 package test; 2 import java.awt.Color; 3 import java.awt.Font; 4 import java.awt.Frame; 5 import j ...
最新文章
- from . import_python首行代码import *,from * import * 解析
- Opencv 实现图像的离散傅里叶变换(DFT)、卷积运算(相关滤波)
- TCP负载均衡地址转换(锐捷设备)
- 张一鸣演讲全文:外部波澜起伏,内心平静如常
- Jmeter集合ant进行操作
- 使用轻量级Spring @Scheduled注解执行定时任务
- Android studio Github 断开连接
- Linux 中 elasticsearch6.3.0 单机安装
- php正则匹配js中变量_Postgresql 中的 正则表达式 模式匹配
- openssl证书相关
- 2018北大计算机复试线,北京大学历年考研复试分数线_2018考研分数线
- 求一个序列中,第k个数
- 屏幕适配 percent_库的扩展
- glmark2移植到嵌入式Linux,嵌入式中移植基于Framebuffer的LittlevGL
- 关于在GridControl中添加GridLookUpEdit绑定数据
- [SharePoint教程系列] 0.SharePoint 2016介绍
- 短视频标题自动生成工具,助你打造爆款标题
- VueX浏览器刷新如何保存数据
- 骂人不带脏字的80后
- ecu的c语言编程,ecu中的程序是如何编写的