Full kinodynamics constraints for arbitrary robot configurations with factor graphs. - View it on GitHub