obstactle implementation (unfinished)

obstactle implementation (unfinished)