Initial stepgen updates

Staring updating and moving defines for the stepgen to 5 axis.