Started MC-stepper, add _print functions. Cleanup