Fixed innital setup and implemented missing command
Changed innital steps per unit to 80
Implemented ability to change steps per unit through G-code