Replace test_stand_firmware.ino, switched to serial polling to lag issues, testing of math effectiveness could be conducted