improved obstacle occupation init