程序员经验分享-hwhale

【坐标转换】lla转换成enu坐标（无损版）

2023-05-16 
import numpy as np  
import smpy.utils as smpy_utils
import ditu.topbind as tb
from scipy.spatial.transform import Rotation as R
import o3d_hdmap.open3d as o3d
geojson_path = '/data/mpcv_lspo_download_data/prod/PLEF35196-2021-11-10-17-48-39/mapping_results/ground_pole_geojson_LC.json'
geojson_data = smpy_utils.read_json(geojson_path)
anchor_lla_ = tb.utils.ecef2lla( np.array(geojson_data['extrinsics'][0]['center']))
lla = [111.64994725780178,30.73907846113732,131.25631082151085]
enu = tb.utils.lla2enu_cheap([lla], anchor_lla=anchor_lla_)
print(enu)
[[  966.10732692 -5813.22954404   -59.09057418]]

上述方法操作简单，但是lla2enu_cheap函数存在损失，导致结果不够准确。需要无损的lla2enu转换，则使用如下方法进行
坐标转换：通过旋转矩阵乘以（lla2ecef - 锚点（ecef））的方式，将lla转换成enu坐标

import numpy as np  
import smpy.utils as smpy_utils
import ditu.topbind as tb
from scipy.spatial.transform import Rotation as R
import o3d_hdmap.open3d as o3d

geojson_path = '/data/mpcv_lspo_download_data/prod/PLEF35196-2021-11-10-17-48-39/mapping_results/ground_pole_geojson_LC.json'
geojson_data = smpy_utils.read_json(geojson_path)
Q_w = geojson_data['extrinsics'][0]['Rwc_quat_wxyz']
w,x,y,z = Q_w[0],Q_w[1],Q_w[2],Q_w[3]
Q_w = [x,y,z,w]
r = R.from_quat(Q_w) 
Q_w = r.as_matrix()
Q_w_inv = np.linalg.inv(Q_w)
t_w = np.array(geojson_data['extrinsics'][0]['center'])

output_dir = 'output_grid_size_2m_deltas_1m'
geojson_points_enu = []
for feature in geojson_data['features']:
    if feature['properties']['type'] == 'road_surface':
        for coord in feature['geometry']['coordinates']:
            t_l = np.array(tb.utils.lla2ecef(coord))
            w_t_l = Q_w_inv @ (t_l-t_w)
            geojson_points_enu.append(w_t_l)
geojson_points_enu = np.array(geojson_points_enu)
pcd = o3d.geometry.PointCloud()
pcd.points = o3d.utility.Vector3dVector(geojson_points_enu)
colors = np.zeros(geojson_points_enu.shape)
colors[:, 1] = 1
pcd.colors = o3d.utility.Vector3dVector(colors)
path = f'{output_dir}/origin_geojson_all_points.pcd'
o3d.io.write_point_cloud(path, pcd)
本文内容由网友自发贡献，版权归原作者所有，本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容，请联系:hwhale#tublm.com(使用前将#替换为@)

