function iconf = inv_config(conf)
% invert a 2D robot config (x,y,beta)

c = cos(conf(3,:));
s = sin(conf(3,:));

iconf = [
   -c.*conf(1,:)-s.*conf(2,:);
   +s.*conf(1,:)-c.*conf(2,:);
   -conf(3,:);
];
