ucomp.m

来自「移动机器人同时定位与地图创建最前沿技术」· M 代码 · 共 15 行

function [tac, Pac] = ucomp(tab, Pab, tbc, Pbc);
%-------------------------------------------------------
% University of Zaragoza
% Centro Politecnico Superior
% Robotics and Real Time Group
% Authors:  J. Neira, J. Tardos
% Date   :  7-2004
%-------------------------------------------------------
%-------------------------------------------------------

tac = tcomp(tab, tbc);
J1 = jacobian1(tab, tbc);
J2 = jacobian2(tab, tbc);
Pac = J1 * Pab * J1' + J2 * Pbc * J2';