euler2quart.m

来自「一个很好用的摄像机标定程序」· M 代码 · 共 23 行

function [rotV, beta] = euler2quart(ox, fy, kz)
%DEVELOPMENT PHASE
%
% rotmat = quart(rotAx, rotAng)
%
% computes quarternions from euler angles
%
% rotmat - rotation matrix
%
% rotAx - rotation axis [xr, yr, zr]
% rotAng - rotation angle

beta = ox;

z1 = sin( fy );
x1 = cos( fy );
y1 = sin( kz ) * x1;
x2 = cos( kz ) * x1;

rotV = [x2, y1, z1];