Tidied up stepper initial positioning code