Mach 4 Post

Can anyone help with a post processor for Mach 4 using a floating head? I am using a ethernet smooth stepper. I can use eithe G28.1 or G31, I currntly have it set up for G28 and having lots of problems with it zeroing