function y=fi(x,qi)
%just a basic contraction function to a vector by a factor of 1/2
fi=1/2*(x-qi)+qi;