added cancel function
now for testing and running
added motor-reset
changed sd-wait message
removed redundant code