https://andrewsenogles.com/posts/uas_trajectory/