icmstep.m

来自「Matlab code for encoding an unwrapping p」· M 代码 · 共 14 行

function  psim = icmstep(eta,mph,beta)
%   psim = icmstep(eta,mph,beta);
%   Compute the maximizer of
%   beta*cos(psi-eta) - (psi-mph)^2
%   for psi \in [-pi,pi];


N = 300; % course grid
delta = pi/N;
psi = linspace(-pi-delta,pi+delta,N);
[dummy i] = max(beta*cos(psi-eta) - (psi-mph).^2);
psim = psi(i);