【坐标转换】lla转换成enu坐标（无损版） 的相关文章

  • idea Services项目运行后启动类没有显示端口号

    文章目录 问题描述原因分析 xff1a 解决方案 xff1a 问题描述 Services 项目运行后启动类没有显示端口号 原因分析 xff1a 旧版插件升级才会出现这种情况 xff0c 这个功能是近期升级新版本添加的 xff0c 以前安装后

  • [08S01] 驱动程序无法通过使用安全套接字层(SSL)加密与 SQL Server 建立安全连接。错误:“The server selected protocol version TLS10 is

    文章目录 项目场景问题描述解决方案方案一 xff1a 修改jdk xff08 推荐 xff09 方案二 xff1a 修改idea 测试连接 项目场景 Idea使用DateSource插件连接SqlServer数据库报错 问题描述 08S01

  • JDK1.8Stream根据条件过滤出两个List集合中不一样的数据

    文章目录 前言1 基础类2 核心代码2 1 单条件筛选2 2 多条件筛选 前言 需求 xff1a 对两个数据库 xff08 一个SqlServer xff0c 一个MySQL xff09 xff0c 同一张表做数据同步 xff0c 保证两边

  • Dockers更新镜像（保留原始数据）

    文章目录 一 前言 二 使用步骤 1 拉取需要更新的镜像版本 2 获取当前镜像启动参数 3 停止当前镜像 4 启动新镜像 5 删除旧镜像 三 测试验证 一 前言 日常工作中 应用程序为了避免漏洞 体验等等肯定是需要定期更新的 使用Docke

  • FRP实现内网穿透

    文章目录 前言一 frp是什么 xff1f 二 使用步骤1 安装frp2 有公网IP Centos2 1 frps配置2 2 防火墙配置 xff08 有坑 xff09 3 配置无公网IP Centos4 内网穿透测试 前言 使用旧笔记本电脑

  • Linux创建普通用户并设置目录权限

    文章目录 前言 使用步骤 1 创建普通用户 2 创建docker用户组 3 测试 4 扩展 前言 实际工作中 通常为什么不直接使用root账户而要使用普通账户呢 因为root的权限太大了 一旦用户 特别是小白用户直接使用root账户的话 那

  • Error response from daemon: unauthorized: unauthorized to access repository:xxx

    问题描述 Jenkins构建项目异常 xff1a Unable to span class token function find span image span class token string 39 xxx latest 39 sp

  • 宝塔Linux面板phpMyAdmin无法打开/打开404完美解决方案

    文章目录 问题描述解决方案1 宝塔放行端口2 放行安全组端口3 解决开启防火墙方案3 1 方案一 xff1a 放行防火墙端口3 2 方案二 xff1a 关闭防火墙 问题描述 宝塔面板安装phpMyAdmin后打不开 xff0c 无响应 解决

  • Ubuntu18.04配置PX4编译环境

    最近尝试使用Ubuntu18 04重新配置了一下PX4编译环境 http dev px4 io master en setup dev env linux ubuntu html 跟着官网走 非常简单 1 运行ubuntu sim ros

  • Windows高精度时钟

    封装几个代码 xff0c 方便以后查询和使用 Windows高精度时钟 精度 xff1a lt 1us 微秒 1 1Function 1统计一段代码的CPU时间 LARGE INTEGER freq span class token pun

  • LAMP平台配置

    Apache安装 安装httpd 96 yum y install httpd 96 启动apache服务 xff1a service httpd start验证apache的端口是否开放 xff1a ss antpl grep 80建立a

  • ROS实战篇（二）如何创建自定义的msg文件以及自己编写launch文件？

    一 如何创建自定义的msg文件 xff1f msg文件介绍 xff1a 1 msg文件是用来描述ROS中自定义的消息类型的 xff0c 可以被不同语言调用 2 msg文件以 msg 结尾 xff0c 必须存放在软件包的msg文件夹下 3 m

  • 十五、Linux驱动之USB鼠标驱动

    1 如何编写USB鼠标驱动 结合十四 Linux驱动之USB驱动分析中的分析 xff0c 我们开始写一个USB鼠标驱动 USB的驱动可以分为3类 xff1a SoC的USB控制器的驱动 xff0c 主机端USB设备的驱动 xff0c 设备上

  • kazam录制视频转码

    Ubuntu安装kazam录制视频转码问题 录制转码 录制 在ubuntu下录制视频发现录制mp4视频在windows中大部分无法打开播放只有potplayer可以 xff0c 主要是两边视频格式不支持 xff0c 为此需要进行转码 转码

  • layui实现文件分片上传

    html代码 lt DOCTYPE html gt lt html gt lt head gt lt meta charset 61 34 utf 8 34 gt lt title gt layui lt title gt lt meta

  • C++ day42 C++的其他类库（除STL外）

    STL已经提供了一个非常好的可重用代码源 xff0c STL工具可以被用来解决很多编程问题了 xff0c 但是C 43 43 还是觉得不够 xff0c 在STL之外 xff0c 也提供了一些模板类 xff0c 这些模板类基本都是用来做一件很

  • python爬虫beautifulsoup详细教程

    BeautifulSoup4是爬虫必学的技能 BeautifulSoup最主要的功能是从网页抓取数据 xff0c Beautiful Soup自动将输入文档转换为Unicode编码 xff0c 输出文档转换为utf 8编码 Beautifu

  • pandas用法详解

    一 生成数据表 1 首先导入pandas库 xff0c 一般都会用到numpy库 xff0c 所以我们先导入备用 xff1a import numpy as np import pandas as pd 2 导入CSV或者xlsx文件 xf

  • 程序员读书顺序！

    程序猿的读书历程 xff1a xx语言入门 gt xx语言应用实践 gt xxx语言高阶编程 gt xxx语言的科学与艺术 gt 编程之美 gt 编程之道 gt 编程之禅 gt 颈椎病康复指南

  • 基于STM32的倾斜仪设计（二）—— 硬件设计（2）

    2 4控制电路 本实验中选用的控制核心是STM32系列单片机 xff0c 具体型号为STM32F103R8T6 STM32F103R8T6是一款嵌入式 微控制器集成电路 xff0c 是ST旗下的一款常用的增强型系列微控制器 此芯片工作电压为

