refactory the movement package to permit distinct normal & privileged
control model.
And there is two questions left :
1. very little thing, that sometimes the robot will hit the obstacle
while the distance to right is too close and it trying to turn left.
2. think about whether we put the ai strategy into the xml file or not.