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@235:ce028fbf054d, 2016-10-19 (annotated)

Committer:
davidjhoward
Date:
Wed Oct 19 22:28:28 2016 +0000
Revision:
235:ce028fbf054d
Parent:
216:7783e894f7e0
Child:
237:ecf34419ce5d
Updates for demo unit in PCT lab

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 214:52ef35bc44ec 28 //std::map<std::string,VirtualCommand> VirtualCommandMap;
davidjhoward 214:52ef35bc44ec 29
davidjhoward 214:52ef35bc44ec 30 std::map< std::string, std::map<std::string, VirtualCommand> > VirtualCommandMap;
davidjhoward 214:52ef35bc44ec 31
davidjhoward 214:52ef35bc44ec 32 void LoadModbusConfigFile( char *fileName );
davidjhoward 214:52ef35bc44ec 33 void UpdateSimulatedInput( std::map<std::string, ModbusRegister>::iterator &modMap );
davidjhoward 214:52ef35bc44ec 34 void ReadModbusRegister( std::map<std::string, ModbusRegister>::iterator &modMap );
davidjhoward 214:52ef35bc44ec 35 void ExecuteRegisterCommand( std::map<std::string, ModbusRegister>::iterator &modMap );
davidjhoward 216:7783e894f7e0 36 void ExecuteRegisterOperation( std::map<std::string, VirtualCommand>::iterator &cmdMap );
davidjhoward 214:52ef35bc44ec 37 void UpdateOutputRegister( std::map<std::string, ModbusRegister>::iterator &modMap );
davidjhoward 149:950c90425f7c 38
jmarkel44 177:9ec90c8e3ce1 39 char ModbusMasterScratchBuf[MAX_FILE_SIZE];
jmarkel44 0:65cfa4873284 40 void ModbusMaster(void const *args)
jmarkel44 0:65cfa4873284 41 {
davidjhoward 31:4b1587034318 42 logInfo("%s ModbusMaster has started...", __func__);
davidjhoward 203:9d735375f218 43 bool SignaledMain = false;
davidjhoward 203:9d735375f218 44 std::map<std::string, ModbusRegister>::iterator modMap;
davidjhoward 81:d45bfa16953a 45
davidjhoward 190:af7ab603c9fe 46 mod_init();
davidjhoward 190:af7ab603c9fe 47 DigitalOut mod_power(PA_11);
davidjhoward 190:af7ab603c9fe 48 mod_power = 0; // provide power to the modbus
jmarkel44 0:65cfa4873284 49
davidjhoward 214:52ef35bc44ec 50 std::vector<mDot::mdot_file>::iterator file;
davidjhoward 214:52ef35bc44ec 51 std::vector<mDot::mdot_file> file_list;
davidjhoward 214:52ef35bc44ec 52 file_list = GLOBAL_mdot->listUserFiles();
davidjhoward 214:52ef35bc44ec 53 for(file = file_list.begin(); file != file_list.end(); ++file) {
davidjhoward 214:52ef35bc44ec 54 LoadModbusConfigFile( file->name );
davidjhoward 214:52ef35bc44ec 55 }
davidjhoward 8:abe51ae5ef8b 56
davidjhoward 214:52ef35bc44ec 57 while ( true ) {
davidjhoward 149:950c90425f7c 58
davidjhoward 214:52ef35bc44ec 59 for (modMap = ModbusRegisterMap.begin(); modMap != ModbusRegisterMap.end(); ++modMap) {
davidjhoward 214:52ef35bc44ec 60 if( modMap->second.simulated == true ) {
davidjhoward 214:52ef35bc44ec 61 UpdateSimulatedInput( modMap );
davidjhoward 235:ce028fbf054d 62 if( strncmp( modMap->first.c_str(), "i_ph", (strlen("i_ph")-1) ) == 0 ) {
davidjhoward 235:ce028fbf054d 63 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value / 1000;
davidjhoward 235:ce028fbf054d 64 } else if( strncmp( modMap->first.c_str(), "i_cond_temp", (strlen("i_cond_temp")-1) ) == 0 ) {
davidjhoward 235:ce028fbf054d 65 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value / 1000;
davidjhoward 235:ce028fbf054d 66 } else if( strncmp( modMap->first.c_str(), "i_ph_temp", (strlen("i_ph_temp")-1) ) == 0 ) {
davidjhoward 235:ce028fbf054d 67 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value / 1000;
davidjhoward 235:ce028fbf054d 68 }
davidjhoward 214:52ef35bc44ec 69 continue;
davidjhoward 214:52ef35bc44ec 70 } else if( modMap->second.node != 0 ) {
davidjhoward 214:52ef35bc44ec 71 ReadModbusRegister( modMap );
davidjhoward 214:52ef35bc44ec 72 } else if( (modMap->second.node == 0) && (modMap->second.regType == REG_TYPE_INPUT) ) {
davidjhoward 214:52ef35bc44ec 73 // logInfo("processing PIN input=%s, reg=%d, value=%d",modMap->first.c_str(), ModbusRegisterMap[modMap->first].reg, (bool)ModbusRegisterMap[modMap->first].float_value);
davidjhoward 214:52ef35bc44ec 74 if( ModbusRegisterMap[modMap->first].reg == 1 ) {
davidjhoward 214:52ef35bc44ec 75 // digital input
davidjhoward 214:52ef35bc44ec 76 ModbusRegisterMap[modMap->first].float_value = (float)flow_switch.read();
davidjhoward 39:9287c7d59016 77 } else {
davidjhoward 214:52ef35bc44ec 78 ModbusRegisterMap[modMap->first].float_value = (float)dinp2.read();
davidjhoward 149:950c90425f7c 79 }
davidjhoward 15:a6ee32969e8e 80 }
davidjhoward 235:ce028fbf054d 81 if( strncmp( modMap->first.c_str(), "i_ph", (strlen("i_ph")-1) ) == 0 ) {
davidjhoward 235:ce028fbf054d 82 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value / 1000;
davidjhoward 235:ce028fbf054d 83 } else if( strncmp( modMap->first.c_str(), "i_cond_temp", (strlen("i_cond_temp")-1) ) == 0 ) {
davidjhoward 235:ce028fbf054d 84 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value / 1000;
davidjhoward 235:ce028fbf054d 85 } else if( strncmp( modMap->first.c_str(), "i_ph_temp", (strlen("i_ph_temp")-1) ) == 0 ) {
davidjhoward 235:ce028fbf054d 86 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value / 1000;
davidjhoward 235:ce028fbf054d 87 }
davidjhoward 4:c35db3946fd8 88 }
davidjhoward 162:5e8948b8044d 89
davidjhoward 214:52ef35bc44ec 90 // now that all of the modbus registers are updated we can execute the register commands.
davidjhoward 214:52ef35bc44ec 91 for (modMap = ModbusRegisterMap.begin(); modMap != ModbusRegisterMap.end(); ++modMap) {
davidjhoward 214:52ef35bc44ec 92 ExecuteRegisterCommand( modMap );
davidjhoward 214:52ef35bc44ec 93 }
davidjhoward 148:ee3cbaafe355 94
davidjhoward 214:52ef35bc44ec 95 // now that all of the inputs and virtuals have been updated, go through the outputs.
davidjhoward 214:52ef35bc44ec 96 for (modMap = ModbusRegisterMap.begin(); modMap != ModbusRegisterMap.end(); ++modMap) {
davidjhoward 214:52ef35bc44ec 97 if( modMap->second.regType == REG_TYPE_OUTPUT ) {
davidjhoward 214:52ef35bc44ec 98 UpdateOutputRegister( modMap );
davidjhoward 214:52ef35bc44ec 99 }
davidjhoward 214:52ef35bc44ec 100 }
davidjhoward 82:f3e495a98877 101
davidjhoward 214:52ef35bc44ec 102 osEvent evt = ModbusMasterMailBox.get(50);
davidjhoward 214:52ef35bc44ec 103 if (evt.status == osEventMail) {
davidjhoward 214:52ef35bc44ec 104 Message_t *mail = (Message_t*)evt.value.p;
davidjhoward 214:52ef35bc44ec 105 printf("Mail Received: Action: %d, New Input File: %s\r\n", mail->action, mail->controlFile);
davidjhoward 214:52ef35bc44ec 106 if( mail->action == ACTION_EXEC_CMD ) {
davidjhoward 214:52ef35bc44ec 107 ModbusMasterExecCmd( mail->controlFile );
davidjhoward 214:52ef35bc44ec 108 } else {
davidjhoward 214:52ef35bc44ec 109 LoadModbusConfigFile( mail->controlFile );
davidjhoward 39:9287c7d59016 110 }
davidjhoward 214:52ef35bc44ec 111 ModbusMasterMailBox.free(mail);
davidjhoward 31:4b1587034318 112 }
davidjhoward 214:52ef35bc44ec 113 if( SignaledMain == false ) {
davidjhoward 214:52ef35bc44ec 114 SignaledMain = true;
davidjhoward 214:52ef35bc44ec 115 osSignalSet(mainThreadId, sig_output_continue);
davidjhoward 214:52ef35bc44ec 116 }
davidjhoward 214:52ef35bc44ec 117 Thread::wait(5000);
jmarkel44 0:65cfa4873284 118 }
davidjhoward 4:c35db3946fd8 119 }
davidjhoward 4:c35db3946fd8 120
davidjhoward 190:af7ab603c9fe 121 bool ReadModbus_32bit_float( float *float_value, int order, unsigned char *rd_buf )
davidjhoward 4:c35db3946fd8 122 {
davidjhoward 15:a6ee32969e8e 123 MR_REGISTER_32_BIT_FLOAT value;
davidjhoward 31:4b1587034318 124
davidjhoward 15:a6ee32969e8e 125 switch( order ) {
davidjhoward 31:4b1587034318 126 case BigEndian:
davidjhoward 190:af7ab603c9fe 127 value.b.lo_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 128 value.b.lo_hi = rd_buf[2];
davidjhoward 190:af7ab603c9fe 129 value.b.hi_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 130 value.b.hi_hi = rd_buf[0];
davidjhoward 15:a6ee32969e8e 131 break;
davidjhoward 15:a6ee32969e8e 132 case BigEndianReverseWord:
davidjhoward 190:af7ab603c9fe 133 value.b.lo_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 134 value.b.lo_hi = rd_buf[0];
davidjhoward 190:af7ab603c9fe 135 value.b.hi_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 136 value.b.hi_hi = rd_buf[2];
davidjhoward 15:a6ee32969e8e 137 break;
davidjhoward 15:a6ee32969e8e 138 default:
davidjhoward 197:594afd088f32 139 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 15:a6ee32969e8e 140 return false;
davidjhoward 15:a6ee32969e8e 141 }
davidjhoward 214:52ef35bc44ec 142 // printf("0x%x 0x%x 0x%x 0x%x (%2.4f)\r\n", value.b.hi_hi, value.b.hi_lo, value.b.lo_hi, value.b.lo_lo, value.f);
davidjhoward 15:a6ee32969e8e 143 *float_value = value.f;
davidjhoward 4:c35db3946fd8 144 return true;
davidjhoward 4:c35db3946fd8 145 }
davidjhoward 186:16912aa18c2a 146
davidjhoward 197:594afd088f32 147 bool WriteModbus_32bit_float( float float_value, int order, unsigned char *xmt_buf )
davidjhoward 197:594afd088f32 148 {
davidjhoward 197:594afd088f32 149 MR_REGISTER_32_BIT_FLOAT value;
davidjhoward 197:594afd088f32 150
davidjhoward 197:594afd088f32 151 value.f = float_value;
davidjhoward 197:594afd088f32 152
davidjhoward 197:594afd088f32 153 switch( order ) {
davidjhoward 197:594afd088f32 154 case BigEndian:
davidjhoward 197:594afd088f32 155 xmt_buf[3] = value.b.lo_lo;
davidjhoward 197:594afd088f32 156 xmt_buf[2] = value.b.lo_hi;
davidjhoward 197:594afd088f32 157 xmt_buf[1] = value.b.hi_lo;
davidjhoward 197:594afd088f32 158 xmt_buf[0] = value.b.hi_hi;
davidjhoward 197:594afd088f32 159 break;
davidjhoward 197:594afd088f32 160 case BigEndianReverseWord:
davidjhoward 197:594afd088f32 161 xmt_buf[1] = value.b.lo_lo;
davidjhoward 197:594afd088f32 162 xmt_buf[0] = value.b.lo_hi;
davidjhoward 197:594afd088f32 163 xmt_buf[3] = value.b.hi_lo;
davidjhoward 197:594afd088f32 164 xmt_buf[2] = value.b.hi_hi;
davidjhoward 197:594afd088f32 165 break;
davidjhoward 197:594afd088f32 166 default:
davidjhoward 197:594afd088f32 167 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 197:594afd088f32 168 return false;
davidjhoward 197:594afd088f32 169 }
davidjhoward 214:52ef35bc44ec 170 printf("%s:%d: 0x%x 0x%x 0x%x 0x%x (%2.4f)\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 171 return true;
davidjhoward 197:594afd088f32 172 }
davidjhoward 197:594afd088f32 173
davidjhoward 190:af7ab603c9fe 174 bool ReadModbus_32bit_int( int32_t *int32_value, int order, unsigned char *rd_buf )
davidjhoward 186:16912aa18c2a 175 {
davidjhoward 186:16912aa18c2a 176 MR_REGISTER_32BIT_INT value;
davidjhoward 186:16912aa18c2a 177
davidjhoward 186:16912aa18c2a 178 switch( order ) {
davidjhoward 186:16912aa18c2a 179 case BigEndian:
davidjhoward 190:af7ab603c9fe 180 value.b.lo_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 181 value.b.lo_hi = rd_buf[2];
davidjhoward 190:af7ab603c9fe 182 value.b.hi_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 183 value.b.hi_hi = rd_buf[0];
davidjhoward 186:16912aa18c2a 184 break;
davidjhoward 186:16912aa18c2a 185 case BigEndianReverseWord:
davidjhoward 190:af7ab603c9fe 186 value.b.lo_lo = rd_buf[1];
davidjhoward 190:af7ab603c9fe 187 value.b.lo_hi = rd_buf[0];
davidjhoward 190:af7ab603c9fe 188 value.b.hi_lo = rd_buf[3];
davidjhoward 190:af7ab603c9fe 189 value.b.hi_hi = rd_buf[2];
davidjhoward 186:16912aa18c2a 190 break;
davidjhoward 186:16912aa18c2a 191 default:
davidjhoward 197:594afd088f32 192 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 186:16912aa18c2a 193 return false;
davidjhoward 186:16912aa18c2a 194 }
davidjhoward 188:d35a74bf4e92 195 // 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 196 *int32_value = value.i;
davidjhoward 186:16912aa18c2a 197 return true;
davidjhoward 197:594afd088f32 198 }
davidjhoward 197:594afd088f32 199
davidjhoward 197:594afd088f32 200 bool WriteModbus_32bit_int( int32_t int32_value, int order, unsigned char *xmt_buf )
davidjhoward 197:594afd088f32 201 {
davidjhoward 197:594afd088f32 202 MR_REGISTER_32BIT_INT value;
davidjhoward 197:594afd088f32 203
davidjhoward 197:594afd088f32 204 value.i = int32_value;
davidjhoward 197:594afd088f32 205
davidjhoward 197:594afd088f32 206 switch( order ) {
davidjhoward 197:594afd088f32 207 case BigEndian:
davidjhoward 197:594afd088f32 208 xmt_buf[3] = value.b.lo_lo;
davidjhoward 197:594afd088f32 209 xmt_buf[2] = value.b.lo_hi;
davidjhoward 197:594afd088f32 210 xmt_buf[1] = value.b.hi_lo;
davidjhoward 197:594afd088f32 211 xmt_buf[0] = value.b.hi_hi;
davidjhoward 197:594afd088f32 212 break;
davidjhoward 197:594afd088f32 213 case BigEndianReverseWord:
davidjhoward 197:594afd088f32 214 xmt_buf[1] = value.b.lo_lo;
davidjhoward 197:594afd088f32 215 xmt_buf[0] = value.b.lo_hi;
davidjhoward 197:594afd088f32 216 xmt_buf[3] = value.b.hi_lo;
davidjhoward 197:594afd088f32 217 xmt_buf[2] = value.b.hi_hi;
davidjhoward 197:594afd088f32 218 break;
davidjhoward 197:594afd088f32 219 default:
davidjhoward 197:594afd088f32 220 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 197:594afd088f32 221 return false;
davidjhoward 197:594afd088f32 222 }
davidjhoward 197:594afd088f32 223 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 224 return true;
davidjhoward 197:594afd088f32 225 }
davidjhoward 197:594afd088f32 226
davidjhoward 197:594afd088f32 227 bool WriteModbus_16bit_int( int16_t int16_value, int order, unsigned char *xmt_buf )
davidjhoward 197:594afd088f32 228 {
davidjhoward 197:594afd088f32 229 MR_REGISTER_16BIT_INT value;
davidjhoward 197:594afd088f32 230
davidjhoward 197:594afd088f32 231 value.w = int16_value;
davidjhoward 197:594afd088f32 232
davidjhoward 197:594afd088f32 233 switch( order ) {
davidjhoward 197:594afd088f32 234 case BigEndian:
davidjhoward 197:594afd088f32 235 case BigEndianReverseWord:
davidjhoward 197:594afd088f32 236 xmt_buf[1] = value.b.lo;
davidjhoward 197:594afd088f32 237 xmt_buf[0] = value.b.hi;
davidjhoward 197:594afd088f32 238 break;
davidjhoward 197:594afd088f32 239 default:
davidjhoward 197:594afd088f32 240 printf("%s:%d: order not supported\r\n",__func__,__LINE__);
davidjhoward 197:594afd088f32 241 return false;
davidjhoward 197:594afd088f32 242 }
davidjhoward 197:594afd088f32 243 printf("%s:%d: 0x%x 0x%x (%d)\r\n", __func__,__LINE__, value.b.hi, value.b.lo, value.w);
davidjhoward 197:594afd088f32 244 return true;
davidjhoward 197:594afd088f32 245 }
davidjhoward 197:594afd088f32 246
davidjhoward 197:594afd088f32 247 void ModbusMasterExecCmd( char *cmd )
davidjhoward 197:594afd088f32 248 {
davidjhoward 197:594afd088f32 249 MbedJSONValue json_cmd;
davidjhoward 197:594afd088f32 250 bool status;
davidjhoward 197:594afd088f32 251 int ret;
davidjhoward 197:594afd088f32 252 unsigned char rd_buf[16];
davidjhoward 197:594afd088f32 253
davidjhoward 197:594afd088f32 254 // printf("%s:%d: command=%s\r\n", __func__, __LINE__, cmd );
davidjhoward 197:594afd088f32 255
davidjhoward 197:594afd088f32 256 parse( json_cmd, cmd );
davidjhoward 197:594afd088f32 257
davidjhoward 197:594afd088f32 258 std::string id = json_cmd["id"].get<std::string>().c_str();
davidjhoward 197:594afd088f32 259 int node = atoi(json_cmd["node"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 260 int func = atoi(json_cmd["func"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 261 int sreg = atoi(json_cmd["sreg"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 262 int nreg = atoi(json_cmd["nreg"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 263 int dtype = atoi(json_cmd["dtype"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 264 int order = atoi(json_cmd["order"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 265 float value = atof(json_cmd["value"].get<std::string>().c_str());
davidjhoward 197:594afd088f32 266
davidjhoward 197:594afd088f32 267 switch( func ) {
davidjhoward 197:594afd088f32 268 case MOD_FUNC_GET_HREG: // read holding register
davidjhoward 197:594afd088f32 269 case MOD_FUNC_GET_IREG: // read input register
davidjhoward 197:594afd088f32 270 ret = mod_read(node, func, sreg, nreg, rd_buf);
davidjhoward 197:594afd088f32 271 switch( dtype ) {
davidjhoward 197:594afd088f32 272 case TYPE_32BIT_FLOAT: {
davidjhoward 197:594afd088f32 273 float float_value;
davidjhoward 197:594afd088f32 274 if( ret != MOD_ERROR_NONE ) {
davidjhoward 197:594afd088f32 275 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 276 break;
davidjhoward 197:594afd088f32 277 }
davidjhoward 197:594afd088f32 278 status = ReadModbus_32bit_float( &float_value, order, rd_buf );
davidjhoward 197:594afd088f32 279 if( status == true ) {
davidjhoward 214:52ef35bc44ec 280 printf("CMD: %s:%d: %s value=%2.4f\r\n", __func__, __LINE__, id.c_str(), float_value );
davidjhoward 197:594afd088f32 281 } else {
davidjhoward 197:594afd088f32 282 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 283 }
davidjhoward 197:594afd088f32 284 break;
davidjhoward 197:594afd088f32 285 }
davidjhoward 197:594afd088f32 286 case TYPE_32BIT_INT:
davidjhoward 197:594afd088f32 287 case TYPE_32BIT_UINT: {
davidjhoward 197:594afd088f32 288 int32_t int32_value;
davidjhoward 197:594afd088f32 289 if( ret != MOD_ERROR_NONE ) {
davidjhoward 197:594afd088f32 290 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 291 break;
davidjhoward 197:594afd088f32 292 }
davidjhoward 197:594afd088f32 293 status = ReadModbus_32bit_int( &int32_value, order, rd_buf );
davidjhoward 197:594afd088f32 294 if( status == true ) {
davidjhoward 197:594afd088f32 295 printf("CMD: %s:%d: %s value=%d\r\n", __func__, __LINE__, id.c_str(), int32_value );
davidjhoward 197:594afd088f32 296 } else {
davidjhoward 197:594afd088f32 297 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 298 }
davidjhoward 197:594afd088f32 299 break;
davidjhoward 197:594afd088f32 300 }
davidjhoward 197:594afd088f32 301 case TYPE_16BIT_INT:
davidjhoward 197:594afd088f32 302 case TYPE_16BIT_UINT:
davidjhoward 197:594afd088f32 303 break;
davidjhoward 197:594afd088f32 304 default:
davidjhoward 197:594afd088f32 305 break;
davidjhoward 197:594afd088f32 306 }
davidjhoward 197:594afd088f32 307 break;
davidjhoward 197:594afd088f32 308 case MOD_FUNC_SET_HREG: // write holding register
davidjhoward 197:594afd088f32 309 case MOD_FUNC_SET_HREGS: // write multiple registers (only supports 2 right now)
davidjhoward 197:594afd088f32 310 case MOD_FUNC_SET_COIL: { // write coil
davidjhoward 197:594afd088f32 311 unsigned char xmt_buf[10];
davidjhoward 197:594afd088f32 312 switch( dtype ) {
davidjhoward 197:594afd088f32 313 case TYPE_32BIT_FLOAT: {
davidjhoward 197:594afd088f32 314 status = WriteModbus_32bit_float( value, order, xmt_buf );
davidjhoward 197:594afd088f32 315 if( status != true ) {
davidjhoward 197:594afd088f32 316 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 317 return;
davidjhoward 197:594afd088f32 318 }
davidjhoward 197:594afd088f32 319 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 320 break;
davidjhoward 197:594afd088f32 321 }
davidjhoward 197:594afd088f32 322 case TYPE_32BIT_INT:
davidjhoward 197:594afd088f32 323 case TYPE_32BIT_UINT: {
davidjhoward 197:594afd088f32 324 status = WriteModbus_32bit_int( (int32_t)value, order, xmt_buf );
davidjhoward 197:594afd088f32 325 if( status != true ) {
davidjhoward 197:594afd088f32 326 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 327 return;
davidjhoward 197:594afd088f32 328 }
davidjhoward 197:594afd088f32 329 break;
davidjhoward 197:594afd088f32 330 }
davidjhoward 197:594afd088f32 331 case TYPE_16BIT_INT:
davidjhoward 197:594afd088f32 332 case TYPE_16BIT_UINT:
davidjhoward 197:594afd088f32 333 status = WriteModbus_16bit_int( (int16_t)value, order, xmt_buf );
davidjhoward 197:594afd088f32 334 if( status != true ) {
davidjhoward 197:594afd088f32 335 printf("CMD: %s:%d: %s failed\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 336 return;
davidjhoward 197:594afd088f32 337 }
davidjhoward 197:594afd088f32 338 printf("%s:%d: 0x%x 0x%x\r\n", __func__,__LINE__, xmt_buf[0], xmt_buf[1]);
davidjhoward 197:594afd088f32 339 break;
davidjhoward 197:594afd088f32 340 default:
davidjhoward 197:594afd088f32 341 printf("CMD: %s:%d: %s NOT IMPLEMENTED\r\n", __func__, __LINE__, id.c_str() );
davidjhoward 197:594afd088f32 342 return;
davidjhoward 197:594afd088f32 343 }
davidjhoward 197:594afd088f32 344 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 345 ret = mod_write(node, func, sreg, nreg, xmt_buf);
davidjhoward 197:594afd088f32 346 if( ret != MOD_ERROR_NONE ) {
davidjhoward 197:594afd088f32 347 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 348 } else {
davidjhoward 214:52ef35bc44ec 349 printf("CMD: %s:%d: %s wrote to modbus func=%d reg=%d value=%2.4f, errflag=%d\r\n", __func__, __LINE__, id.c_str(), func, sreg, value, ret );
davidjhoward 197:594afd088f32 350 }
davidjhoward 197:594afd088f32 351 break;
davidjhoward 197:594afd088f32 352 }
davidjhoward 197:594afd088f32 353 default:
davidjhoward 197:594afd088f32 354 printf("CMD: %s:%d: %s failed, errflag=%d\r\n", __func__, __LINE__, id.c_str(), ret );
davidjhoward 197:594afd088f32 355 break;
davidjhoward 197:594afd088f32 356 }
davidjhoward 214:52ef35bc44ec 357 }
davidjhoward 197:594afd088f32 358
davidjhoward 214:52ef35bc44ec 359 void LoadModbusConfigFile( char *fileName )
davidjhoward 214:52ef35bc44ec 360 {
davidjhoward 214:52ef35bc44ec 361 bool status;
davidjhoward 214:52ef35bc44ec 362 RegisterType_t regType;
davidjhoward 214:52ef35bc44ec 363
davidjhoward 214:52ef35bc44ec 364 if( (strncmp( fileName, "vcmd", (strlen("vcmd")-1)) == 0) ) {
davidjhoward 214:52ef35bc44ec 365 status = GLOBAL_mdot->readUserFile(fileName, ModbusMasterScratchBuf, MAX_FILE_SIZE);
davidjhoward 214:52ef35bc44ec 366 if( status != true ) {
davidjhoward 214:52ef35bc44ec 367 printf("(%d)read file failed, status=%d\r\n", __LINE__, status);
davidjhoward 214:52ef35bc44ec 368 return;
davidjhoward 214:52ef35bc44ec 369 } else {
davidjhoward 214:52ef35bc44ec 370 printf("(%s:%d)loading File: %s\r\n", __func__, __LINE__, fileName );
davidjhoward 214:52ef35bc44ec 371 }
davidjhoward 214:52ef35bc44ec 372 MbedJSONValue json_value;
davidjhoward 214:52ef35bc44ec 373 parse( json_value, ModbusMasterScratchBuf );
davidjhoward 214:52ef35bc44ec 374
davidjhoward 214:52ef35bc44ec 375 std::string tag = json_value["tag"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 376 std::string id = json_value["id"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 377 VirtualCommandMap[tag][id].c = atof(json_value["c"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 378 VirtualCommandMap[tag][id].tag = json_value["tag"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 379 VirtualCommandMap[tag][id].opl = json_value["opl"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 380 VirtualCommandMap[tag][id].opr = json_value["opr"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 381 VirtualCommandMap[tag][id].op = json_value["op"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 382 printf("Processd virtual command file: id=%s, tag=%s\r\n", id.c_str(), tag.c_str());
davidjhoward 214:52ef35bc44ec 383 return;
davidjhoward 214:52ef35bc44ec 384 }
davidjhoward 214:52ef35bc44ec 385
davidjhoward 214:52ef35bc44ec 386 regType = REG_TYPE_NONE;
davidjhoward 214:52ef35bc44ec 387
davidjhoward 214:52ef35bc44ec 388 if( (strncmp( fileName, "input", (strlen("input")-1)) == 0) ) {
davidjhoward 214:52ef35bc44ec 389 regType = REG_TYPE_INPUT;
davidjhoward 214:52ef35bc44ec 390 } else if( (strncmp( fileName, "output", (strlen("output")-1)) == 0) ) {
davidjhoward 214:52ef35bc44ec 391 regType = REG_TYPE_OUTPUT;
davidjhoward 214:52ef35bc44ec 392 } else if( (strncmp( fileName, "vinput", (strlen("vinput")-1)) == 0) ) {
davidjhoward 214:52ef35bc44ec 393 regType = REG_TYPE_VINPUT;
davidjhoward 214:52ef35bc44ec 394 } else if( (strncmp( fileName, "voutput", (strlen("voutput")-1)) == 0) ) {
davidjhoward 214:52ef35bc44ec 395 regType = REG_TYPE_VOUTPUT;
davidjhoward 214:52ef35bc44ec 396 }
davidjhoward 214:52ef35bc44ec 397
davidjhoward 214:52ef35bc44ec 398 if( regType != REG_TYPE_NONE ) {
davidjhoward 214:52ef35bc44ec 399 MbedJSONValue json_value;
davidjhoward 214:52ef35bc44ec 400 status = GLOBAL_mdot->readUserFile(fileName, ModbusMasterScratchBuf, MAX_FILE_SIZE);
davidjhoward 214:52ef35bc44ec 401 if( status != true ) {
davidjhoward 214:52ef35bc44ec 402 logInfo("(%d)read file failed, status=%d", __LINE__, status);
davidjhoward 214:52ef35bc44ec 403 return;
davidjhoward 214:52ef35bc44ec 404 } else {
davidjhoward 214:52ef35bc44ec 405 logInfo("(%s:%d)loading File: %s", __func__, __LINE__, fileName );
davidjhoward 214:52ef35bc44ec 406 }
davidjhoward 214:52ef35bc44ec 407
davidjhoward 214:52ef35bc44ec 408 parse( json_value, ModbusMasterScratchBuf );
davidjhoward 214:52ef35bc44ec 409
davidjhoward 214:52ef35bc44ec 410 std::string id = json_value["id"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 411 ModbusRegisterMap[id].name = json_value["name"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 412 ModbusRegisterMap[id].units = json_value["units"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 413 ModbusRegisterMap[id].min = atof(json_value["min"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 414 ModbusRegisterMap[id].max = atof(json_value["max"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 415 ModbusRegisterMap[id].node = atoi(json_value["node"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 416 ModbusRegisterMap[id].reg = atoi(json_value["reg"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 417 ModbusRegisterMap[id].rtype = atoi(json_value["rtype"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 418 ModbusRegisterMap[id].type = atoi(json_value["type"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 419 ModbusRegisterMap[id].size = atoi(json_value["size"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 420 ModbusRegisterMap[id].order = atoi(json_value["order"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 421 ModbusRegisterMap[id].fmt = json_value["fmt"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 422 ModbusRegisterMap[id].rfreq = atoi(json_value["rfreq"].get<std::string>().c_str());
davidjhoward 214:52ef35bc44ec 423 ModbusRegisterMap[id].regType = regType;
davidjhoward 214:52ef35bc44ec 424 ModbusRegisterMap[id].simulated = false;
davidjhoward 214:52ef35bc44ec 425 ModbusRegisterMap[id].errflag = 0;
davidjhoward 214:52ef35bc44ec 426 if( (regType == REG_TYPE_VINPUT) || (regType == REG_TYPE_VOUTPUT) ) {
davidjhoward 214:52ef35bc44ec 427 ModbusRegisterMap[id].vcmd = json_value["vcmd"].get<std::string>().c_str();
davidjhoward 214:52ef35bc44ec 428 }
davidjhoward 214:52ef35bc44ec 429 }
davidjhoward 214:52ef35bc44ec 430 return;
davidjhoward 214:52ef35bc44ec 431 }
davidjhoward 214:52ef35bc44ec 432
davidjhoward 214:52ef35bc44ec 433 void UpdateSimulatedInput( std::map<std::string, ModbusRegister>::iterator &modMap )
davidjhoward 214:52ef35bc44ec 434 {
davidjhoward 214:52ef35bc44ec 435 ModbusRegisterMap[modMap->first].errflag = 0;
davidjhoward 214:52ef35bc44ec 436 // printf("\r\nsimulating input=%s, min=%2.4f, max=%2.4f, start_value=%2.4f, up_step=%2.4f, down_step=%2.4f moving_up=%d\r\n",modMap->first.c_str(), SimulateInputMap[modMap->first].min, SimulateInputMap[modMap->first].max, SimulateInputMap[modMap->first].start_value, SimulateInputMap[modMap->first].up_step, SimulateInputMap[modMap->first].down_step, SimulateInputMap[modMap->first].moving_up);
davidjhoward 214:52ef35bc44ec 437 if( (SimulateInputMap[modMap->first].min == 0) && (SimulateInputMap[modMap->first].max == 0) ) {
davidjhoward 214:52ef35bc44ec 438 ModbusRegisterMap[modMap->first].float_value = SimulateInputMap[modMap->first].start_value;
davidjhoward 214:52ef35bc44ec 439 // printf("simulating input=%s, value=%2.4f\r\n",modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value);
davidjhoward 214:52ef35bc44ec 440 } else {
davidjhoward 214:52ef35bc44ec 441 if( ModbusRegisterMap[modMap->first].float_value >= SimulateInputMap[modMap->first].max ) {
davidjhoward 214:52ef35bc44ec 442 SimulateInputMap[modMap->first].moving_up = false;
davidjhoward 214:52ef35bc44ec 443 // printf("simulating down input=%s, value=%2.4f - %2.4f\r\n",modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value, SimulateInputMap[modMap->first].down_step);
davidjhoward 214:52ef35bc44ec 444 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value - SimulateInputMap[modMap->first].down_step;
davidjhoward 214:52ef35bc44ec 445 } else if( ModbusRegisterMap[modMap->first].float_value <= SimulateInputMap[modMap->first].min ) {
davidjhoward 214:52ef35bc44ec 446 SimulateInputMap[modMap->first].moving_up = true;
davidjhoward 214:52ef35bc44ec 447 // printf("simulating up input=%s, value=%2.4f + %2.4f\r\n",modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value, SimulateInputMap[modMap->first].up_step);
davidjhoward 214:52ef35bc44ec 448 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value + SimulateInputMap[modMap->first].up_step;
davidjhoward 214:52ef35bc44ec 449 } else {
davidjhoward 214:52ef35bc44ec 450 if( SimulateInputMap[modMap->first].moving_up == true ) {
davidjhoward 214:52ef35bc44ec 451 // printf("continue simulate up input=%s, value=%2.4f + %2.4f\r\n",modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value, SimulateInputMap[modMap->first].up_step);
davidjhoward 214:52ef35bc44ec 452 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value + SimulateInputMap[modMap->first].up_step;
davidjhoward 214:52ef35bc44ec 453 } else {
davidjhoward 214:52ef35bc44ec 454 // printf("continue simulate down input=%s, value=%2.4f - %2.4f\r\n",modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value, SimulateInputMap[modMap->first].down_step);
davidjhoward 214:52ef35bc44ec 455 ModbusRegisterMap[modMap->first].float_value = ModbusRegisterMap[modMap->first].float_value - SimulateInputMap[modMap->first].down_step;
davidjhoward 214:52ef35bc44ec 456 }
davidjhoward 214:52ef35bc44ec 457 }
davidjhoward 214:52ef35bc44ec 458 // printf("simulating input=%s, value=%2.4f\r\n\r\n",modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value);
davidjhoward 214:52ef35bc44ec 459 }
davidjhoward 214:52ef35bc44ec 460 }
davidjhoward 214:52ef35bc44ec 461
davidjhoward 214:52ef35bc44ec 462 void ReadModbusRegister( std::map<std::string, ModbusRegister>::iterator &modMap )
davidjhoward 214:52ef35bc44ec 463 {
davidjhoward 214:52ef35bc44ec 464 bool status;
davidjhoward 214:52ef35bc44ec 465 unsigned char rd_buf[16];
davidjhoward 214:52ef35bc44ec 466 memset( rd_buf, 0, 16 );
davidjhoward 214:52ef35bc44ec 467 logInfo("Processing Input: tag=%s, node=%d, reg=%d, size=%d, order=%d", modMap->first.c_str(), modMap->second.node, modMap->second.reg, modMap->second.size, modMap->second.order );
davidjhoward 214:52ef35bc44ec 468 int ret = mod_read(modMap->second.node, modMap->second.rtype, modMap->second.reg, modMap->second.size, rd_buf);
davidjhoward 214:52ef35bc44ec 469 switch( modMap->second.type ) {
davidjhoward 214:52ef35bc44ec 470 case TYPE_32BIT_FLOAT:
davidjhoward 214:52ef35bc44ec 471 float float_value;
davidjhoward 214:52ef35bc44ec 472 if( ret != MOD_ERROR_NONE ) {
davidjhoward 214:52ef35bc44ec 473 ModbusRegisterMap[modMap->first].errflag = ret;
davidjhoward 214:52ef35bc44ec 474 break;
davidjhoward 214:52ef35bc44ec 475 }
davidjhoward 214:52ef35bc44ec 476 status = ReadModbus_32bit_float( &float_value, modMap->second.order, rd_buf );
davidjhoward 214:52ef35bc44ec 477 if( status == true ) {
davidjhoward 214:52ef35bc44ec 478 ModbusRegisterMap[modMap->first].float_value = float_value;
davidjhoward 214:52ef35bc44ec 479 ModbusRegisterMap[modMap->first].errflag = 0;
davidjhoward 214:52ef35bc44ec 480 // logInfo("Modbus Tag:%s value=%2.4f", modMap->first.c_str(), float_value );
davidjhoward 214:52ef35bc44ec 481 } else {
davidjhoward 214:52ef35bc44ec 482 ModbusRegisterMap[modMap->first].errflag = 1000;
davidjhoward 214:52ef35bc44ec 483 // logInfo("Modbus Read Failed, tag=%s", modMap->first.c_str() );
davidjhoward 214:52ef35bc44ec 484 }
davidjhoward 214:52ef35bc44ec 485 break;
davidjhoward 214:52ef35bc44ec 486 case TYPE_32BIT_INT:
davidjhoward 214:52ef35bc44ec 487 int32_t int32_value;
davidjhoward 214:52ef35bc44ec 488 if( ret != MOD_ERROR_NONE ) {
davidjhoward 214:52ef35bc44ec 489 ModbusRegisterMap[modMap->first].errflag = ret;
davidjhoward 214:52ef35bc44ec 490 break;
davidjhoward 214:52ef35bc44ec 491 }
davidjhoward 214:52ef35bc44ec 492 status = ReadModbus_32bit_int( &int32_value, modMap->second.order, rd_buf );
davidjhoward 214:52ef35bc44ec 493 if( status == true ) {
davidjhoward 214:52ef35bc44ec 494 ModbusRegisterMap[modMap->first].float_value = int32_value;
davidjhoward 214:52ef35bc44ec 495 ModbusRegisterMap[modMap->first].errflag = 0;
davidjhoward 214:52ef35bc44ec 496 logInfo("Modbus Tag:%s value=%2.4f", modMap->first.c_str(), ModbusRegisterMap[modMap->first].float_value );
davidjhoward 214:52ef35bc44ec 497 } else {
davidjhoward 214:52ef35bc44ec 498 ModbusRegisterMap[modMap->first].errflag = 1000;
davidjhoward 214:52ef35bc44ec 499 logInfo("Modbus Read Failed, tag=%s", modMap->first.c_str() );
davidjhoward 214:52ef35bc44ec 500 }
davidjhoward 214:52ef35bc44ec 501 break;
davidjhoward 214:52ef35bc44ec 502 case TYPE_32BIT_UINT:
davidjhoward 214:52ef35bc44ec 503 break;
davidjhoward 214:52ef35bc44ec 504 case TYPE_16BIT_INT:
davidjhoward 214:52ef35bc44ec 505 break;
davidjhoward 214:52ef35bc44ec 506 case TYPE_16BIT_UINT:
davidjhoward 214:52ef35bc44ec 507 break;
davidjhoward 214:52ef35bc44ec 508 default:
davidjhoward 214:52ef35bc44ec 509 break;
davidjhoward 214:52ef35bc44ec 510 }
davidjhoward 214:52ef35bc44ec 511 }
davidjhoward 214:52ef35bc44ec 512
davidjhoward 214:52ef35bc44ec 513 void ExecuteRegisterCommand( std::map<std::string, ModbusRegister>::iterator &modMap )
davidjhoward 214:52ef35bc44ec 514 {
davidjhoward 214:52ef35bc44ec 515 std::map<std::string, VirtualCommand>::iterator cmdMap;
davidjhoward 214:52ef35bc44ec 516 for (cmdMap = VirtualCommandMap[modMap->first].begin(); cmdMap != VirtualCommandMap[modMap->first].end(); ++cmdMap) {
davidjhoward 214:52ef35bc44ec 517
davidjhoward 214:52ef35bc44ec 518 // printf("Executing Register Command: key:%s, id:%s, tag:%s, opl:%s, opr:%s, op:%s, constant:%.4f\r\n", modMap->first.c_str(), cmdMap->first.c_str(),
davidjhoward 214:52ef35bc44ec 519 // cmdMap->second.tag.c_str(), cmdMap->second.opl.c_str(), cmdMap->second.opr.c_str(), cmdMap->second.op.c_str(), cmdMap->second.c );
davidjhoward 216:7783e894f7e0 520 ExecuteRegisterOperation( cmdMap );
davidjhoward 216:7783e894f7e0 521 }
davidjhoward 216:7783e894f7e0 522 }
davidjhoward 214:52ef35bc44ec 523
davidjhoward 216:7783e894f7e0 524 void ExecuteRegisterOperation( std::map<std::string, VirtualCommand>::iterator &cmdMap )
davidjhoward 216:7783e894f7e0 525 {
davidjhoward 216:7783e894f7e0 526 switch( cmdMap->second.op.c_str()[0] ) {
davidjhoward 216:7783e894f7e0 527 case '=':
davidjhoward 216:7783e894f7e0 528 if( cmdMap->second.opr.size() == 0 ) {
davidjhoward 216:7783e894f7e0 529 ModbusRegisterMap[cmdMap->second.tag].float_value = cmdMap->second.c;
davidjhoward 216:7783e894f7e0 530 } else {
davidjhoward 216:7783e894f7e0 531 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value;
davidjhoward 216:7783e894f7e0 532 }
davidjhoward 214:52ef35bc44ec 533 // printf("Setting tag=%s, equal to (value=%2.4f)\r\n", cmdMap->second.tag.c_str(), ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 534 break;
davidjhoward 216:7783e894f7e0 535 case '*': {
davidjhoward 216:7783e894f7e0 536 float opl = ModbusRegisterMap[cmdMap->second.opl].float_value;
davidjhoward 216:7783e894f7e0 537 float opr = ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 216:7783e894f7e0 538 if( cmdMap->second.opr.size() == 0 ) {
davidjhoward 216:7783e894f7e0 539 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value * cmdMap->second.c;
davidjhoward 214:52ef35bc44ec 540 // printf("Setting tag=%s, equal to (%2.4f*%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, cmdMap->second.c, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 541 } else {
davidjhoward 216:7783e894f7e0 542 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value * ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 214:52ef35bc44ec 543 // printf("Setting tag=%s, equal to (%2.4f*%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, opr, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 214:52ef35bc44ec 544 }
davidjhoward 216:7783e894f7e0 545 break;
davidjhoward 216:7783e894f7e0 546 }
davidjhoward 216:7783e894f7e0 547 case '/': {
davidjhoward 216:7783e894f7e0 548 float opl = ModbusRegisterMap[cmdMap->second.opl].float_value;
davidjhoward 216:7783e894f7e0 549 float opr = ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 216:7783e894f7e0 550 if( cmdMap->second.opr.size() == 0 ) {
davidjhoward 216:7783e894f7e0 551 // constant operation
davidjhoward 216:7783e894f7e0 552 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value / cmdMap->second.c;
davidjhoward 214:52ef35bc44ec 553 // printf("Setting tag=%s, equal to (%2.4f/%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, cmdMap->second.c, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 554 } else if( ModbusRegisterMap[cmdMap->second.opr].float_value != 0 ) {
davidjhoward 216:7783e894f7e0 555 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value / ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 214:52ef35bc44ec 556 // printf("Setting tag=%s, equal to (%2.4f/%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, opr, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 557 } else {
davidjhoward 216:7783e894f7e0 558 printf("NOT DOING DIVIDE BY ZERO\r\n");
davidjhoward 216:7783e894f7e0 559 }
davidjhoward 216:7783e894f7e0 560 break;
davidjhoward 216:7783e894f7e0 561 }
davidjhoward 216:7783e894f7e0 562 case '+': {
davidjhoward 216:7783e894f7e0 563 float opl = ModbusRegisterMap[cmdMap->second.opl].float_value;
davidjhoward 216:7783e894f7e0 564 float opr = ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 216:7783e894f7e0 565 if( cmdMap->second.opr.size() == 0 ) {
davidjhoward 216:7783e894f7e0 566 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value + cmdMap->second.c;
davidjhoward 216:7783e894f7e0 567 // printf("Setting tag=%s, equal to (%2.4f+%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, cmdMap->second.c, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 568 } else {
davidjhoward 216:7783e894f7e0 569 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value + ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 216:7783e894f7e0 570 // printf("Setting tag=%s, equal to (%2.4f+%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, opr, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 214:52ef35bc44ec 571 }
davidjhoward 216:7783e894f7e0 572 break;
davidjhoward 214:52ef35bc44ec 573 }
davidjhoward 216:7783e894f7e0 574 case '-': {
davidjhoward 216:7783e894f7e0 575 float opl = ModbusRegisterMap[cmdMap->second.opl].float_value;
davidjhoward 216:7783e894f7e0 576 float opr = ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 216:7783e894f7e0 577 if( cmdMap->second.opr.size() == 0 ) {
davidjhoward 216:7783e894f7e0 578 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value - cmdMap->second.c;
davidjhoward 216:7783e894f7e0 579 // printf("Setting tag=%s, equal to (%2.4f-%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, cmdMap->second.c, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 580 } else {
davidjhoward 216:7783e894f7e0 581 ModbusRegisterMap[cmdMap->second.tag].float_value = ModbusRegisterMap[cmdMap->second.opl].float_value - ModbusRegisterMap[cmdMap->second.opr].float_value;
davidjhoward 216:7783e894f7e0 582 // printf("Setting tag=%s, equal to (%2.4f-%2.4f) = %2.4f\r\n", cmdMap->second.tag.c_str(), opl, opr, ModbusRegisterMap[cmdMap->second.tag].float_value );
davidjhoward 216:7783e894f7e0 583 }
davidjhoward 216:7783e894f7e0 584 break;
davidjhoward 216:7783e894f7e0 585 }
davidjhoward 216:7783e894f7e0 586 default:
davidjhoward 216:7783e894f7e0 587 printf("OPERATION NOT SUPPORTED: %s\r\n", cmdMap->second.op.c_str());
davidjhoward 216:7783e894f7e0 588 break;
davidjhoward 214:52ef35bc44ec 589 }
davidjhoward 214:52ef35bc44ec 590 }
davidjhoward 214:52ef35bc44ec 591
davidjhoward 214:52ef35bc44ec 592 void UpdateOutputRegister( std::map<std::string, ModbusRegister>::iterator &modMap )
davidjhoward 214:52ef35bc44ec 593 {
davidjhoward 214:52ef35bc44ec 594 bool status;
davidjhoward 214:52ef35bc44ec 595 int ret;
davidjhoward 214:52ef35bc44ec 596
davidjhoward 214:52ef35bc44ec 597 if( modMap->second.node == 0) {
davidjhoward 214:52ef35bc44ec 598 if( ModbusRegisterMap[modMap->first].reg == 1 ) {
davidjhoward 214:52ef35bc44ec 599 dout1 = (bool)((int)ModbusRegisterMap[modMap->first].float_value&0x1);
davidjhoward 214:52ef35bc44ec 600 } else {
davidjhoward 214:52ef35bc44ec 601 dout2 = (bool)((int)ModbusRegisterMap[modMap->first].float_value&0x1);
davidjhoward 214:52ef35bc44ec 602 }
davidjhoward 214:52ef35bc44ec 603 } else {
davidjhoward 214:52ef35bc44ec 604 unsigned char xmt_buf[10];
davidjhoward 214:52ef35bc44ec 605
davidjhoward 214:52ef35bc44ec 606 switch( ModbusRegisterMap[modMap->first].type ) {
davidjhoward 214:52ef35bc44ec 607 case TYPE_32BIT_FLOAT: {
davidjhoward 214:52ef35bc44ec 608 status = WriteModbus_32bit_float( ModbusRegisterMap[modMap->first].float_value, ModbusRegisterMap[modMap->first].order, xmt_buf );
davidjhoward 214:52ef35bc44ec 609 if( status != true ) {
davidjhoward 214:52ef35bc44ec 610 printf("CMD: %s:%d: failed\r\n", __func__, __LINE__);
davidjhoward 214:52ef35bc44ec 611 return;
davidjhoward 214:52ef35bc44ec 612 }
davidjhoward 214:52ef35bc44ec 613 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 214:52ef35bc44ec 614 break;
davidjhoward 214:52ef35bc44ec 615 }
davidjhoward 214:52ef35bc44ec 616 case TYPE_32BIT_INT:
davidjhoward 214:52ef35bc44ec 617 case TYPE_32BIT_UINT: {
davidjhoward 214:52ef35bc44ec 618 status = WriteModbus_32bit_int( ((int32_t)ModbusRegisterMap[modMap->first].float_value&0x1), ModbusRegisterMap[modMap->first].order, xmt_buf );
davidjhoward 214:52ef35bc44ec 619 if( status != true ) {
davidjhoward 214:52ef35bc44ec 620 printf("CMD: %s:%d: failed\r\n", __func__, __LINE__ );
davidjhoward 214:52ef35bc44ec 621 return;
davidjhoward 214:52ef35bc44ec 622 }
davidjhoward 214:52ef35bc44ec 623 break;
davidjhoward 214:52ef35bc44ec 624 }
davidjhoward 214:52ef35bc44ec 625 case TYPE_16BIT_INT:
davidjhoward 214:52ef35bc44ec 626 case TYPE_16BIT_UINT:
davidjhoward 214:52ef35bc44ec 627 status = WriteModbus_16bit_int( ((int16_t)ModbusRegisterMap[modMap->first].float_value&0x1), ModbusRegisterMap[modMap->first].order, xmt_buf );
davidjhoward 214:52ef35bc44ec 628 if( status != true ) {
davidjhoward 214:52ef35bc44ec 629 printf("CMD: %s:%d: failed\r\n", __func__, __LINE__ );
davidjhoward 214:52ef35bc44ec 630 return;
davidjhoward 214:52ef35bc44ec 631 }
davidjhoward 214:52ef35bc44ec 632 printf("%s:%d: 0x%x 0x%x\r\n", __func__,__LINE__, xmt_buf[0], xmt_buf[1]);
davidjhoward 214:52ef35bc44ec 633 break;
davidjhoward 214:52ef35bc44ec 634 default:
davidjhoward 214:52ef35bc44ec 635 printf("CMD: %s:%d: NOT IMPLEMENTED\r\n", __func__, __LINE__ );
davidjhoward 214:52ef35bc44ec 636 return;
davidjhoward 214:52ef35bc44ec 637 }
davidjhoward 214:52ef35bc44ec 638 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 214:52ef35bc44ec 639 ret = mod_write(ModbusRegisterMap[modMap->first].node, ModbusRegisterMap[modMap->first].rtype, ModbusRegisterMap[modMap->first].reg, ModbusRegisterMap[modMap->first].size, xmt_buf);
davidjhoward 214:52ef35bc44ec 640 if( ret != MOD_ERROR_NONE ) {
davidjhoward 214:52ef35bc44ec 641 printf("CMD: %s:%d: failed, errflag=%d\r\n", __func__, __LINE__, ret );
davidjhoward 214:52ef35bc44ec 642 } else {
davidjhoward 214:52ef35bc44ec 643 printf("CMD: %s:%d: wrote to modbus func=%d reg=%d value=%2.4f, errflag=%d\r\n", __func__, __LINE__, ModbusRegisterMap[modMap->first].rtype, ModbusRegisterMap[modMap->first].reg, ModbusRegisterMap[modMap->first].float_value, ret );
davidjhoward 214:52ef35bc44ec 644 }
davidjhoward 214:52ef35bc44ec 645 }
davidjhoward 186:16912aa18c2a 646 }