Arduino mega + ramps 1.4 quale software?

Buonasera a tutti ragazzi ho realizzato un plotter xy. Per ora ho completato gli assi xy e mi manca da fare il piatto centrale per l'asse z che mi servirebbe solo per staccare la punta della penna dal foglio. Il problema è partito tutto dal dubbio di usare un motore servo o stepper poiché per alzare solo la penna, un servo dovrebbe essere più semplice. Il punto è che avevo già un arduino mega ed una rampa 1.4 e funziona perfettamente con i nema 17 degli assi xy. Il problema viene su quale motore adottare in relazione alle schede che ho ed alla disponibilità di programmi che ci sono. Mi spiego meglio grbl supporta male la mega e gli stepper e non trovò una versione che supporti entrambi. E gli altri programmi come tiny o Marlin ho provato a documentarmi ma non trovo niente in merito agli stepper . Confido in voi grazie mille