Create ToneFirmata.cpp

Implementation file for ToneFirmata feature