Trouble with obstacle avoiding robot