robot cant walk through stones anymore
added TODOS