Added std::swap if not compiling for Arduino