Rewrote to not use AccelStepper. H-bot can make diagonal steps now'
Change position counter after step. Move commands relative to position, not target