Kyrylo Cherneha / ModBusTCP

ModBusTCP with some fixes

ModBus-TCP.cpp@2:fcd20e2cd110, 2017-06-29 (annotated)

Committer:
gulchi
Date:
Thu Jun 29 10:17:29 2017 +0000
Revision:
2:fcd20e2cd110
Parent:
HTTPD.cpp@1:b724fdb741e7
Child:
3:ebea8e061ae6
init v1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
okini3939 0:d18dff347122 1 /* Copyright (C) 2013 Hiroshi Suga, MIT License
okini3939 0:d18dff347122 2 *
okini3939 0:d18dff347122 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
okini3939 0:d18dff347122 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
okini3939 0:d18dff347122 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
okini3939 0:d18dff347122 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
okini3939 0:d18dff347122 7 * furnished to do so, subject to the following conditions:
okini3939 0:d18dff347122 8 *
okini3939 0:d18dff347122 9 * The above copyright notice and this permission notice shall be included in all copies or
okini3939 0:d18dff347122 10 * substantial portions of the Software.
okini3939 0:d18dff347122 11 *
okini3939 0:d18dff347122 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
okini3939 0:d18dff347122 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
okini3939 0:d18dff347122 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
okini3939 0:d18dff347122 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
okini3939 0:d18dff347122 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
okini3939 0:d18dff347122 17 */
okini3939 0:d18dff347122 18
gulchi 2:fcd20e2cd110 19 #include "ModBus-TCP.h"
okini3939 0:d18dff347122 20
gulchi 2:fcd20e2cd110 21 Modbus * Modbus::_inst;
okini3939 0:d18dff347122 22
gulchi 2:fcd20e2cd110 23 Modbus::Modbus () {
okini3939 0:d18dff347122 24 _inst = this;
okini3939 0:d18dff347122 25 memset(_state, 0, sizeof(_state));
okini3939 0:d18dff347122 26 _handler_count = 0;
okini3939 0:d18dff347122 27 }
okini3939 0:d18dff347122 28
gulchi 2:fcd20e2cd110 29 int Modbus::start (NetworkStack *ns, int port) {
okini3939 0:d18dff347122 30 int i;
okini3939 0:d18dff347122 31
dgriffin65 1:b724fdb741e7 32 m_ns = ns;
dgriffin65 1:b724fdb741e7 33
gulchi 2:fcd20e2cd110 34 for (i = 0; i < MODBUS_MAX_CLIENTS; i ++) {
gulchi 2:fcd20e2cd110 35 _state[i].buf = new CircBuffer<char>(MODBUS_BUF_SIZE);
gulchi 2:fcd20e2cd110 36 _state[i].thread = new Thread(osPriorityNormal, MODBUS_STACK_SIZE);
dgriffin65 1:b724fdb741e7 37 _state[i].client = new TCPSocket();
dgriffin65 1:b724fdb741e7 38 _state[i].thread->start(callback(child, (void*)i));
okini3939 0:d18dff347122 39 }
dgriffin65 1:b724fdb741e7 40
gulchi 2:fcd20e2cd110 41 #ifdef MODBUS_ENABLE_CLOSER
gulchi 2:fcd20e2cd110 42 _state[MODBUS_MAX_CLIENTS].thread = new Thread(closer, (void*)MODBUS_MAX_CLIENTS, osPriorityNormal, 128);
gulchi 2:fcd20e2cd110 43 _state[MODBUS_MAX_CLIENTS].client = new TCPSocket(m_ns);
okini3939 0:d18dff347122 44 #endif
okini3939 0:d18dff347122 45
dgriffin65 1:b724fdb741e7 46 _server.open(m_ns);
okini3939 0:d18dff347122 47 _server.bind(port);
dgriffin65 1:b724fdb741e7 48 _server.set_blocking(true);
okini3939 0:d18dff347122 49 _server.listen();
gulchi 2:fcd20e2cd110 50 _daemon = new Thread(osPriorityNormal, MODBUS_STACK_SIZE);
gulchi 2:fcd20e2cd110 51 _daemon->start(Modbus::daemon);
okini3939 0:d18dff347122 52 return 0;
okini3939 0:d18dff347122 53 }
okini3939 0:d18dff347122 54
gulchi 2:fcd20e2cd110 55 void Modbus::daemon () {
gulchi 2:fcd20e2cd110 56 Modbus *modbus = Modbus::getInstance();
okini3939 0:d18dff347122 57 int i, t = 0;
okini3939 0:d18dff347122 58
okini3939 0:d18dff347122 59 INFO("Wait for new connection...\r\n");
okini3939 0:d18dff347122 60 for (;;) {
okini3939 0:d18dff347122 61 if (t >= 0) {
gulchi 2:fcd20e2cd110 62 if (modbus->_server.accept(modbus->_state[t].client) == 0) {
okini3939 0:d18dff347122 63 INFO("accept %d\r\n", t);
gulchi 2:fcd20e2cd110 64 modbus->_state[t].thread->signal_set(1);
okini3939 0:d18dff347122 65 }
okini3939 0:d18dff347122 66 } else {
okini3939 0:d18dff347122 67 #ifdef HTTPD_ENABLE_CLOSER
gulchi 2:fcd20e2cd110 68 if (modbus->_server.accept(modbus->_state[MODBUS_MAX_CLIENTS].client) == 0) {
okini3939 0:d18dff347122 69 INFO("accept x\r\n");
gulchi 2:fcd20e2cd110 70 modbus->_state[MODBUS_MAX_CLIENTS].thread->signal_set(1);
okini3939 0:d18dff347122 71 }
okini3939 0:d18dff347122 72 #endif
okini3939 0:d18dff347122 73 }
okini3939 0:d18dff347122 74
okini3939 0:d18dff347122 75 t = -1;
gulchi 2:fcd20e2cd110 76 for (i = 0; i < MODBUS_MAX_CLIENTS; i ++) {
gulchi 2:fcd20e2cd110 77 if (modbus->_state[i].thread->get_state() == Thread::WaitingAnd) {
okini3939 0:d18dff347122 78 if (t < 0) t = i; // next empty thread
okini3939 0:d18dff347122 79 }
okini3939 0:d18dff347122 80 }
okini3939 0:d18dff347122 81 }
okini3939 0:d18dff347122 82 }
okini3939 0:d18dff347122 83
gulchi 2:fcd20e2cd110 84 void Modbus::child (void const *arg) {
gulchi 2:fcd20e2cd110 85 Modbus *modbus = ModBus::getInstance();
okini3939 0:d18dff347122 86 int id = (int)arg;
okini3939 0:d18dff347122 87 int i, n;
gulchi 2:fcd20e2cd110 88 char buf[ModBus_BUF_SIZE];
okini3939 0:d18dff347122 89
okini3939 0:d18dff347122 90 for (;;) {
okini3939 0:d18dff347122 91 Thread::signal_wait(1);
gulchi 2:fcd20e2cd110 92 modbus->_state[id].mode = MODE_REQUEST;
gulchi 2:fcd20e2cd110 93 modbus->_state[id].buf->flush();
gulchi 2:fcd20e2cd110 94 modbus->_state[id].keepalive = 0;
dgriffin65 1:b724fdb741e7 95 INFO("Connection from client\r\n");
dgriffin65 1:b724fdb741e7 96 // INFO("Connection from %s\r\n", httpd->_state[id].client->get_ip_address());
dgriffin65 1:b724fdb741e7 97
gulchi 2:fcd20e2cd110 98 modbus->_state[id].client->set_blocking(false);
gulchi 2:fcd20e2cd110 99 modbus->_state[id].client->set_timeout(HTTPD_TIMEOUT);
dgriffin65 1:b724fdb741e7 100
okini3939 0:d18dff347122 101 for (;;) {
dgriffin65 1:b724fdb741e7 102 //if (! httpd->_state[id].client->is_connected()) break;
okini3939 0:d18dff347122 103
gulchi 2:fcd20e2cd110 104 n = modbus->_state[id].client->recv(buf, sizeof(buf));
dgriffin65 1:b724fdb741e7 105
dgriffin65 1:b724fdb741e7 106 if (n < 0 ) {
dgriffin65 1:b724fdb741e7 107 printf("HTTPD::child breaking n = %d\r\n", n);
dgriffin65 1:b724fdb741e7 108 break;
dgriffin65 1:b724fdb741e7 109 }
okini3939 0:d18dff347122 110 buf[n] = 0;
dgriffin65 1:b724fdb741e7 111 //DBG("Recv %d ", n);
dgriffin65 1:b724fdb741e7 112 DBG("Recv %d '%s'", n, buf);
okini3939 0:d18dff347122 113
okini3939 0:d18dff347122 114 for (i = 0; i < n; i ++) {
gulchi 2:fcd20e2cd110 115 modbus->recvData(id, buf[i]);
okini3939 0:d18dff347122 116 }
okini3939 0:d18dff347122 117 }
okini3939 0:d18dff347122 118
gulchi 2:fcd20e2cd110 119 modbus->_state[id].client->close(); // Needs to bere moved
dgriffin65 1:b724fdb741e7 120 INFO("Closed client connection\r\n");
dgriffin65 1:b724fdb741e7 121 //INFO("Close %s\r\n", httpd->_state[id].client->get_ip_address());
okini3939 0:d18dff347122 122 }
okini3939 0:d18dff347122 123 }
okini3939 0:d18dff347122 124
gulchi 2:fcd20e2cd110 125 void Modbus::closer (void const *arg) {
gulchi 2:fcd20e2cd110 126 Modbus *modbus = Modbus::getInstance();
okini3939 0:d18dff347122 127 int id = (int)arg;
okini3939 0:d18dff347122 128
okini3939 0:d18dff347122 129 for (;;) {
okini3939 0:d18dff347122 130 Thread::signal_wait(1);
okini3939 0:d18dff347122 131
gulchi 2:fcd20e2cd110 132 modbus->_state[id].client->close();
dgriffin65 1:b724fdb741e7 133 INFO("Closed client connection\r\n");
dgriffin65 1:b724fdb741e7 134 //INFO("Close %s\r\n", httpd->_state[id].client->get_ip_address());
okini3939 0:d18dff347122 135 }
okini3939 0:d18dff347122 136 }
okini3939 0:d18dff347122 137