C++ Port of FRC Team 4334's ATALibJ