Plotter - 3 servos

I've started new project.
This time it is a xy table, moved by steppers motors. It is working but I have to write better software.