[master] Some changes in move function, ApproachDoor and MappingServer