pre-release 0.1

проверка

Src/modbus_holdregs.c

@@ -0,0 +1,97 @@
+/**
+******************************************************************************
+* @file modbus_holdregs.c
+* @brief Реализация работы с регистрами хранения Modbus
+******************************************************************************
+* @details
+Модуль обработки команд для holding registers (регистров хранения):
+- Чтение множественных регистров (0x03) - копирование данных в буфер ответа
+- Запись одиночного регистра (0x06) - прямая запись значения
+- Запись множественных регистров (0x10) - пакетная запись из буфера
+
+@section Валидация данных:
+- Проверка соответствия количества байт и регистров
+Валидация адресов через MB_DefineRegistersAddress()
+- Обработка исключений при некорректных запросах
+
+@section Echo-ответы:
+При успешной записи формируется echo-ответ с теми же данными,
+что были в запросе (для функций 0x05, 0x06, 0x0F, 0x10).
+******************************************************************************/
+#include "modbus_inputregs.h"
+
+
+/**
+  * @brief    Proccess command Read Holding Registers (03 - 0x03).
+  * @param    modbus_msg        Указатель на структуру собщения modbus.
+  * @return   fMessageHandled   Статус о результате обработки комманды.
+  * @details  Обработка команды Read Holding Registers.
+  */
+uint8_t MB_Proccess_Read_Hold_Regs(RS_MsgTypeDef *modbus_msg)
+{
+  //---------CHECK FOR ERRORS---------- 
+  // get origin address for data
+  uint16_t *pHoldRegs;      
+  modbus_msg->Except_Code = MB_DefineRegistersAddress(&pHoldRegs, modbus_msg->Addr, modbus_msg->Qnt, RegisterType_Holding); // определение адреса регистров
+  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++)
+  {
+    modbus_msg->DATA[i] = *(pHoldRegs++);
+  } 
+  return 1;
+}
+
+/**
+  * @brief    Proccess command Write Single Register (06 - 0x06).
+  * @param    modbus_msg        Указатель на структуру собщения modbus.
+  * @return   fMessageHandled   Статус о результате обработки комманды.
+  * @details  Обработка команды Write Single Register.
+  */
+uint8_t MB_Proccess_Write_Single_Reg(RS_MsgTypeDef *modbus_msg)
+{ 
+  // get origin address for data
+  uint16_t *pHoldRegs;      
+  modbus_msg->Except_Code = MB_DefineRegistersAddress(&pHoldRegs, modbus_msg->Addr, 1, RegisterType_Holding); // определение адреса регистров
+  if(modbus_msg->Except_Code != NO_ERRORS)
+    return 0;
+  
+  //-----------WRITTING REG------------ 
+  *(pHoldRegs) = modbus_msg->Qnt;
+  return 1;
+}
+
+/**
+  * @brief    Proccess command Write Multiple Registers (16 - 0x10).
+  * @param    modbus_msg        Указатель на структуру собщения modbus.
+  * @return   fMessageHandled   Статус о результате обработки комманды.
+  * @details  Обработка команды Write Multiple Registers.
+  */
+uint8_t MB_Proccess_Write_Miltuple_Regs(RS_MsgTypeDef *modbus_msg)
+{
+  //---------CHECK FOR ERRORS----------
+  if (modbus_msg->Qnt*2 != modbus_msg->ByteCnt)
+  { // if quantity and bytes count arent match
+    modbus_msg->Except_Code = 3;
+    return 0;
+  } 
+  // get origin address for data
+  uint16_t *pHoldRegs;      
+  modbus_msg->Except_Code = MB_DefineRegistersAddress(&pHoldRegs, modbus_msg->Addr, modbus_msg->Qnt, RegisterType_Holding); // определение адреса регистров
+  if(modbus_msg->Except_Code != NO_ERRORS)
+    return 0;
+  
+  //-----------WRITTING REGS----------- 
+  for (int i = 0; i<modbus_msg->Qnt; i++)
+  {
+    *(pHoldRegs++) = modbus_msg->DATA[i];
+  }
+  return 1;
+}