fix obstacles, add robots path, fix node color in BT