fixed 6D planning bug