Finished green horizon calculation except for vision config and boost accumulator replacement. Also ported upperConvexHull and cross (now called DifferenceCrossProduct) functions.