added C++ to Teensy code