ros python 构造 pose
2024-08-23 00:13:17
#!/usr/bin/env python
import numpy as np
from geometry_msgs.msg import Pose, Point, Quaternion, Twist
from tf.transformations import quaternion_from_euler
#orientation x,y,z,w
#x=i[3]
#y=i[4]
#z=i[5]
#w=i[6]
g=np.array([i[3],i[4],i[5],i[6]])
#position x,y,z
#x=i[0]
#y=i[1]
#z=i[2]
print(Pose(Point(i[0],i[1],i[2]), Quaternion(*g)))
最新文章
- 冗余代码都走开——前端模块打包利器 Rollup.js 入门
- 关于Certificate、Provisioning Profile、App ID的介绍及其之间的关系
- Spring MVC常见的三种URL请求参数的处理
- centos 6.4 /var/log/secure 不记录日志的問題
- Ruby on Rail学习笔记
- P==NP??
- 鸟哥的Linux私房菜 第十八章、认识系统服务 (daemons)
- 【czy系列赛】czy的后宫6 &;&; bzoj1044 [HAOI2008]木棍分割
- jQuery Moblile Demos学习记录Panel
- Android研究之手PullToRefresh(ListView GridView 下拉刷新)使用具体解释
- python 日历
- c#FTP操作类,包含上传,下载,删除,获取FTP文件列表文件夹等Hhelp类
- Kylin与CDH兼容性剖析
- Bootstrap3 概述
- Undefined、Null区别渗透
- HDU4779 Tower Defense 组合数学
- Linux 下安装 Tomcat 出现拒绝访问的情况
- 吴恩达机器学习CS229课程笔记学习
- cocos2dx - Lua 语言
- JAVA解压文件
热门文章
- linux环境,hidraw设备自动加载时默认权限的设置方法
- 用scrapy爬取京东商城的商品信息
- ubuntu下使用JNI Java调用C++的例子
- MongoDB 无法启动
- Xshell 上传文件到Ubuntu
- Django组件之modelformset
- 持续集成实践---基于ant+jmeter+jenkins接口CI
- RabbitMQ3 单机及集群安装配置及优化
- ***PHP preg_match正则表达式的使用 转载:https://www.cnblogs.com/kenshinobiy/p/4443600.html
- 一次vaccum导致的事故