MATLAB自定义函数Rodrigues
Posted weiyu-blog
tags:
篇首语：本文由小常识网(cha138.com)小编为大家整理，主要介绍了MATLAB自定义函数Rodrigues相关的知识，希望对你有一定的参考价值。
The customized MATLAB function is to onvert a rotation vector to a rotation matrix.
function [rotation_matrix] = Rodrigues( rotation_vector ) % Convert a rotation vector to a rotation matrix. rotation_vector = rotation_vector‘; theta = norm(rotation_vector); rotation_vector = rotation_vector./theta; I = eye(3); tmp_matrix = [0 -rotation_vector(3) rotation_vector(2); ... rotation_vector(3) 0 -rotation_vector(1); ... -rotation_vector(2) rotation_vector(1) 0]; rotation_matrix = cos(theta) * I + (1 - cos(theta)) * ... (rotation_vector * rotation_vector‘) + sin(theta) * tmp_matrix; end
以上是关于MATLAB自定义函数Rodrigues的主要内容，如果未能解决你的问题，请参考以下文章