98 lines
4.2 KiB
C
98 lines
4.2 KiB
C
/**
|
||
******************************************************************************
|
||
* @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;
|
||
}
|