Modified to support Maple/Maple_Mini (ONLY WORKS WITH 800hz TIMING)
All Arduino/Teensy Code has been removed