|
| 1 | +/* Copyright (C) 2020 Electrooptical Innovations |
| 2 | + * ---------------------------------------------------------------------- |
| 3 | + * Project: Modbus |
| 4 | + * Title: LinuxSlave.h |
| 5 | + * Description: Linux modbus slave |
| 6 | + * |
| 7 | + * $Date: 13. May 2020 |
| 8 | + * $Revision: V.1.0.1 |
| 9 | + * ---------------------------------------------------------------------- |
| 10 | + */ |
| 11 | + |
| 12 | +#pragma once |
| 13 | +#include "LinuxModbusTools.h" |
| 14 | +#include <Modbus/flat_buffers_register_wrapper.h> |
| 15 | +#include "InputRegisterMappedDataStore_generated.h" |
| 16 | +#include "HoldingRegisterMappedDataStore_generated.h" |
| 17 | +#include <Modbus/../../examples/posix/PosixSerial.h> |
| 18 | +#include <Modbus/Modbus.h> |
| 19 | +#include <Modbus/BitControl.h> |
| 20 | +#include <Modbus/DataStore.h> |
| 21 | +#include <Modbus/ModbusRtu/ModbusRtuSlave.h> |
| 22 | +#include <Modbus/RegisterControl.h> |
| 23 | +#include <Modbus/MappedRegisterDataStore.h> |
| 24 | +#include <Modbus/DataStore.h> |
| 25 | +#include <Utilities/TypeConversion.h> |
| 26 | +#include <cassert> |
| 27 | +#include <cstdint> |
| 28 | +#include <sys/time.h> |
| 29 | +#include <vector> |
| 30 | +inline const constexpr std::size_t kCoilCount = 1; |
| 31 | +using CoilController = |
| 32 | + Modbus::CoilController<Modbus::BitFieldDataStore<kCoilCount>>; |
| 33 | +using DiscreteInputController = |
| 34 | + Modbus::DiscreteInputController<Modbus::BitFieldDataStore<kCoilCount>>; |
| 35 | + |
| 36 | + |
| 37 | +using HoldingRegisterMemoryMap = Modbus::FlatBufferRegisterStore<HoldingRegisters>; |
| 38 | +using HoldingRegisterController = |
| 39 | + Modbus::HoldingRegisterController<Modbus::MappedRegisterDataStore<HoldingRegisterMemoryMap>>; |
| 40 | +using InputRegisterMemoryMap = Modbus::FlatBufferRegisterStore<InputRegisters>; |
| 41 | +using InputRegisterController = |
| 42 | + Modbus::InputRegisterController<Modbus::MappedRegisterDataStore<InputRegisterMemoryMap>>; |
| 43 | +using SlaveBase = |
| 44 | + Modbus::ProtocolRtuSlave<CoilController, HoldingRegisterController, |
| 45 | + DiscreteInputController, InputRegisterController>; |
| 46 | + |
| 47 | + |
| 48 | +class LinuxSlave : public SlaveBase { |
| 49 | + public: |
| 50 | + |
| 51 | + CoilController coils_; |
| 52 | + //HoldingRegisterController& holding_register_controller_; |
| 53 | + DiscreteInputController dins_; |
| 54 | + |
| 55 | + static const constexpr uint8_t kSlaveAddress = 0x03; |
| 56 | + |
| 57 | + static const constexpr int kBaudRateHz = 9600; |
| 58 | + static const constexpr speed_t kBaudRate = B9600; |
| 59 | + static const constexpr int kCharacterClocks = 8 + 1; |
| 60 | + |
| 61 | + const char *const device_name; // = "/tmp/ttyp0"; |
| 62 | + timeval last_character_time_ = GetTimeStamp(); |
| 63 | + static const constexpr int64_t kFrameDelay_us = |
| 64 | + (1e6 * (kCharacterClocks * 3.5)) / (static_cast<double>(kBaudRateHz)); |
| 65 | + UartController iodev_; |
| 66 | + int byte_counter_ = 0; |
| 67 | + |
| 68 | + timeval GetTimeStamp(void) { |
| 69 | + timeval tv; |
| 70 | + gettimeofday(&tv, NULL); |
| 71 | + return tv; |
| 72 | + } |
| 73 | + |
| 74 | + void ProcessPacket(void) { |
| 75 | + ProcessMessage(); |
| 76 | + |
| 77 | + const auto& frame = GetFrameIn(); |
| 78 | + Modbus::PrintPacketData(frame); |
| 79 | + printf("\n"); |
| 80 | +#if 0 |
| 81 | + if (frame.address == 246 || frame.function == Modbus::Function::kWriteMultipleHoldingRegisters) { |
| 82 | + printf("\n"); |
| 83 | + PrintPacketData(frame); |
| 84 | + printf("\n"); |
| 85 | + } else { |
| 86 | + printf("."); |
| 87 | + fflush(stdout); |
| 88 | + } |
| 89 | +#endif |
| 90 | + if (GetResponseValid()) { |
| 91 | + iodev_.write(GetResponse().data(), GetResponse().GetLength()); |
| 92 | + printf("Response: ["); |
| 93 | + const auto response = GetResponse(); |
| 94 | + std::size_t cnt = 0; |
| 95 | + for (auto pt : response) { |
| 96 | + cnt++; |
| 97 | + printf("%d ", pt); |
| 98 | + } |
| 99 | + printf("]\n"); |
| 100 | + assert(cnt == response.GetLength()); |
| 101 | + } |
| 102 | + Reset(); |
| 103 | + } |
| 104 | + |
| 105 | + bool RxCharacterTimeout(const timeval ×tamp) const { |
| 106 | + const bool character_timeout = GetMicroSecondsSince(last_character_time_, timestamp) >= |
| 107 | + 10 * kFrameDelay_us; |
| 108 | + return character_timeout; |
| 109 | + } |
| 110 | + |
| 111 | + public: |
| 112 | + void Run(void) { |
| 113 | + //sleep(0.005); |
| 114 | + iodev_.SendTxBuff(); |
| 115 | + iodev_.ReadIntoRxBuff(); |
| 116 | + |
| 117 | + if (slave_.ctx_.PacketReceived()) { |
| 118 | + // check slave address |
| 119 | + ProcessPacket(); |
| 120 | + } |
| 121 | + if (!iodev_.rxEmpty()) { |
| 122 | + last_character_time_ = GetTimeStamp(); |
| 123 | + uint8_t data = 0; |
| 124 | + iodev_.read(&data, 1); |
| 125 | + slave_.ProcessCharacter(data); |
| 126 | + } else if (RxCharacterTimeout(GetTimeStamp())) { |
| 127 | + Reset(); |
| 128 | + } |
| 129 | + } |
| 130 | + |
| 131 | + public: |
| 132 | + |
| 133 | + explicit LinuxSlave(const char *const port, |
| 134 | + HoldingRegisterController& holding_register_controller, |
| 135 | + InputRegisterController& input_register_controller) |
| 136 | + : SlaveBase{&crc16, kSlaveAddress, coils_, |
| 137 | + holding_register_controller, dins_, input_register_controller}, |
| 138 | + device_name{port}, iodev_{port, kBaudRate} {} |
| 139 | +}; |
0 commit comments