Merge remote-tracking branch 'sasens/master'
Newest version of angle error, including logical indexing to find the max velocity of times with decreasing Z-position
Newest version, including logical indexing for max velocity at decreasing z-position
Merge wars!