Collision Detection with Beacon checking

Works fine. Move2Middle() sometimes gives wrong direction though.