随机推荐

  • win32多媒体定时器

    win32多媒体定时器 因为编程需要以1ms为周期调用一个函数 xff0c 故在Windows平台上测试了一些定时器 xff0c 并进行比较 xff0c 最终选用timeSetEvent作为最终选项 几个拉跨的定时器精度 select选择模

  • 树莓派005_L298N电机控制板

    硬件接口 ENA IN1 IN2 控制左边的电机A xff0c ENB IN3 IN4控制右边的电机B 以上六个全部接GPIO口 xff0c 可通过pwm控制ENA ENB实现调速 43 12V为外接电源正极接入口 GND为外接电源负极接入

  • Vue实现Enter键查询

    单个条件 xff1a 64 keyup span class token punctuation span enter span class token punctuation span native span class token op

  • 图文详解教你在线换系统（无须U盘）

    1 先去msdn下载需要安装的系统 建议不要下载到系统盘 系统下载传送门 2 系统下载后 xff0c 双击打开找到setup xff0c 然后以管理员权限打开 3 打开windows安装界面后 xff0c 选择更改windows安装程序下载

  • 从零开始写一个图像处理程序之一（BMP彩色图转灰度图）

    图像二值化可以直接调用opencv的二值化函数去完成处理 xff0c 但是不利用OpenCV从头手写一个处理图片程序未尝不是一件有意思的事情 xff0c 就拿BMP图片为例去做一个 BMP图像 xff1a BMP xff08 Bitmap

  • 智能革命和未来社会《智能时代--大数据和智能革命重新定义未来》

    通过区块链 xff08 Block Chain xff09 在未来跟踪每一件商品从制造出来到被消费的完整行踪 比特币在一定程度上起到货币的作用 xff0c 并且成为全球很安全的洗钱工具 xff0c 源于它背后的一个技术 区块链 block即

  • Git 版本回退方法

    场景一 xff1a 如果想将代码恢复到之前某个提交的版本 xff0c 且那个版本之后提交的版本都不要了 xff0c 就可以使用 git rest 原理 xff1a git reset的作用是修改HEAD的位置 xff0c 即将HEAD指向的

  • Antd form表单的使用、设值、取值、清空值

    1 使用 this props form getFieldDecorator 34 key 34 lt Input gt 3 设值 this props form setFieldsValue key 39 123 39 2 取值 this

  • 静态类，方法，成员

    说起静态类 xff0c 你可能会联想到实例类 这两者并不难区分 xff0c 前者 静态类 只在内存中创建一个 xff0c 而后者 实例类 则是每次实例化后 xff0c 就会再内存创建一份 今天来简单聊一下静态类的理解 代码情景 xff1a

  • shell脚本批量执行可执行文件

    touch一个test sh文件 xff0c 按下方例子vim写入 xff1a span class token comment bin bash span span class token function echo span span

  • git 本地改动了，不保留，直接拉取线上最新代码

    如果您在本地做了改动 xff0c 但是又不想保留这些改动 xff0c 可以使用以下命令强制拉取远程最新代码 xff0c 覆盖掉本地代码 xff1a span class token function git span fetch all s

  • C语言创建单链表

    单链表 链表是一种物理存储单元上非连续 非顺序的存储结构 xff0c 数据元素的逻辑顺序是通过链表中的指针链接次序实现的 链表由一系列结点 xff08 链表中每一个元素称为结点 xff09 组成 xff0c 结点可以在运行时动态生成 每个结

  • kvaser二次开发

    总结归纳 xff1a 实施步骤 xff1a 通过浏览网上的大量关于can总线开发的资料 xff0c 建立起对can总线软件开发的大致流程记录优质资料将开发过程流程化通过官方资料研究技术细节开工 技术要点 xff1a can协议 xff0c

  • vue瀑布流布局插件vue-masonry

    插件npm网址 https www npmjs com package vue masonrygithub xff1a https github com shershen08 vue masonry安装 npm install vue ma

  • 双目视觉——点云与RGB图像融合

    目录 一 固定向量类1 cv Vec2 读取像素 二 点云着色四 结果展示1 图像2 点云3 彩色点云 五 参考链接 一 固定向量类 1 cv Vec 在OpenCV中针对三通道矩阵 xff0c 定义的Vec类型有 xff1a cv Vec

  • PX4二次开发环境搭建及报错解决（v1.9.2）

    PX4二次开发环境搭建及报错解决 xff08 v1 9 2 xff09 正文脚本安装方式手动安装编译环境 网上之前已经有很完善的环境搭建教程了 xff0c 但是大多是支持v1 8 0及之前版本的 xff0c 但自从v1 9 0版本之后 xf

  • 双系统安装Ubuntu（16.04）（含重装教程）

    双系统安装Ubuntu xff08 16 04 xff09 正文制作启动盘给Ubuntu分硬盘空间安装Ubuntu系统 笔者之前装过Ubuntu的双系统 xff0c 现在是重装 xff0c 但本教程同时适用初次安装和二次安装的 xff0c

  • （五）通俗易懂理解——双向LSTM

    中文翻译作者博客 xff1a https www cnblogs com wangduo p 6773601 html utm source 61 itdadao amp utm medium 61 referral 英文原文作者网址 xf

  • linux服务器升级node版本

    最近部署前端代码时 xff0c 发现服务器node版本太低 xff0c 导致前端工程编译不成功 于是升级了一下 下载node安装包 这里我们在node官网下载LTS xff08 即当前稳定版本 xff09 xff0c 找到对应当前服务器环境

  • 【坐标转换】lla转换成enu坐标（无损版）

    import numpy as np import smpy utils as smpy utils import ditu topbind as tb from scipy spatial transform import Rotatio

热门标签