%%%%%%%%%% From this point the code differes from previous push. %%%%%%%%%
angleHead = rand * 360;
length = 20;

x_head = (cosd(angleHead) * length) + x_body;
y_head = (sind(angleHead) * length) + y_body;

pos_head = [x_head y_head];

vec = pos_head - pos_body;