ros python 四元数 转 欧拉角
2024-08-27 12:08:22
import sys
import math
w = -0.99114048481
x = -0.00530699081719
y = 0.00178255140781
z = -0.133612662554
r = math.atan2(2*(w*x+y*z),1-2*(x*x+y*y))
p = math.asin(2*(w*y-z*z))
y = math.atan2(2*(w*z+x*y),1-2*(z*z+y*y))
angleR = r*180/math.pi
angleP = p*180/math.pi
angleY = y*180/math.pi
print (angleR)#翻滚
print (angleP)#俯仰
print (angleY)#偏航
输出:
0.575472843396
-2.24876083545
15.3574378019
https://blog.csdn.net/pengcan985632236/article/details/85230675
https://blog.csdn.net/u012700322/article/details/52252305
https://blog.csdn.net/zhouxinlin2009/article/details/81050028
https://blog.csdn.net/dinnerhowe/article/details/79569281
https://blog.csdn.net/super_mice/article/details/45619945
https://blog.csdn.net/wwlcsdn000/article/details/79421612#comments
最新文章
- 【数据结构】简单谈一谈二分法和二叉排序树BST查找的比较
- Mac快捷键与命令学习
- Android Studio签名打包的两种方式
- DirectX基础学习系列1
- 李洪强漫谈iOS开发[C语言-022]-算术运算符
- Windows命令行语法说明
- JuliaSet&;MandelBulb @ Maya&;KK —— 4亿粒子的测试
- Jemter
- php保留小数格式的多种方法
- cocos2dx 在mac下开发ios和android游戏
- (转)centos7安装telnet服务
- 安装虚拟机,磁盘选择厚置备延迟置零与厚置备置零和Thin Provision有什么区别
- CentOS7的网卡重启方法
- day16_雷神_前端04
- MyBatis映射文件2(不支持自增的数据库解决方案/参数处理[单参、多参、命名参数])
- input子系统事件处理层(evdev)的环形缓冲区【转】
- Hyper-V 安装系统
- org.apache.commons.net.ftp
- Fibre Channel address weaknesses
- “全栈2019”Java异常第一章:什么是异常?
热门文章
- C# 阿拉伯数字转换为中文数字/中文数字转换为阿拉伯数字
- entity-framework-core – 实体框架核心RC2表名称复数
- mysql 系统变量
- 今日前端框架Vue学习笔记
- iptables的nat规则骚操作
- JAVA多线程之UncaughtExceptionHandler——处理非正常的线程中止
- Linux 非互联网环境安装依赖包
- HTTP 协议部分常识简介
- C++——Big Three(copy ctor、copy op=、dtor)
- 报错:ipython 6.5.0 has requirement prompt-toolkit<;2.0.0,>;=1.0.15, but you&#39;ll have prompt-toolkit 2.0.15 which is incompatible.