132 lines
6.4 KiB
C
132 lines
6.4 KiB
C
/*
|
|
* Доступ к окнам Modbus-регистров через один classic CAN-кадр ProtoCAN. Сервер сопоставляет
|
|
* команду с банком и диапазоном регистров; чтение и запись значений выполняет предоставленный
|
|
* приложением интерфейс.
|
|
*/
|
|
|
|
#include "pcan_modbus_server.h"
|
|
|
|
#include <stddef.h>
|
|
|
|
#include "pcan_id.h"
|
|
|
|
bool pcan_modbus_server_init(pcan_modbus_server_t *server,
|
|
uint8_t device_type, uint8_t device_id,
|
|
pcan_modbus_read_fn read,
|
|
pcan_modbus_write_fn write, void *user)
|
|
{
|
|
if ((server == NULL) || (read == NULL) || (device_type > 7U) ||
|
|
(device_id > 15U)) {
|
|
return false;
|
|
}
|
|
server->device_type = device_type;
|
|
server->device_id = device_id;
|
|
server->read = read;
|
|
server->write = write;
|
|
server->user = user;
|
|
server->requests = 0U;
|
|
server->responses = 0U;
|
|
server->rejected = 0U;
|
|
return true;
|
|
}
|
|
|
|
static pcan_modbus_result_t reject(pcan_modbus_server_t *server)
|
|
{
|
|
server->rejected++;
|
|
return PCAN_MODBUS_HANDLED_NO_RESPONSE;
|
|
}
|
|
|
|
pcan_modbus_result_t pcan_modbus_server_handle(pcan_modbus_server_t *server,
|
|
const pcan_frame_t *request,
|
|
pcan_frame_t *response)
|
|
{
|
|
pcan_id_t id;
|
|
uint16_t address;
|
|
uint8_t count;
|
|
pcan_modbus_bank_t bank;
|
|
|
|
if ((server == NULL) || (request == NULL) || (response == NULL) ||
|
|
((request->flags & PCAN_FLAG_IDE) == 0U)) {
|
|
return PCAN_MODBUS_NOT_FOR_US;
|
|
}
|
|
pcan_id_unpack(request->id, &id);
|
|
if ((id.route != PCAN_ROUTE_FROM_PM) ||
|
|
(id.device_type != server->device_type) ||
|
|
(id.device_id != server->device_id) || (id.msg_type != PCAN_MSG_MODBUS)) { /* Только единый тип 0x5 адресует Modbus; 0x4, 0x6 и 0x7 не вызывают provider. */
|
|
return PCAN_MODBUS_NOT_FOR_US;
|
|
}
|
|
|
|
server->requests++;
|
|
address = (uint16_t)(id.msg_body >> 4U);
|
|
count = (uint8_t)pcan_modbus_count(id.msg_body); /* Два младших бита хранят количество минус один, поэтому нулевого запроса больше нет. */
|
|
bank = (pcan_modbus_bank_t)pcan_modbus_function(id.msg_body); /* Биты 3:2 выбирают банк Coil/Discrete/Holding/Input через функцию 1…4. */
|
|
if ((address + count > 0x1000U) || (request->dlc > 8U) || ((request->flags & PCAN_FLAG_RTR) != 0U)) { /* Диапазон не пересекает границу 4096 адресов; поддерживаются только classic data frames. */
|
|
return reject(server);
|
|
}
|
|
|
|
*response = *request;
|
|
id.route = PCAN_ROUTE_FROM_DEVICE;
|
|
response->id = pcan_id_pack(&id);
|
|
response->flags = PCAN_FLAG_IDE;
|
|
response->seq = 0U;
|
|
|
|
if (request->dlc == 0U) {
|
|
uint16_t packed = 0U;
|
|
if ((bank == PCAN_MODBUS_COIL) || (bank == PCAN_MODBUS_DISCRETE)) { /* Функции 1 и 2 возвращают до четырёх последовательных битов в одном октете. */
|
|
for (uint8_t index = 0U; index < count; ++index) {
|
|
uint16_t value = 0U;
|
|
if (!server->read(server->user, bank,
|
|
(uint16_t)(address + index), &value)) {
|
|
return reject(server);
|
|
}
|
|
if (value != 0U) {
|
|
packed |= (uint16_t)(1U << index);
|
|
}
|
|
}
|
|
response->dlc = 1U; /* Для 1…4 битов достаточно одного октета; старшие биты остаются нулевыми. */
|
|
response->data[0] = (uint8_t)packed;
|
|
} else {
|
|
if (count > 4U) {
|
|
return reject(server);
|
|
}
|
|
response->dlc = (uint8_t)(count * 2U);
|
|
for (uint8_t index = 0U; index < count; ++index) {
|
|
uint16_t value = 0U;
|
|
if (!server->read(server->user, bank,
|
|
(uint16_t)(address + index), &value)) {
|
|
return reject(server);
|
|
}
|
|
response->data[index * 2U] = (uint8_t)value;
|
|
response->data[(index * 2U) + 1U] = (uint8_t)(value >> 8U);
|
|
}
|
|
}
|
|
} else {
|
|
if ((bank == PCAN_MODBUS_INPUT) || (bank == PCAN_MODBUS_DISCRETE) || /* Входные банки функций 2 и 4 сохраняют запрет записи. */
|
|
(server->write == NULL)) {
|
|
return reject(server);
|
|
}
|
|
if (bank == PCAN_MODBUS_COIL) { /* ProtoCAN выбирает запись по непустому payload, сохраняя номер функции как селектор банка. */
|
|
if ((request->dlc != 1U) || (request->data[0] >> count) != 0U) return reject(server); /* Ровно один октет хранит маску выбранного числа выходов без лишних установленных битов. */
|
|
for (uint8_t index = 0U; index < count; ++index) { /* Выходы записываются по возрастанию адреса начиная с младшего бита маски. */
|
|
if (!server->write(server->user, bank, (uint16_t)(address + index), (uint16_t)((request->data[0] >> index) & 1U))) return reject(server); /* Передаём provider значение 0 или 1 каждого выхода. */
|
|
} /* Все запрошенные выходы обработаны. */
|
|
} else { /* Для Holding сохраняется запись 16-битных значений little-endian. */
|
|
if ((count > 4U) || (request->dlc != (uint8_t)(count * 2U))) {
|
|
return reject(server);
|
|
}
|
|
for (uint8_t index = 0U; index < count; ++index) {
|
|
uint16_t value = (uint16_t)(request->data[index * 2U] |
|
|
((uint16_t)request->data[(index * 2U) + 1U] << 8U));
|
|
if (!server->write(server->user, bank,
|
|
(uint16_t)(address + index), value)) {
|
|
return reject(server);
|
|
}
|
|
}
|
|
}
|
|
response->dlc = request->dlc;
|
|
}
|
|
|
|
server->responses++;
|
|
return PCAN_MODBUS_RESPONSE;
|
|
}
|