removed print lines and added obstacle visualization