Horn1986年利用四元数求解旋转的记录

最新推荐文章于 2022-05-29 16:31:40 发布

stoooo

最新推荐文章于 2022-05-29 16:31:40 发布

阅读量849

点赞数 4

分类专栏：点云处理先关

本文链接：https://blog.csdn.net/stoooo/article/details/79142925

版权

利用四元数求解旋转——Horn1986年论文笔记先附上原文链接Closed-form solution of absolute orientation using unit quaternions问题描述有左右两个点集rl" role="presentation">rlrl\mathbf{r}_l,rr" role="presentation">rrrr\mathbf{r}_r

摘要由CSDN通过智能技术生成

利用四元数求解旋转——Horn1986年论文笔记

先附上原文链接Closed-form solution of absolute orientation using unit quaternions

问题描述

有左右两个点集 $\mathbf{r}_l$ , $\mathbf{r}_r$ 。右点集由左点集经旋转 $R$ ，缩放 $s$ 平移 $T$ 后得到，且 $\mathbf{r}_{l,i}$ 与 $\mathbf{r}_{r,i}$ 对应。求 $R$ 与 $T$ ，使得

r r = s R (r l) + T

$\mathbf{r}_r=sR(\mathbf{r}_l)+T$
由于实际测得的点集有误差

ei=rr,i−sR(rl,i)−T e i = r r , i − s R ( r l , i ) − T $\mathbf{e}_i=\mathbf{r}_{r,i}-sR(\mathbf{r}_{l,i})-T$ ,所以问题可以转化为求

R R $R$ ，

s

$s$ ，

T T $T$ 以最小化目标函数

\sum_{i = 0}^{n} {‖ e_{i} ‖}^{2}

$\sum_{i=0}^n\left\lVert\mathbf{e}_i\right\rVert^2$
Horn在文章中给出了依次分离求解

T T $T$ ，

s

$s$ ，

R R $R$ 的解决思路。

解决方法

利用中心点分离T

计算左右两个点集的中心

{\bar{r}}_{l} = \frac{1}{n} \sum_{i = 0}^{n} r_{l, i}, {\bar{r}}_{r} = \frac{1}{n} \sum_{i = 0}^{n} r_{r, i}

$\overline{\mathbf{r}}_l=\frac{1}{n}\sum_{i=0}^n\mathbf{r}_{l,i},\overline{\mathbf{r}}_r=\frac{1}{n}\sum_{i=0}^n\mathbf{r}_{r,i}$
计算左右两个点集中每个点相对各自中心的位置

r' l, i = r l, i - r ⎯ ⎯ ⎯ l, r' r, i = r r, i - r ⎯ ⎯ ⎯ r

$\mathbf{r}_{l,i}'=\mathbf{r}_{l,i}-\overline{\mathbf{r}}_l,\mathbf{r}_{r,i}'=\mathbf{r}_{r,i}-\overline{\mathbf{r}}_r$
这样

ei e i $\mathbf{e}_i$ 可以表示为

e i = r' r, i - s R (r' l, i) - T', T' = T - r ⎯ ⎯ ⎯ r + s R (r ⎯ ⎯ ⎯

最低0.47元/天解锁文章

stoooo

关注

4
点赞
踩
8

收藏

觉得还不错? 一键收藏
1
评论
Horn1986年利用四元数求解旋转的记录

利用四元数求解旋转——Horn1986年论文笔记先附上原文链接Closed-form solution of absolute orientation using unit quaternions问题描述有左右两个点集rl" role="presentation">rlrl\mathbf{r}_l,rr" role="presentation">rrrr\mathbf{r}_r
复制链接

扫一扫