Обновление примера + доработки мастера

Modbus/Src/modbus_devid.c

@@ -28,6 +28,16 @@ MB_DeviceIdentificationsTypeDef MB_DEVID;  ///< Глобальная струк
   */
 int MB_GetNumberOfObjects(RS_MsgTypeDef *modbus_msg)
 {
+  if(modbus_msg == NULL)
+  {
+    return 0;
+  }
+  // Проверяем что ответ связан с диагностикой
+  if(modbus_msg->Func_Code != MB_R_DEVICE_INFO)
+  {
+    return 0;
+  }
+  
   return modbus_msg->DevId.NumbOfObj;
 }
 
@@ -44,6 +54,12 @@ int MB_FindObjectById(RS_MsgTypeDef *modbus_msg, uint8_t obj_id, char *obj_data,
   if((modbus_msg == NULL) || (obj_data == NULL))
     return 0;
   
+  // Проверяем что ответ связан с диагностикой
+  if(modbus_msg->Func_Code != MB_R_DEVICE_INFO)
+  {
+    return 0;
+  }
+  
   uint8_t *data = (uint8_t*)modbus_msg->DATA;
   unsigned ind = 0;
   
@@ -89,6 +105,12 @@ int MB_GetObjectByIndex(RS_MsgTypeDef *modbus_msg, int index, uint8_t *obj_id, c
   if((modbus_msg == NULL) || (obj_data == NULL))
     return 0;
   
+  // Проверяем что ответ связан с диагностикой
+  if(modbus_msg->Func_Code != MB_R_DEVICE_INFO)
+  {
+    return 0;
+  }
+  
   if(index >= modbus_msg->DevId.NumbOfObj) 
     return 0;