goalfunction.m

来自「机器人路径规划的matlab程序」· M 代码 · 共 12 行

% Gaol function:
% Author: K. Passino, Version: 1/25/01
function Jg=goalfunction(x,xgoal,w2)

% An example gaol function:

	Jg=w2*(x-xgoal)'*(x-xgoal);
%	Jg=0.01*(x-xgoal)'*(x-xgoal)/(1-0.01*(x-xgoal)'*(x-xgoal));