Added some debug output for motor steps

[CptanPanic]

I was having some problems with z axis motor, and the biggest help was the added debug to the motor test which shows the step counts.