pre-release 0.1

проверка

Src/modbus_inputregs.c

@@ -0,0 +1,45 @@
+/**
+******************************************************************************
+* @file modbus_inputregs.c
+* @brief Реализация работы с входными регистрами Modbus
+******************************************************************************
+* @details
+Модуль обработки команды чтения input registers (0x04):
+- Чтение множественных входных регистров
+Копирование данных из структур устройства в буфер ответа
+- Поддержка знаковых и беззнаковых значений
+******************************************************************************/
+
+#include "modbus_inputregs.h"
+
+
+/**
+  * @brief    Proccess command Read Input Registers (04 - 0x04).
+  * @param    modbus_msg        Указатель на структуру собщения modbus.
+  * @return   fMessageHandled   Статус о результате обработки комманды.
+  * @details  Обработка команды Read Input Registers.
+  */
+uint8_t MB_Proccess_Read_Input_Regs(RS_MsgTypeDef *modbus_msg)
+{
+  //---------CHECK FOR ERRORS---------- 
+  // get origin address for data
+  uint16_t *pInRegs;      
+  modbus_msg->Except_Code = MB_DefineRegistersAddress(&pInRegs, modbus_msg->Addr, modbus_msg->Qnt, RegisterType_Input); // определение адреса регистров
+  if(modbus_msg->Except_Code != NO_ERRORS)
+    return 0;
+  
+
+  //-----------READING REGS------------
+  // setup output message data size 
+  modbus_msg->ByteCnt = modbus_msg->Qnt*2; // *2 because we transmit 8 bits, not 16 bits
+  // read data
+  int i;
+  for (i = 0; i<modbus_msg->Qnt; i++)
+  {
+    if(*((int16_t *)pInRegs) > 0)
+      modbus_msg->DATA[i] = (*pInRegs++);
+    else
+      modbus_msg->DATA[i] = (*pInRegs++);
+  } 
+  return 1;
+}