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@214:52ef35bc44ec, 2016-10-11 (annotated)

Committer:
davidjhoward
Date:
Tue Oct 11 15:31:49 2016 +0000
Revision:
214:52ef35bc44ec
Parent:
203:9d735375f218
Child:
216:7783e894f7e0
more work towards virtual tags

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