Fixed avoiding of borders + added obstacle avoidance. Looking good. OOOOoow yeaah.