crossy.m

来自「nn modelling and auto-pid controller」· M 代码 · 共 29 行

function y = crossY(bcase, theta, beta, left, t)
%
% computes the crossover point for the given tau = t
%    for the given crossover case with the EVADER at the origin
%    if left = 1 computes the left trajectory, otherwise the right
% helper function for crossover.m
%
% Ian Mitchell, 4/23/01

  if(left)					% left trajectory
    switch bcase(1)
    case 1
      y = 2 * sin(t) - sin(theta) - (beta + 2 * t - 2 * pi - theta) * cos(t);
    case 2
      y = sin(t) - beta * cos(pi + theta / 2) + sin(theta - t) - sin(theta);
    otherwise
      error([ 'case ' num2str(bcase(1)) ' is not supported on left' ]);
    end
  else						% right trajectory
    switch bcase(2)
    case 1
      y = 2 * sin(t) + sin(theta) - (beta + 2 * t + theta) * cos(t);
    case 2
      y = -sin(theta) - (beta - theta) * cos(t);
    otherwise
      error([ 'case ' num2str(bcase(2)) ' is not supported on right' ]);
    end
  end