Any chance you could send me your sketch? I have the exact same 3D printer. I am not sure I have my servo defined correctly. I am unable to get it to move via pronterface m401, m402. (It does move when I first plug in printer). Any help on defining the pins would be appreciated. Thanks!