Working on stepper controller