https://123dok.org/document/y4wkw8g5-multi-axle-order-tracking-vold-kalman-tracking-filter.html