Part of an FRC team building a Vision system from scratch, quite fun and nearly complete, just need to recalibrate some angle formulas