Now works on Arduino (no C++11 features)