[dekhn]

See fluidnc http://wiki.fluidnc.com/en/config/kinematics as an example where you can get kinematics going without too much effort. It also has links to more pen plotter implementations to learn from.