Przede wszystkim źle liczysz przemieszczenie. W przypadku kół zębatych nie średnica zewnętrzna, a srednica koła podzialowego wplywa na przełożenie. Upraszcza to obliczenia. Przemieszcczenie zebatki wynosi moduł *liczba zębów *pi. Czyli w Twoim przypadku 40pi, bo moduł masz =1 czyli przesunięcie po pełnym obrocie wyjdzie Ci 125,66 mm.
Reszta ok, ale tak jak kolega zasugerował korzystnie jest zastosować co najmniej 10 mikrokroków ( co wpłynie korzystnie na płynność ruchu) a porządne sterowniki pozwalają nawet na podział na 256 mikrokroków) mozna pomyśleć o mniejszym kole.