Copy of code I contributed to FRC Team 694 (Stuypulse) for ComputerVision