三维坐标的旋转矩阵转换测试Demo(ROS1 RVIZ)

2024-08-21 07:20

本文主要是介绍三维坐标的旋转矩阵转换测试Demo(ROS1 RVIZ),希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

已知空间上的某一个点P在坐标系1下的位置为 P1(1,2,3),需要求出P在三维空间坐标系0之间的相对关系,其中坐标系1是相对于坐标系0绕着x轴旋转60度后转化。示意如下图
在这里插入图片描述

程序设计

  • 定义P点在坐标系1下的位置
array = np.array([1,2,3])
# [1 2 3]
  • 定义坐标系1和坐标系0之间的旋转矩阵
PI = 3.14
angle = 60/360*PItransforat_array = np.array([[1,0,0],[0,math.cos(angle),math.sin(angle)],[0,-math.sin(angle),math.cos(angle)]])
# [[ 1.          0.          0.        ]
#  [ 0.          0.86615809  0.4997701 ]
# [ 0.         -0.4997701   0.86615809]]
  • 得到转换结果
d = np.dot(array,transforat_array)
# [1.         0.23300588 3.59801449]

整体程序

import math
import numpy as np
PI = 3.14array = np.array([1,2,3])
angle = 60/360*PIprint(angle)
transforat_array = np.array([[1,0,0],[0,math.cos(angle),math.sin(angle)],[0,-math.sin(angle),math.cos(angle)]])
print(array)
print(transforat_array)d = np.dot(array,transforat_array)
print(d)

使用ROS 的RVIZ进行查看验证

按照顺序打开和输入指令,不同的的指令需要开启不同的终端执行

roscore
rosrun tf2_ros static_transform_publisher 1 2 3 0 0 0 /base_1 /p
rosrun tf2_ros static_transform_publisher 0 0 0 0 0 0.523333 /base_0 /base_1
rosrun rviz rviz

讲话Fixed Frame选择为base_0,表示观察的基坐标,然后就可以查看P点和他之间的相对位置关系,可以从中第二个方框看出ROS计算得到的旋转结果和之前python程序计算出来的结果相同。
在这里插入图片描述
在测试的Demo当中,使用的还是静态的发布关系,一般在机械臂上面各个关节关节之间的关系一般会保持静止,变动的是末端执行机构和目标物体之间的相对位置姿态,后续就可以程序来找出机械臂末端的执行机构需要运动到达目标物体的角度和路线了。

这篇关于三维坐标的旋转矩阵转换测试Demo(ROS1 RVIZ)的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/1092492

相关文章

python+opencv处理颜色之将目标颜色转换实例代码

《python+opencv处理颜色之将目标颜色转换实例代码》OpenCV是一个的跨平台计算机视觉库,可以运行在Linux、Windows和MacOS操作系统上,:本文主要介绍python+ope... 目录下面是代码+ 效果 + 解释转HSV: 关于颜色总是要转HSV的掩膜再标注总结 目标:将红色的部分滤

利用Python开发Markdown表格结构转换为Excel工具

《利用Python开发Markdown表格结构转换为Excel工具》在数据管理和文档编写过程中,我们经常使用Markdown来记录表格数据,但它没有Excel使用方便,所以本文将使用Python编写一... 目录1.完整代码2. 项目概述3. 代码解析3.1 依赖库3.2 GUI 设计3.3 解析 Mark

C语言中的数据类型强制转换

《C语言中的数据类型强制转换》:本文主要介绍C语言中的数据类型强制转换方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录C语言数据类型强制转换自动转换强制转换类型总结C语言数据类型强制转换强制类型转换:是通过类型转换运算来实现的,主要的数据类型转换分为自动转换

Java实现XML与JSON的互相转换详解

《Java实现XML与JSON的互相转换详解》这篇文章主要为大家详细介绍了如何使用Java实现XML与JSON的互相转换,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 目录1. XML转jsON1.1 代码目的1.2 代码实现2. JSON转XML3. JSON转XML并输出成指定的

Java实现将Markdown转换为纯文本

《Java实现将Markdown转换为纯文本》这篇文章主要为大家详细介绍了两种在Java中实现Markdown转纯文本的主流方法,文中的示例代码讲解详细,大家可以根据需求选择适合的方案... 目录方法一:使用正则表达式(轻量级方案)方法二:使用 Flexmark-Java 库(专业方案)1. 添加依赖(Ma

Java实现将byte[]转换为File对象

《Java实现将byte[]转换为File对象》这篇文章将通过一个简单的例子为大家演示Java如何实现byte[]转换为File对象,并将其上传到外部服务器,感兴趣的小伙伴可以跟随小编一起学习一下... 目录前言1. 问题背景2. 环境准备3. 实现步骤3.1 从 URL 获取图片字节数据3.2 将字节数组

Java中数组转换为列表的两种实现方式(超简单)

《Java中数组转换为列表的两种实现方式(超简单)》本文介绍了在Java中将数组转换为列表的两种常见方法使用Arrays.asList和Java8的StreamAPI,Arrays.asList方法简... 目录1. 使用Java Collections框架(Arrays.asList)1.1 示例代码1.

Python使用PIL库将PNG图片转换为ICO图标的示例代码

《Python使用PIL库将PNG图片转换为ICO图标的示例代码》在软件开发和网站设计中,ICO图标是一种常用的图像格式,特别适用于应用程序图标、网页收藏夹图标等场景,本文将介绍如何使用Python的... 目录引言准备工作代码解析实践操作结果展示结语引言在软件开发和网站设计中,ICO图标是一种常用的图像

Python3脚本实现Excel与TXT的智能转换

《Python3脚本实现Excel与TXT的智能转换》在数据处理的日常工作中,我们经常需要将Excel中的结构化数据转换为其他格式,本文将使用Python3实现Excel与TXT的智能转换,需要的可以... 目录场景应用:为什么需要这种转换技术解析:代码实现详解核心代码展示改进点说明实战演练:从Excel到

SpringBoot中整合RabbitMQ(测试+部署上线最新完整)的过程

《SpringBoot中整合RabbitMQ(测试+部署上线最新完整)的过程》本文详细介绍了如何在虚拟机和宝塔面板中安装RabbitMQ,并使用Java代码实现消息的发送和接收,通过异步通讯,可以优化... 目录一、RabbitMQ安装二、启动RabbitMQ三、javascript编写Java代码1、引入