从旋转矩阵估计更加精确的旋转矩阵

29 篇文章 2 订阅
29 篇文章 2 订阅

     当我们获得一个粗糙的旋转矩阵,想得到一个准确的旋转矩阵,但是与初步估计出来的旋转矩阵的F范数误差,参考张正友文章,用svd分解对矩阵R1进行分解,R1=USV',分解后用UV'来表征最佳的旋转矩阵。

python中scipy的Rotation里面,旧版本的as_matrix写作as_dcm

上述算法写python代码如下:

u_, s_, vh = np.linalg.svd(rot_mat.copy(), full_matrices=True)
rot_mat= u_ @ np.diag(np.sign(s_)) @ vh

https://www.microsoft.com/en-us/research/wp-content/uploads/2016/02/tr98-71.pdf

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值