[Motion] Add tree_direction to make goal location more accurate

[tongtybj]

Good! Could you edit the title and your first message to be more clear?