https://vateroqawatuc.fencingveterans2013.com/real-time-trajectory-optimization-on-parallel-processors-book-11388dy.php