Develop: Implement several methods to support `MoveToPoint` action. (#9)