Erick / Mbed 2 deprecated ICE_BLE_TEST

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   NaturalTinyShell_ice libmDot-12Sept mbed-rtos mbed

Fork of ICE by Erick

src/ModbusMaster/ModbusMaster.cpp@199:d65ed41d4dd4, 2016-10-07 (annotated)

Committer:
davidjhoward
Date:
Fri Oct 07 11:40:51 2016 +0000
Revision:
199:d65ed41d4dd4
Parent:
197:594afd088f32
Child:
203:9d735375f218
adding more inputs to the demo command

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jmarkel44 0:65cfa4873284 1 /******************************************************************************
davidjhoward 4:c35db3946fd8 2 *
jmarkel44 0:65cfa4873284 3 * File: ModbusMaster.cpp
jmarkel44 0:65cfa4873284 4 * Desciption: source for the ICE Modbus Master
jmarkel44 0:65cfa4873284 5 *
jmarkel44 0:65cfa4873284 6 *****************************************************************************/
jmarkel44 0:65cfa4873284 7 #include "global.h"
jmarkel44 0:65cfa4873284 8 #include <stdio.h>
davidjhoward 31:4b1587034318 9 #include "MTSLog.h"
jmarkel44 0:65cfa4873284 10 #include "BLEDataHandler.h"
davidjhoward 4:c35db3946fd8 11 #include "ModbusMaster.h"
davidjhoward 197:594afd088f32 12 #include "ModbusMasterApi.h"
davidjhoward 190:af7ab603c9fe 13 #include "mod.h"
davidjhoward 8:abe51ae5ef8b 14 #include "MbedJSONValue.h"
jmarkel44 0:65cfa4873284 15
davidjhoward 81:d45bfa16953a 16 DigitalOut dout1(PC_1);
davidjhoward 81:d45bfa16953a 17 DigitalOut dout2(PA_1);
davidjhoward 148:ee3cbaafe355 18 DigitalIn flow_switch(PA_0);
davidjhoward 148:ee3cbaafe355 19 DigitalIn dinp2(PC_13);
davidjhoward 81:d45bfa16953a 20
jmarkel44 0:65cfa4873284 21 /*****************************************************************************
jmarkel44 0:65cfa4873284 22 * Function: ModbusMaster
jmarkel44 0:65cfa4873284 23 * Description: entry point for the Modbus Master
jmarkel44 0:65cfa4873284 24 *
jmarkel44 0:65cfa4873284 25 * @param (IN) args (user-defined arguments)
jmarkel44 0:65cfa4873284 26 * @return none
jmarkel44 0:65cfa4873284 27 *****************************************************************************/
davidjhoward 149:950c90425f7c 28 std::map<std::string,VirtualCommand> VirtualCommandMap;
davidjhoward 149:950c90425f7c 29
jmarkel44 177:9ec90c8e3ce1 30 char ModbusMasterScratchBuf[MAX_FILE_SIZE];
jmarkel44 0:65cfa4873284 31 void ModbusMaster(void const *args)
jmarkel44 0:65cfa4873284 32 {
davidjhoward 31:4b1587034318 33 logInfo("%s ModbusMaster has started...", __func__);
davidjhoward 15:a6ee32969e8e 34 bool status;
davidjhoward 149:950c90425f7c 35 RegisterType_t regType;
davidjhoward 81:d45bfa16953a 36
davidjhoward 190:af7ab603c9fe 37 mod_init();
davidjhoward 190:af7ab603c9fe 38 DigitalOut mod_power(PA_11);
davidjhoward 190:af7ab603c9fe 39 mod_power = 0; // provide power to the modbus
jmarkel44 0:65cfa4873284 40
davidjhoward 39:9287c7d59016 41 while( true ) {
davidjhoward 8:abe51ae5ef8b 42
davidjhoward 173:acfb464a4aec 43 MbedJSONValue json_value;
davidjhoward 173:acfb464a4aec 44
davidjhoward 39:9287c7d59016 45 // configure modbus registers based in all files that start with "input"
davidjhoward 39:9287c7d59016 46 std::vector<mDot::mdot_file> file_list = GLOBAL_mdot->listUserFiles();
davidjhoward 39:9287c7d59016 47 for (std::vector<mDot::mdot_file>::iterator i = file_list.begin(); i != file_list.end(); ++i) {
davidjhoward 149:950c90425f7c 48 if( (strncmp( i->name, "vcmd", (strlen("input")-1)) == 0) ) {
jmarkel44 177:9ec90c8e3ce1 49 status = GLOBAL_mdot->readUserFile(i->name, ModbusMasterScratchBuf, MAX_FILE_SIZE);
davidjhoward 149:950c90425f7c 50 if( status != true ) {
davidjhoward 149:950c90425f7c 51 logInfo("(%d)read file failed, status=%d", __LINE__, status);
davidjhoward 149:950c90425f7c 52 } else {
davidjhoward 151:9d47fe5ba805 53 logInfo("(%s:%d)loading File: %s", __func__, __LINE__, i->name );
davidjhoward 149:950c90425f7c 54 }
davidjhoward 8:abe51ae5ef8b 55
davidjhoward 149:950c90425f7c 56 parse( json_value, ModbusMasterScratchBuf );
davidjhoward 162:5e8948b8044d 57
davidjhoward 149:950c90425f7c 58 std::string id = json_value["id"].get<std::string>().c_str();
davidjhoward 149:950c90425f7c 59 VirtualCommandMap[id].constant = atof(json_value["constant"].get<std::string>().c_str());
davidjhoward 149:950c90425f7c 60 VirtualCommandMap[id].opl = json_value["opl"].get<std::string>().c_str();
davidjhoward 149:950c90425f7c 61 VirtualCommandMap[id].opr = json_value["opr"].get<std::string>().c_str();
davidjhoward 149:950c90425f7c 62 VirtualCommandMap[id].op = json_value["op"].get<std::string>().c_str();
davidjhoward 151:9d47fe5ba805 63 logInfo("Processd virtual command file: id=%s", id.c_str());
davidjhoward 149:950c90425f7c 64 continue;
davidjhoward 149:950c90425f7c 65 }
davidjhoward 149:950c90425f7c 66
davidjhoward 149:950c90425f7c 67 regType = REG_TYPE_NONE;
davidjhoward 149:950c90425f7c 68
davidjhoward 149:950c90425f7c 69 if( (strncmp( i->name, "input", (strlen("input")-1)) == 0) ) {
davidjhoward 149:950c90425f7c 70 regType = REG_TYPE_INPUT;
davidjhoward 149:950c90425f7c 71 } else if( (strncmp( i->name, "output", (strlen("output")-1)) == 0) ) {
davidjhoward 149:950c90425f7c 72 regType = REG_TYPE_OUTPUT;
davidjhoward 149:950c90425f7c 73 } else if( (strncmp( i->name, "vinput", (strlen("vinput")-1)) == 0) ) {
davidjhoward 149:950c90425f7c 74 regType = REG_TYPE_VINPUT;
davidjhoward 149:950c90425f7c 75 } else if( (strncmp( i->name, "voutput", (strlen("voutput")-1)) == 0) ) {
davidjhoward 149:950c90425f7c 76 regType = REG_TYPE_VOUTPUT;
davidjhoward 149:950c90425f7c 77 }
davidjhoward 149:950c90425f7c 78
davidjhoward 149:950c90425f7c 79 if( regType != REG_TYPE_NONE ) {
davidjhoward 81:d45bfa16953a 80
jmarkel44 177:9ec90c8e3ce1 81 status = GLOBAL_mdot->readUserFile(i->name, ModbusMasterScratchBuf, MAX_FILE_SIZE);
davidjhoward 39:9287c7d59016 82 if( status != true ) {
davidjhoward 45:3b9e1923cb15 83 logInfo("(%d)read file failed, status=%d", __LINE__, status);
davidjhoward 39:9287c7d59016 84 } else {
davidjhoward 151:9d47fe5ba805 85 logInfo("(%s:%d)loading File: %s", __func__, __LINE__, i->name );
davidjhoward 39:9287c7d59016 86 }
davidjhoward 81:d45bfa16953a 87
davidjhoward 42:c703a60993b1 88 parse( json_value, ModbusMasterScratchBuf );
davidjhoward 9:ef0ca2f8a8a6 89
davidjhoward 39:9287c7d59016 90 std::string id = json_value["id"].get<std::string>().c_str();
davidjhoward 39:9287c7d59016 91 ModbusRegisterMap[id].name = json_value["name"].get<std::string>().c_str();
davidjhoward 39:9287c7d59016 92 ModbusRegisterMap[id].units = json_value["units"].get<std::string>().c_str();
davidjhoward 39:9287c7d59016 93 ModbusRegisterMap[id].min = atof(json_value["min"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 94 ModbusRegisterMap[id].max = atof(json_value["max"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 95 ModbusRegisterMap[id].node = atoi(json_value["node"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 96 ModbusRegisterMap[id].reg = atoi(json_value["reg"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 97 ModbusRegisterMap[id].rtype = atoi(json_value["rtype"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 98 ModbusRegisterMap[id].type = atoi(json_value["type"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 99 ModbusRegisterMap[id].size = atoi(json_value["size"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 100 ModbusRegisterMap[id].order = atoi(json_value["order"].get<std::string>().c_str());
davidjhoward 39:9287c7d59016 101 ModbusRegisterMap[id].fmt = json_value["fmt"].get<std::string>().c_str();
davidjhoward 49:0456ee2271be 102 ModbusRegisterMap[id].rfreq = atoi(json_value["rfreq"].get<std::string>().c_str());
davidjhoward 149:950c90425f7c 103 ModbusRegisterMap[id].regType = regType;
davidjhoward 82:f3e495a98877 104 ModbusRegisterMap[id].simulated = false;
davidjhoward 190:af7ab603c9fe 105 ModbusRegisterMap[id].errflag = 0;
davidjhoward 149:950c90425f7c 106 if( (regType == REG_TYPE_VINPUT) || (regType == REG_TYPE_VOUTPUT) ) {
davidjhoward 149:950c90425f7c 107 ModbusRegisterMap[id].vcmd = json_value["vcmd"].get<std::string>().c_str();
davidjhoward 149:950c90425f7c 108 }
davidjhoward 15:a6ee32969e8e 109 }
davidjhoward 4:c35db3946fd8 110 }
davidjhoward 162:5e8948b8044d 111
davidjhoward 151:9d47fe5ba805 112 osSignalSet(mainThreadId, sig_output_continue);
davidjhoward 31:4b1587034318 113
davidjhoward 39:9287c7d59016 114 // read modbus registers that have been configured.
davidjhoward 39:9287c7d59016 115 while ( true ) {
davidjhoward 39:9287c7d59016 116
davidjhoward 39:9287c7d59016 117 std::map<std::string, ModbusRegister>::iterator iter;
davidjhoward 39:9287c7d59016 118 for (iter = ModbusRegisterMap.begin(); iter != ModbusRegisterMap.end(); ++iter) {
davidjhoward 82:f3e495a98877 119 if( iter->second.simulated == true ) {
davidjhoward 199:d65ed41d4dd4 120 ModbusRegisterMap[iter->first].errflag = 0;
davidjhoward 181:e2c982c94e98 121 // printf("\r\nsimulating input=%s, min=%2.2f, max=%2.2f, start_value=%2.2f, up_step=%2.2f, down_step=%2.2f moving_up=%d\r\n",iter->first.c_str(), SimulateInputMap[iter->first].min, SimulateInputMap[iter->first].max, SimulateInputMap[iter->first].start_value, SimulateInputMap[iter->first].up_step, SimulateInputMap[iter->first].down_step, SimulateInputMap[iter->first].moving_up);
davidjhoward 176:492cfa856521 122 if( (SimulateInputMap[iter->first].min == 0) && (SimulateInputMap[iter->first].max == 0) ) {
davidjhoward 176:492cfa856521 123 ModbusRegisterMap[iter->first].float_value = SimulateInputMap[iter->first].start_value;
davidjhoward 181:e2c982c94e98 124 // printf("simulating input=%s, value=%2.2f\r\n",iter->first.c_str(), ModbusRegisterMap[iter->first].float_value);
davidjhoward 176:492cfa856521 125 } else {
davidjhoward 176:492cfa856521 126 if( ModbusRegisterMap[iter->first].float_value >= SimulateInputMap[iter->first].max ) {
davidjhoward 179:a31ea334e2b7 127 SimulateInputMap[iter->first].moving_up = false;
davidjhoward 181:e2c982c94e98 128 // printf("simulating down input=%s, value=%2.2f - %2.2f\r\n",iter->first.c_str(), ModbusRegisterMap[iter->first].float_value, SimulateInputMap[iter->first].down_step);
davidjhoward 176:492cfa856521 129 ModbusRegisterMap[iter->first].float_value = ModbusRegisterMap[iter->first].float_value - SimulateInputMap[iter->first].down_step;
davidjhoward 176:492cfa856521 130 } else if( ModbusRegisterMap[iter->first].float_value <= SimulateInputMap[iter->first].min ) {
davidjhoward 179:a31ea334e2b7 131 SimulateInputMap[iter->first].moving_up = true;
davidjhoward 181:e2c982c94e98 132 // printf("simulating up input=%s, value=%2.2f + %2.2f\r\n",iter->first.c_str(), ModbusRegisterMap[iter->first].float_value, SimulateInputMap[iter->first].up_step);
davidjhoward 176:492cfa856521 133 ModbusRegisterMap[iter->first].float_value = ModbusRegisterMap[iter->first].float_value + SimulateInputMap[iter->first].up_step;
davidjhoward 82:f3e495a98877 134 } else {
davidjhoward 179:a31ea334e2b7 135 if( SimulateInputMap[iter->first].moving_up == true ) {
davidjhoward 181:e2c982c94e98 136 // printf("continue simulate up input=%s, value=%2.2f + %2.2f\r\n",iter->first.c_str(), ModbusRegisterMap[iter->first].float_value, SimulateInputMap[iter->first].up_step);
davidjhoward 150:4db35c8234b4 137 ModbusRegisterMap[iter->first].float_value = ModbusRegisterMap[iter->first].float_value + SimulateInputMap[iter->first].up_step;
davidjhoward 82:f3e495a98877 138 } else {
davidjhoward 181:e2c982c94e98 139 // printf("continue simulate down input=%s, value=%2.2f - %2.2f\r\n",iter->first.c_str(), ModbusRegisterMap[iter->first].float_value, SimulateInputMap[iter->first].down_step);
davidjhoward 176:492cfa856521 140 ModbusRegisterMap[iter->first].float_value = ModbusRegisterMap[iter->first].float_value - SimulateInputMap[iter->first].down_step;
davidjhoward 82:f3e495a98877 141 }
davidjhoward 82:f3e495a98877 142 }
davidjhoward 181:e2c982c94e98 143 // printf("simulating input=%s, value=%2.2f\r\n\r\n",iter->first.c_str(), ModbusRegisterMap[iter->first].float_value);
davidjhoward 82:f3e495a98877 144 }
davidjhoward 82:f3e495a98877 145 continue;
davidjhoward 82:f3e495a98877 146 }
davidjhoward 148:ee3cbaafe355 147
davidjhoward 147:105bcf234f81 148 if( iter->second.node != 0 ) {
davidjhoward 197:594afd088f32 149 unsigned char rd_buf[16];
davidjhoward 197:594afd088f32 150 memset( rd_buf, 0, 16 );
davidjhoward 149:950c90425f7c 151 logInfo("Processing Input: tag=%s, node=%d, reg=%d, size=%d, order=%d", iter->first.c_str(), iter->second.node, iter->second.reg, iter->second.size, iter->second.order );
davidjhoward 190:af7ab603c9fe 152 int ret = mod_read(iter->second.node, iter->second.rtype, iter->second.reg, iter->second.size, rd_buf);
davidjhoward 147:105bcf234f81 153 switch( iter->second.type ) {
davidjhoward 147:105bcf234f81 154 case TYPE_32BIT_FLOAT:
davidjhoward 147:105bcf234f81 155 float float_value;
davidjhoward 190:af7ab603c9fe 156 if( ret != MOD_ERROR_NONE ) {
davidjhoward 190:af7ab603c9fe 157 ModbusRegisterMap[iter->first].errflag = ret;
davidjhoward 190:af7ab603c9fe 158 break;
davidjhoward 190:af7ab603c9fe 159 }
davidjhoward 190:af7ab603c9fe 160 status = ReadModbus_32bit_float( &float_value, iter->second.order, rd_buf );
davidjhoward 147:105bcf234f81 161 if( status == true ) {
davidjhoward 147:105bcf234f81 162 ModbusRegisterMap[iter->first].float_value = float_value;
davidjhoward 190:af7ab603c9fe 163 ModbusRegisterMap[iter->first].errflag = 0;
davidjhoward 148:ee3cbaafe355 164 // logInfo("Modbus Tag:%s value=%2.2f", iter->first.c_str(), float_value );
davidjhoward 147:105bcf234f81 165 } else {
davidjhoward 190:af7ab603c9fe 166 ModbusRegisterMap[iter->first].errflag = 1000;
davidjhoward 148:ee3cbaafe355 167 // logInfo("Modbus Read Failed, tag=%s", iter->first.c_str() );
davidjhoward 147:105bcf234f81 168 }
davidjhoward 147:105bcf234f81 169 break;
davidjhoward 147:105bcf234f81 170 case TYPE_32BIT_INT:
davidjhoward 186:16912aa18c2a 171 int32_t int32_value;
davidjhoward 190:af7ab603c9fe 172 if( ret != MOD_ERROR_NONE ) {
davidjhoward 190:af7ab603c9fe 173 ModbusRegisterMap[iter->first].errflag = ret;
davidjhoward 190:af7ab603c9fe 174 break;
davidjhoward 190:af7ab603c9fe 175 }
davidjhoward 190:af7ab603c9fe 176 status = ReadModbus_32bit_int( &int32_value, iter->second.order, rd_buf );
davidjhoward 186:16912aa18c2a 177 if( status == true ) {
davidjhoward 186:16912aa18c2a 178 ModbusRegisterMap[iter->first].float_value = int32_value;
davidjhoward 190:af7ab603c9fe 179 ModbusRegisterMap[iter->first].errflag = 0;
davidjhoward 186:16912aa18c2a 180 logInfo("Modbus Tag:%s value=%2.2f", iter->first.c_str(), ModbusRegisterMap[iter->first].float_value );
davidjhoward 186:16912aa18c2a 181 } else {
davidjhoward 190:af7ab603c9fe 182 ModbusRegisterMap[iter->first].errflag = 1000;
davidjhoward 186:16912aa18c2a 183 logInfo("Modbus Read Failed, tag=%s", iter->first.c_str() );
davidjhoward 186:16912aa18c2a 184 }
davidjhoward 147:105bcf234f81 185 break;
davidjhoward 147:105bcf234f81 186 case TYPE_32BIT_UINT:
davidjhoward 147:105bcf234f81 187 break;
davidjhoward 147:105bcf234f81 188 case TYPE_16BIT_INT:
davidjhoward 147:105bcf234f81 189 break;
davidjhoward 147:105bcf234f81 190 case TYPE_16BIT_UINT:
davidjhoward 147:105bcf234f81 191 break;
davidjhoward 147:105bcf234f81 192 default:
davidjhoward 147:105bcf234f81 193 break;
davidjhoward 147:105bcf234f81 194 }
davidjhoward 39:9287c7d59016 195 }
davidjhoward 82:f3e495a98877 196
davidjhoward 149:950c90425f7c 197 if( (iter->second.node == 0) && (iter->second.regType == REG_TYPE_OUTPUT) ) {
davidjhoward 148:ee3cbaafe355 198 // logInfo("processing PIN output=%s, reg=%d, value=%d",iter->first.c_str(), ModbusRegisterMap[iter->first].reg, (bool)ModbusRegisterMap[iter->first].float_value);
davidjhoward 148:ee3cbaafe355 199 if( ModbusRegisterMap[iter->first].reg == 1 ) {
davidjhoward 189:546b04f89b19 200 dout1 = (bool)((int)ModbusRegisterMap[iter->first].float_value&0x1);
davidjhoward 148:ee3cbaafe355 201 } else {
davidjhoward 189:546b04f89b19 202 dout2 = (bool)((int)ModbusRegisterMap[iter->first].float_value&0x1);
davidjhoward 148:ee3cbaafe355 203 }
davidjhoward 148:ee3cbaafe355 204 }
davidjhoward 149:950c90425f7c 205 if( (iter->second.node == 0) && (iter->second.regType == REG_TYPE_INPUT) ) {
davidjhoward 148:ee3cbaafe355 206 // logInfo("processing PIN input=%s, reg=%d, value=%d",iter->first.c_str(), ModbusRegisterMap[iter->first].reg, (bool)ModbusRegisterMap[iter->first].float_value);
davidjhoward 148:ee3cbaafe355 207 if( ModbusRegisterMap[iter->first].reg == 1 ) {
davidjhoward 148:ee3cbaafe355 208 // digital input
davidjhoward 148:ee3cbaafe355 209 ModbusRegisterMap[iter->first].float_value = (float)flow_switch.read();
davidjhoward 148:ee3cbaafe355 210 } else {
davidjhoward 148:ee3cbaafe355 211 ModbusRegisterMap[iter->first].float_value = (float)dinp2.read();
davidjhoward 81:d45bfa16953a 212 }
davidjhoward 81:d45bfa16953a 213 }
davidjhoward 39:9287c7d59016 214 }
davidjhoward 39:9287c7d59016 215
davidjhoward 149:950c90425f7c 216 // now update all of the virtual registers
davidjhoward 149:950c90425f7c 217 for (iter = ModbusRegisterMap.begin(); iter != ModbusRegisterMap.end(); ++iter) {
davidjhoward 149:950c90425f7c 218 if( (ModbusRegisterMap[iter->first].regType != REG_TYPE_VINPUT) && (ModbusRegisterMap[iter->first].regType != REG_TYPE_VOUTPUT) ) {
davidjhoward 149:950c90425f7c 219 continue;
davidjhoward 149:950c90425f7c 220 }
davidjhoward 149:950c90425f7c 221 logInfo("Processing Virtual Input: vcmd:%s, tag:%s, opl:%s, opr:%s, op:%s, constant:%.4f", iter->second.vcmd.c_str(), iter->first.c_str(),
davidjhoward 149:950c90425f7c 222 VirtualCommandMap[iter->second.vcmd].opl.c_str(),
davidjhoward 149:950c90425f7c 223 VirtualCommandMap[iter->second.vcmd].opr.c_str(),
davidjhoward 149:950c90425f7c 224 VirtualCommandMap[iter->second.vcmd].op.c_str(),
davidjhoward 149:950c90425f7c 225 VirtualCommandMap[iter->second.vcmd].constant
davidjhoward 149:950c90425f7c 226 );
davidjhoward 149:950c90425f7c 227 switch( VirtualCommandMap[iter->second.vcmd].op.c_str()[0] ) {
davidjhoward 149:950c90425f7c 228 case '=':
davidjhoward 149:950c90425f7c 229 ModbusRegisterMap[iter->first].float_value = ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opl].float_value;
davidjhoward 149:950c90425f7c 230 logInfo("Setting tag=%s, equal to (value=%2.2f)", iter->first.c_str(),
jmarkel44 169:c503848823aa 231 //VirtualCommandMap[iter->second.vcmd].opl.c_str(),
davidjhoward 149:950c90425f7c 232 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opl].float_value
davidjhoward 149:950c90425f7c 233 );
davidjhoward 149:950c90425f7c 234 break;
davidjhoward 149:950c90425f7c 235 case '*':
davidjhoward 162:5e8948b8044d 236 ModbusRegisterMap[iter->first].float_value =
davidjhoward 162:5e8948b8044d 237 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opl].float_value *
davidjhoward 162:5e8948b8044d 238 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opr].float_value;
davidjhoward 162:5e8948b8044d 239 logInfo("Setting tag=%s, equal to (%2.2f*%2.2f) = %2.2f", iter->first.c_str(),
jmarkel44 169:c503848823aa 240 //VirtualCommandMap[iter->second.vcmd].opl.c_str(),
davidjhoward 162:5e8948b8044d 241 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opl].float_value,
davidjhoward 162:5e8948b8044d 242 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opr].float_value,
davidjhoward 162:5e8948b8044d 243 ModbusRegisterMap[iter->first].float_value
davidjhoward 162:5e8948b8044d 244 );
davidjhoward 149:950c90425f7c 245 case '/':
davidjhoward 162:5e8948b8044d 246 if( ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opr].float_value != 0 ) {
davidjhoward 162:5e8948b8044d 247 ModbusRegisterMap[iter->first].float_value =
davidjhoward 162:5e8948b8044d 248 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opl].float_value /
davidjhoward 162:5e8948b8044d 249 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opr].float_value;
davidjhoward 162:5e8948b8044d 250 logInfo("Setting tag=%s, equal to (%2.2f/%2.2f) = %2.2f", iter->first.c_str(),
jmarkel44 169:c503848823aa 251 //VirtualCommandMap[iter->second.vcmd].opl.c_str(),
davidjhoward 162:5e8948b8044d 252 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opl].float_value,
davidjhoward 162:5e8948b8044d 253 ModbusRegisterMap[VirtualCommandMap[iter->second.vcmd].opr].float_value,
davidjhoward 162:5e8948b8044d 254 ModbusRegisterMap[iter->first].float_value
davidjhoward 162:5e8948b8044d 255 );
davidjhoward 162:5e8948b8044d 256 } else {
davidjhoward 162:5e8948b8044d 257 logInfo("NOT DOING DIVIDE BY ZERO");
davidjhoward 162:5e8948b8044d 258 }
davidjhoward 162:5e8948b8044d 259 break;
davidjhoward 149:950c90425f7c 260 case '+':
davidjhoward 149:950c90425f7c 261 case '-':
davidjhoward 149:950c90425f7c 262 default:
davidjhoward 149:950c90425f7c 263 break;
davidjhoward 149:950c90425f7c 264 }
davidjhoward 149:950c90425f7c 265 }
davidjhoward 149:950c90425f7c 266
davidjhoward 39:9287c7d59016 267 osEvent evt = ModbusMasterMailBox.get(50);
davidjhoward 39:9287c7d59016 268 if (evt.status == osEventMail) {
davidjhoward 39:9287c7d59016 269 Message_t *mail = (Message_t*)evt.value.p;
davidjhoward 197:594afd088f32 270 printf("Mail Received: Action: %d, New Input File: %s\r\n", mail->action, mail->controlFile);
davidjhoward 197:594afd088f32 271 if( mail->action == ACTION_EXEC_CMD ) {
davidjhoward 197:594afd088f32 272 ModbusMasterExecCmd( mail->controlFile );
davidjhoward 197:594afd088f32 273 } else {
davidjhoward 197:594afd088f32 274 ModbusRegisterMap.clear();
davidjhoward 197:594afd088f32 275 }
davidjhoward 39:9287c7d59016 276 ModbusMasterMailBox.free(mail);
davidjhoward 39:9287c7d59016 277 break;
davidjhoward 39:9287c7d59016 278 }
davidjhoward 57:5f18ae91c7c7 279 Thread::wait(5000);
davidjhoward 31:4b1587034318 280 }
jmarkel44 0:65cfa4873284 281 }
davidjhoward 4:c35db3946fd8 282 }
davidjhoward 4:c35db3946fd8 283
davidjhoward 190:af7ab603c9fe 284 bool ReadModbus_32bit_float( float *float_value, int order, unsigned char *rd_buf )
davidjhoward 4:c35db3946fd8 285 {
davidjhoward 15:a6ee32969e8e 286 MR_REGISTER_32_BIT_FLOAT value;
davidjhoward 31:4b1587034318 287
davidjhoward 15:a6ee32969e8e 288 switch( order ) {
davidjhoward 31:4b1587034318 289 case BigEndian:
davidjhoward 190:af7ab603c9fe 290 value.b.lo_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 291 value.b.lo_hi = rd_buf[2];
davidjhoward 190:af7ab603c9fe 292 value.b.hi_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 293 value.b.hi_hi = rd_buf[0];
davidjhoward 15:a6ee32969e8e 294 break;
davidjhoward 15:a6ee32969e8e 295 case BigEndianReverseWord:
davidjhoward 190:af7ab603c9fe 296 value.b.lo_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 297 value.b.lo_hi = rd_buf[0];
davidjhoward 190:af7ab603c9fe 298 value.b.hi_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 299 value.b.hi_hi = rd_buf[2];
davidjhoward 15:a6ee32969e8e 300 break;
davidjhoward 15:a6ee32969e8e 301 default:
davidjhoward 197:594afd088f32 302 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 15:a6ee32969e8e 303 return false;
davidjhoward 15:a6ee32969e8e 304 }
davidjhoward 188:d35a74bf4e92 305 // printf("0x%x 0x%x 0x%x 0x%x (%2.2f)\r\n", value.b.hi_hi, value.b.hi_lo, value.b.lo_hi, value.b.lo_lo, value.f);
davidjhoward 15:a6ee32969e8e 306 *float_value = value.f;
davidjhoward 4:c35db3946fd8 307 return true;
davidjhoward 4:c35db3946fd8 308 }
davidjhoward 186:16912aa18c2a 309
davidjhoward 197:594afd088f32 310 bool WriteModbus_32bit_float( float float_value, int order, unsigned char *xmt_buf )
davidjhoward 197:594afd088f32 311 {
davidjhoward 197:594afd088f32 312 MR_REGISTER_32_BIT_FLOAT value;
davidjhoward 197:594afd088f32 313
davidjhoward 197:594afd088f32 314 value.f = float_value;
davidjhoward 197:594afd088f32 315
davidjhoward 197:594afd088f32 316 switch( order ) {
davidjhoward 197:594afd088f32 317 case BigEndian:
davidjhoward 197:594afd088f32 318 xmt_buf[3] = value.b.lo_lo;
davidjhoward 197:594afd088f32 319 xmt_buf[2] = value.b.lo_hi;
davidjhoward 197:594afd088f32 320 xmt_buf[1] = value.b.hi_lo;
davidjhoward 197:594afd088f32 321 xmt_buf[0] = value.b.hi_hi;
davidjhoward 197:594afd088f32 322 break;
davidjhoward 197:594afd088f32 323 case BigEndianReverseWord:
davidjhoward 197:594afd088f32 324 xmt_buf[1] = value.b.lo_lo;
davidjhoward 197:594afd088f32 325 xmt_buf[0] = value.b.lo_hi;
davidjhoward 197:594afd088f32 326 xmt_buf[3] = value.b.hi_lo;
davidjhoward 197:594afd088f32 327 xmt_buf[2] = value.b.hi_hi;
davidjhoward 197:594afd088f32 328 break;
davidjhoward 197:594afd088f32 329 default:
davidjhoward 197:594afd088f32 330 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 197:594afd088f32 331 return false;
davidjhoward 197:594afd088f32 332 }
davidjhoward 197:594afd088f32 333 printf("%s:%d: 0x%x 0x%x 0x%x 0x%x (%2.2f)\r\n",__func__,__LINE__, value.b.hi_hi, value.b.hi_lo, value.b.lo_hi, value.b.lo_lo, value.f);
davidjhoward 197:594afd088f32 334 return true;
davidjhoward 197:594afd088f32 335 }
davidjhoward 197:594afd088f32 336
davidjhoward 190:af7ab603c9fe 337 bool ReadModbus_32bit_int( int32_t *int32_value, int order, unsigned char *rd_buf )
davidjhoward 186:16912aa18c2a 338 {
davidjhoward 186:16912aa18c2a 339 MR_REGISTER_32BIT_INT value;
davidjhoward 186:16912aa18c2a 340
davidjhoward 186:16912aa18c2a 341 switch( order ) {
davidjhoward 186:16912aa18c2a 342 case BigEndian:
davidjhoward 190:af7ab603c9fe 343 value.b.lo_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 344 value.b.lo_hi = rd_buf[2];
davidjhoward 190:af7ab603c9fe 345 value.b.hi_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 346 value.b.hi_hi = rd_buf[0];
davidjhoward 186:16912aa18c2a 347 break;
davidjhoward 186:16912aa18c2a 348 case BigEndianReverseWord:
davidjhoward 190:af7ab603c9fe 349 value.b.lo_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 350 value.b.lo_hi = rd_buf[0];
davidjhoward 190:af7ab603c9fe 351 value.b.hi_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 352 value.b.hi_hi = rd_buf[2];
davidjhoward 186:16912aa18c2a 353 break;
davidjhoward 186:16912aa18c2a 354 default:
davidjhoward 197:594afd088f32 355 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 186:16912aa18c2a 356 return false;
davidjhoward 186:16912aa18c2a 357 }
davidjhoward 188:d35a74bf4e92 358 // printf("0x%x 0x%x 0x%x 0x%x (%d)\r\n", value.b.hi_hi, value.b.hi_lo, value.b.lo_hi, value.b.lo_lo, value.i);
davidjhoward 186:16912aa18c2a 359 *int32_value = value.i;
davidjhoward 186:16912aa18c2a 360 return true;
davidjhoward 197:594afd088f32 361 }
davidjhoward 197:594afd088f32 362
davidjhoward 197:594afd088f32 363 bool WriteModbus_32bit_int( int32_t int32_value, int order, unsigned char *xmt_buf )
davidjhoward 197:594afd088f32 364 {
davidjhoward 197:594afd088f32 365 MR_REGISTER_32BIT_INT value;
davidjhoward 197:594afd088f32 366
davidjhoward 197:594afd088f32 367 value.i = int32_value;
davidjhoward 197:594afd088f32 368
davidjhoward 197:594afd088f32 369 switch( order ) {
davidjhoward 197:594afd088f32 370 case BigEndian:
davidjhoward 197:594afd088f32 371 xmt_buf[3] = value.b.lo_lo;
davidjhoward 197:594afd088f32 372 xmt_buf[2] = value.b.lo_hi;
davidjhoward 197:594afd088f32 373 xmt_buf[1] = value.b.hi_lo;
davidjhoward 197:594afd088f32 374 xmt_buf[0] = value.b.hi_hi;
davidjhoward 197:594afd088f32 375 break;
davidjhoward 197:594afd088f32 376 case BigEndianReverseWord:
davidjhoward 197:594afd088f32 377 xmt_buf[1] = value.b.lo_lo;
davidjhoward 197:594afd088f32 378 xmt_buf[0] = value.b.lo_hi;
davidjhoward 197:594afd088f32 379 xmt_buf[3] = value.b.hi_lo;
davidjhoward 197:594afd088f32 380 xmt_buf[2] = value.b.hi_hi;
davidjhoward 197:594afd088f32 381 break;
davidjhoward 197:594afd088f32 382 default:
davidjhoward 197:594afd088f32 383 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 197:594afd088f32 384 return false;
davidjhoward 197:594afd088f32 385 }
davidjhoward 197:594afd088f32 386 printf("%s:%d: 0x%x 0x%x 0x%x 0x%x (%d)\r\n", __func__, __LINE__, value.b.hi_hi, value.b.hi_lo, value.b.lo_hi, value.b.lo_lo, value.i);
davidjhoward 197:594afd088f32 387 return true;
davidjhoward 197:594afd088f32 388 }
davidjhoward 197:594afd088f32 389
davidjhoward 197:594afd088f32 390 bool WriteModbus_16bit_int( int16_t int16_value, int order, unsigned char *xmt_buf )
davidjhoward 197:594afd088f32 391 {
davidjhoward 197:594afd088f32 392 MR_REGISTER_16BIT_INT value;
davidjhoward 197:594afd088f32 393
davidjhoward 197:594afd088f32 394 value.w = int16_value;
davidjhoward 197:594afd088f32 395
davidjhoward 197:594afd088f32 396 switch( order ) {
davidjhoward 197:594afd088f32 397 case BigEndian:
davidjhoward 197:594afd088f32 398 case BigEndianReverseWord:
davidjhoward 197:594afd088f32 399 xmt_buf[1] = value.b.lo;
davidjhoward 197:594afd088f32 400 xmt_buf[0] = value.b.hi;
davidjhoward 197:594afd088f32 401 break;
davidjhoward 197:594afd088f32 402 default:
davidjhoward 197:594afd088f32 403 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 197:594afd088f32 404 return false;
davidjhoward 197:594afd088f32 405 }
davidjhoward 197:594afd088f32 406 printf("%s:%d: 0x%x 0x%x (%d)\r\n", __func__,__LINE__, value.b.hi, value.b.lo, value.w);
davidjhoward 197:594afd088f32 407 return true;
davidjhoward 197:594afd088f32 408 }
davidjhoward 197:594afd088f32 409
davidjhoward 197:594afd088f32 410 void ModbusMasterExecCmd( char *cmd )
davidjhoward 197:594afd088f32 411 {
davidjhoward 197:594afd088f32 412 MbedJSONValue json_cmd;
davidjhoward 197:594afd088f32 413 bool status;
davidjhoward 197:594afd088f32 414 int ret;
davidjhoward 197:594afd088f32 415 unsigned char rd_buf[16];
davidjhoward 197:594afd088f32 416
davidjhoward 197:594afd088f32 417 // printf("%s:%d: command=%s\r\n", __func__, __LINE__, cmd );
davidjhoward 197:594afd088f32 418
davidjhoward 197:594afd088f32 419 parse( json_cmd, cmd );
davidjhoward 197:594afd088f32 420
davidjhoward 197:594afd088f32 421 std::string id = json_cmd["id"].get<std::string>().c_str();
davidjhoward 197:594afd088f32 422 int node = atoi(json_cmd["node"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 423 int func = atoi(json_cmd["func"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 424 int sreg = atoi(json_cmd["sreg"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 425 int nreg = atoi(json_cmd["nreg"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 426 int dtype = atoi(json_cmd["dtype"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 427 int order = atoi(json_cmd["order"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 428 float value = atof(json_cmd["value"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 429
davidjhoward 197:594afd088f32 430 switch( func ) {
davidjhoward 197:594afd088f32 431 case MOD_FUNC_GET_HREG: // read holding register
davidjhoward 197:594afd088f32 432 case MOD_FUNC_GET_IREG: // read input register
davidjhoward 197:594afd088f32 433 ret = mod_read(node, func, sreg, nreg, rd_buf);
davidjhoward 197:594afd088f32 434 switch( dtype ) {
davidjhoward 197:594afd088f32 435 case TYPE_32BIT_FLOAT: {
davidjhoward 197:594afd088f32 436 float float_value;
davidjhoward 197:594afd088f32 437 if( ret != MOD_ERROR_NONE ) {
davidjhoward 197:594afd088f32 438 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 439 break;
davidjhoward 197:594afd088f32 440 }
davidjhoward 197:594afd088f32 441 status = ReadModbus_32bit_float( &float_value, order, rd_buf );
davidjhoward 197:594afd088f32 442 if( status == true ) {
davidjhoward 197:594afd088f32 443 printf("CMD: %s:%d: %s value=%2.2f\r\n", __func__, __LINE__, id.c_str(), float_value );
davidjhoward 197:594afd088f32 444 } else {
davidjhoward 197:594afd088f32 445 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 446 }
davidjhoward 197:594afd088f32 447 break;
davidjhoward 197:594afd088f32 448 }
davidjhoward 197:594afd088f32 449 case TYPE_32BIT_INT:
davidjhoward 197:594afd088f32 450 case TYPE_32BIT_UINT: {
davidjhoward 197:594afd088f32 451 int32_t int32_value;
davidjhoward 197:594afd088f32 452 if( ret != MOD_ERROR_NONE ) {
davidjhoward 197:594afd088f32 453 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 454 break;
davidjhoward 197:594afd088f32 455 }
davidjhoward 197:594afd088f32 456 status = ReadModbus_32bit_int( &int32_value, order, rd_buf );
davidjhoward 197:594afd088f32 457 if( status == true ) {
davidjhoward 197:594afd088f32 458 printf("CMD: %s:%d: %s value=%d\r\n", __func__, __LINE__, id.c_str(), int32_value );
davidjhoward 197:594afd088f32 459 } else {
davidjhoward 197:594afd088f32 460 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 461 }
davidjhoward 197:594afd088f32 462 break;
davidjhoward 197:594afd088f32 463 }
davidjhoward 197:594afd088f32 464 case TYPE_16BIT_INT:
davidjhoward 197:594afd088f32 465 case TYPE_16BIT_UINT:
davidjhoward 197:594afd088f32 466 break;
davidjhoward 197:594afd088f32 467 default:
davidjhoward 197:594afd088f32 468 break;
davidjhoward 197:594afd088f32 469 }
davidjhoward 197:594afd088f32 470 break;
davidjhoward 197:594afd088f32 471 case MOD_FUNC_SET_HREG: // write holding register
davidjhoward 197:594afd088f32 472 case MOD_FUNC_SET_HREGS: // write multiple registers (only supports 2 right now)
davidjhoward 197:594afd088f32 473 case MOD_FUNC_SET_COIL: { // write coil
davidjhoward 197:594afd088f32 474 unsigned char xmt_buf[10];
davidjhoward 197:594afd088f32 475 switch( dtype ) {
davidjhoward 197:594afd088f32 476 case TYPE_32BIT_FLOAT: {
davidjhoward 197:594afd088f32 477 status = WriteModbus_32bit_float( value, order, xmt_buf );
davidjhoward 197:594afd088f32 478 if( status != true ) {
davidjhoward 197:594afd088f32 479 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 480 return;
davidjhoward 197:594afd088f32 481 }
davidjhoward 197:594afd088f32 482 printf("%s:%d: 0x%x 0x%x 0x%x 0x%x\r\n", __func__,__LINE__, xmt_buf[0], xmt_buf[1], xmt_buf[2], xmt_buf[3]);
davidjhoward 197:594afd088f32 483 break;
davidjhoward 197:594afd088f32 484 }
davidjhoward 197:594afd088f32 485 case TYPE_32BIT_INT:
davidjhoward 197:594afd088f32 486 case TYPE_32BIT_UINT: {
davidjhoward 197:594afd088f32 487 status = WriteModbus_32bit_int( (int32_t)value, order, xmt_buf );
davidjhoward 197:594afd088f32 488 if( status != true ) {
davidjhoward 197:594afd088f32 489 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 490 return;
davidjhoward 197:594afd088f32 491 }
davidjhoward 197:594afd088f32 492 break;
davidjhoward 197:594afd088f32 493 }
davidjhoward 197:594afd088f32 494 case TYPE_16BIT_INT:
davidjhoward 197:594afd088f32 495 case TYPE_16BIT_UINT:
davidjhoward 197:594afd088f32 496 status = WriteModbus_16bit_int( (int16_t)value, order, xmt_buf );
davidjhoward 197:594afd088f32 497 if( status != true ) {
davidjhoward 197:594afd088f32 498 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 499 return;
davidjhoward 197:594afd088f32 500 }
davidjhoward 197:594afd088f32 501 printf("%s:%d: 0x%x 0x%x\r\n", __func__,__LINE__, xmt_buf[0], xmt_buf[1]);
davidjhoward 197:594afd088f32 502 break;
davidjhoward 197:594afd088f32 503 default:
davidjhoward 197:594afd088f32 504 printf("CMD: %s:%d: %s NOT IMPLEMENTED\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 505 return;
davidjhoward 197:594afd088f32 506 }
davidjhoward 197:594afd088f32 507 printf("%s:%d: 0x%x 0x%x 0x%x 0x%x\r\n", __func__,__LINE__, xmt_buf[0], xmt_buf[1], xmt_buf[2], xmt_buf[3]);
davidjhoward 197:594afd088f32 508 ret = mod_write(node, func, sreg, nreg, xmt_buf);
davidjhoward 197:594afd088f32 509 if( ret != MOD_ERROR_NONE ) {
davidjhoward 197:594afd088f32 510 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 511 } else {
davidjhoward 197:594afd088f32 512 printf("CMD: %s:%d: %s wrote to modbus func=%d reg=%d value=%2.2f, errflag=%d\r\n", __func__, __LINE__, id.c_str(), func, sreg, value, ret );
davidjhoward 197:594afd088f32 513 }
davidjhoward 197:594afd088f32 514 break;
davidjhoward 197:594afd088f32 515 }
davidjhoward 197:594afd088f32 516 default:
davidjhoward 197:594afd088f32 517 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 518 break;
davidjhoward 197:594afd088f32 519 }
davidjhoward 197:594afd088f32 520
davidjhoward 186:16912aa18c2a 521 }