Add obstacle collision check