Added collisions, with test between robot frames

if there is collision server write it in console, fix bug with multi
connection