Added movement checkpoint. Fixed some movement command handling bugs.