https://5dok.org/document/1y9284dz-online-trajectory-planning-and-observer-based-control.html