The old implementation seems to be buggy, it accesses segments outside the queue, causing jerks and skipped steps.
Removed support for the slow Toshiba stepper drivers.
Implemented bed skew calibration by matching a precise physical model to the measured data using the least squares method. Rewrote handling of the command buffer to preserve memory and allow pushing the commands to the front of the queue.