diff --git a/src/ModbusRTUServer.cpp b/src/ModbusRTUServer.cpp
index 95cc0b8..697458d 100644
--- a/src/ModbusRTUServer.cpp
+++ b/src/ModbusRTUServer.cpp
@@ -70,4 +70,9 @@ int ModbusRTUServerClass::poll()
   return 0;
 }
 
+int ModbusRTUServerClass::flush()
+{
+  return modbus_flush(_mb);
+}
+
 ModbusRTUServerClass ModbusRTUServer;
diff --git a/src/ModbusRTUServer.h b/src/ModbusRTUServer.h
index 53b7d40..2159297 100644
--- a/src/ModbusRTUServer.h
+++ b/src/ModbusRTUServer.h
@@ -46,6 +46,11 @@ class ModbusRTUServerClass : public ModbusServer {
    */
   virtual int poll();
 
+  /**
+   * Flush modbus
+   */
+  virtual int flush();
+
 private:
   RS485Class* _rs485 = &RS485;
 };