Added complete functionality to MCPM.

Uses the limit switch as north location.