[modbus] fixed some bugs

MK16kawai · Jan 8, 2025 · 0c56ead · 0c56ead
1 parent 77e1de4
commit 0c56ead
Showing 1 changed file with 7 additions and 0 deletions.
diff --git a/components/comm/src/maix_modbus.cpp b/components/comm/src/maix_modbus.cpp
@@ -149,6 +149,11 @@ ::maix::err::Err Slave::set_timeout(uint32_t sec, uint32_t usec)
             return ::maix::err::Err::ERR_RUNTIME;
             // __error_and_throw__(msg);
         }
+        if (::modbus_set_response_timeout(this->ctx_.get(), this->curr_timeout_sec_, this->curr_timeout_usec_) < 0) {
+            std::string msg(this->TAG()+" set timeout failed");
+            log::warn(msg.c_str());
+            return ::maix::err::Err::ERR_RUNTIME;
+        }
         return ::maix::err::Err::ERR_NONE;
     }
 
@@ -299,6 +304,8 @@ ::maix::err::Err Slave::__receive__()
         }
         return ::maix::err::Err::ERR_NONE;
     }
+    /* flush */
+    ::modbus_flush(this->ctx_.get());
     if (this->debug_) {
         log::warn("%s receive failed", this->TAG().c_str());
     }