teste de publish

Dependencies:   DS1820 HighSpeedAnalogIn devices mbed

Committer:
brunofgc
Date:
Wed Aug 09 20:38:10 2017 +0000
Revision:
9:cf406384efd9
Parent:
7:ae9c47f62946
Child:
10:263c093f8977
Ultima versao com enviaDados na thread comunicacoes;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
brunofgc 0:1c0a769988ee 1 #include "diversos.h"
brunofgc 0:1c0a769988ee 2 bool eventosRTC::segundos;
brunofgc 0:1c0a769988ee 3 bool eventosRTC::minutos;
brunofgc 0:1c0a769988ee 4 bool eventosRTC::rotina10Segundos;
brunofgc 0:1c0a769988ee 5 bool eventosRTC::rotina15Minutos;
brunofgc 0:1c0a769988ee 6 bool eventosRTC::rotina1hora;
brunofgc 0:1c0a769988ee 7 bool eventosRTC::rotina1segundo;
brunofgc 0:1c0a769988ee 8 WatchdogTimer diversos::wdt;
brunofgc 0:1c0a769988ee 9 char commands::buffer[tamBufferCommands];
brunofgc 0:1c0a769988ee 10
brunofgc 0:1c0a769988ee 11
brunofgc 0:1c0a769988ee 12 uint32_t diversos::memAvailable(){
brunofgc 0:1c0a769988ee 13 char stackVariable;
brunofgc 0:1c0a769988ee 14 char *heap;
brunofgc 0:1c0a769988ee 15 uint32_t result;
brunofgc 0:1c0a769988ee 16 heap = (char*)malloc(1);
brunofgc 0:1c0a769988ee 17 result = (uint32_t) ((&stackVariable) - heap);
brunofgc 0:1c0a769988ee 18 free(heap);
brunofgc 0:1c0a769988ee 19 return result;
brunofgc 0:1c0a769988ee 20 }
brunofgc 0:1c0a769988ee 21
brunofgc 0:1c0a769988ee 22 void WatchdogTimer::kick(float s) {
brunofgc 0:1c0a769988ee 23 LPC_WDT->WDCLKSEL = 0x1; // Set CLK src to PCLK
brunofgc 0:1c0a769988ee 24 uint32_t clk = SystemCoreClock / 16; // WD has a fixed /4 prescaler, PCLK default is /4
brunofgc 0:1c0a769988ee 25 LPC_WDT->WDTC = s * (float)clk;
brunofgc 0:1c0a769988ee 26 LPC_WDT->WDMOD = 0x3; // Enabled and Reset
brunofgc 0:1c0a769988ee 27 kick();
brunofgc 0:1c0a769988ee 28 }
brunofgc 0:1c0a769988ee 29 // "kick" or "feed" the dog - reset the watchdog timer
brunofgc 0:1c0a769988ee 30 // by writing this required bit pattern
brunofgc 0:1c0a769988ee 31 void WatchdogTimer::kick() {
brunofgc 0:1c0a769988ee 32 LPC_WDT->WDFEED = 0xAA;
brunofgc 0:1c0a769988ee 33 LPC_WDT->WDFEED = 0x55;
brunofgc 0:1c0a769988ee 34 }
brunofgc 0:1c0a769988ee 35
brunofgc 0:1c0a769988ee 36 /*double diversos::stringToFloat(char *p,uint16_t max){
brunofgc 0:1c0a769988ee 37 uint16_t caractere=0;
brunofgc 0:1c0a769988ee 38 double iPart=0.0,dPart=0.0,f=0.0,mult=0.1;
brunofgc 0:1c0a769988ee 39 while(*p != '.') {
brunofgc 0:1c0a769988ee 40 caractere++;
brunofgc 0:1c0a769988ee 41 if(caractere>(max-1)){return 0.0;}
brunofgc 0:1c0a769988ee 42 iPart = (iPart*10) + (double)((*(p++)-'0'));
brunofgc 0:1c0a769988ee 43 }
brunofgc 0:1c0a769988ee 44 p++;
brunofgc 0:1c0a769988ee 45 while(*p!= '\0') {
brunofgc 0:1c0a769988ee 46 if(caractere>(max-1)){return 0.0;}
brunofgc 0:1c0a769988ee 47 dPart += (double)(((*(p++)-'0'))*mult);
brunofgc 0:1c0a769988ee 48 mult /= 10;
brunofgc 0:1c0a769988ee 49 }
brunofgc 0:1c0a769988ee 50 f = iPart + dPart;
brunofgc 0:1c0a769988ee 51 return f;
brunofgc 0:1c0a769988ee 52 }*/
brunofgc 0:1c0a769988ee 53
brunofgc 0:1c0a769988ee 54 /*double diversos::stringToFloat(char *p,uint16_t max){
brunofgc 0:1c0a769988ee 55 uint16_t caractere=0;
brunofgc 0:1c0a769988ee 56 double iPart=0.0,dPart=0.0,f=0.0,mult=0.1;
brunofgc 0:1c0a769988ee 57 while(p[caractere] != '.'){
brunofgc 0:1c0a769988ee 58 caractere++;
brunofgc 0:1c0a769988ee 59 if(caractere>(max-1)){return 0.0;}
brunofgc 0:1c0a769988ee 60 iPart = (iPart*10) + (((uint8_t)p[caractere])-30);
brunofgc 0:1c0a769988ee 61 }
brunofgc 0:1c0a769988ee 62 caractere++;
brunofgc 0:1c0a769988ee 63 while(p[caractere]!= '\0'){
brunofgc 0:1c0a769988ee 64 if(caractere>(max-1)){return 0.0;}
brunofgc 0:1c0a769988ee 65 dPart += (((uint8_t)p[caractere])-30)*mult;
brunofgc 0:1c0a769988ee 66 mult /= 10;
brunofgc 0:1c0a769988ee 67 }
brunofgc 0:1c0a769988ee 68 f = iPart + dPart;
brunofgc 0:1c0a769988ee 69 return f;
brunofgc 0:1c0a769988ee 70 }*/
brunofgc 0:1c0a769988ee 71
brunofgc 3:9598af355293 72 void diversos::strReplace(char *str, char *find, char *replace){
brunofgc 3:9598af355293 73 char aux[100];
brunofgc 3:9598af355293 74 char *ptr;
brunofgc 3:9598af355293 75 char replaced = 0;
brunofgc 3:9598af355293 76 char maxIterations = 0;
brunofgc 3:9598af355293 77 replaced = 0;
brunofgc 3:9598af355293 78 strcpy(aux,"");
brunofgc 3:9598af355293 79 ptr = strtok(str,find);
brunofgc 3:9598af355293 80 while((ptr!=NULL)&&(maxIterations<9)){
brunofgc 3:9598af355293 81 replaced = 1;
brunofgc 3:9598af355293 82 maxIterations++;
brunofgc 3:9598af355293 83 strcat(aux,ptr);
brunofgc 3:9598af355293 84 strcat(aux,replace);
brunofgc 3:9598af355293 85 ptr = strtok(NULL,find);
brunofgc 3:9598af355293 86 pc.printf("Tirando <%s> em <%s>.\r\n",find,str);
brunofgc 3:9598af355293 87 }
brunofgc 3:9598af355293 88 if(replaced){
brunofgc 3:9598af355293 89 aux[strlen(aux)-1]=0;
brunofgc 3:9598af355293 90 strcpy(str,aux);
brunofgc 3:9598af355293 91 }
brunofgc 3:9598af355293 92 //--------------------
brunofgc 3:9598af355293 93 }
brunofgc 3:9598af355293 94
brunofgc 4:13ff9c81dc10 95 void diversos::processaPulsosEDs(){
brunofgc 6:d4ebbaaba295 96 if(ED1){pulsosEDs[0]++;}
brunofgc 6:d4ebbaaba295 97 if(ED2){pulsosEDs[1]++;}
brunofgc 6:d4ebbaaba295 98 if(ED3){pulsosEDs[2]++;}
brunofgc 4:13ff9c81dc10 99 }
brunofgc 4:13ff9c81dc10 100
brunofgc 0:1c0a769988ee 101 void diversos::progressBar(uint32_t progresso,uint32_t total){
brunofgc 0:1c0a769988ee 102 int i,j;
brunofgc 0:1c0a769988ee 103 char maxTam = 20;
brunofgc 0:1c0a769988ee 104 char engrenagem[4]={179,0x2F,0x2D,0x5C};
brunofgc 0:1c0a769988ee 105
brunofgc 0:1c0a769988ee 106 j=((double)progresso/(double)total)*maxTam;
brunofgc 0:1c0a769988ee 107 pc.printf("%c%c%c<",179,engrenagem[(unsigned int)progresso%4],179);
brunofgc 0:1c0a769988ee 108 for(i=0;i<maxTam;i++){
brunofgc 0:1c0a769988ee 109 if(i<=j){
brunofgc 0:1c0a769988ee 110 pc.printf("%c",178);
brunofgc 0:1c0a769988ee 111 }else{
brunofgc 0:1c0a769988ee 112 pc.printf("%c",176);
brunofgc 0:1c0a769988ee 113 }
brunofgc 0:1c0a769988ee 114 }
brunofgc 0:1c0a769988ee 115 pc.printf("> %3.0f%% Progresso %5lu de %5lu\r ",((double)progresso/(double)total)*100,progresso,total);
brunofgc 0:1c0a769988ee 116 }
brunofgc 0:1c0a769988ee 117
brunofgc 0:1c0a769988ee 118 void commands::exec(uint8_t idConnection){
brunofgc 0:1c0a769988ee 119 char *ptr,*pCharFile,*ptrComando;
brunofgc 0:1c0a769988ee 120 char msg[100];
brunofgc 0:1c0a769988ee 121 uint16_t currentCur,totalLengthCommands;
brunofgc 0:1c0a769988ee 122 static uint16_t fileCheckSum16BIT,checkSum16BIT_Lido;
brunofgc 7:ae9c47f62946 123
brunofgc 0:1c0a769988ee 124 totalLengthCommands = strlen(commands::buffer);
brunofgc 0:1c0a769988ee 125 ptrComando = strtok(commands::buffer,";");
brunofgc 0:1c0a769988ee 126
brunofgc 0:1c0a769988ee 127 do{
brunofgc 2:55b7b466e742 128
brunofgc 2:55b7b466e742 129
brunofgc 2:55b7b466e742 130
brunofgc 0:1c0a769988ee 131 ptr=strstr(ptrComando,"DELETE_SENT_FILES");
brunofgc 0:1c0a769988ee 132 if(ptr) {
brunofgc 0:1c0a769988ee 133 pc.printf("Recebido comando para deletar arquivos enviados.\n");
brunofgc 0:1c0a769988ee 134 sdCard::deleteSentFiles = true;
brunofgc 0:1c0a769988ee 135 }
brunofgc 0:1c0a769988ee 136
brunofgc 0:1c0a769988ee 137 ptr=strstr(ptrComando,"SET_RTC:");
brunofgc 0:1c0a769988ee 138 if(ptr) {
brunofgc 0:1c0a769988ee 139 ptr = strtok(ptr,":");
brunofgc 0:1c0a769988ee 140 ptr = strtok(NULL,";");
brunofgc 0:1c0a769988ee 141 set_time(atoi(ptr));
brunofgc 0:1c0a769988ee 142 time_t seconds = time(NULL);
brunofgc 0:1c0a769988ee 143 pc.printf("Horario atualizado pelo server %s",ctime(&seconds));
brunofgc 0:1c0a769988ee 144 }
brunofgc 0:1c0a769988ee 145
brunofgc 0:1c0a769988ee 146 ptr=strstr(ptrComando,"sendArmazenamento");
brunofgc 0:1c0a769988ee 147 if(ptr) {
brunofgc 7:ae9c47f62946 148 eventosRTC::rotina15Minutos=1;
brunofgc 0:1c0a769988ee 149 }
brunofgc 0:1c0a769988ee 150
brunofgc 0:1c0a769988ee 151 ptr=strstr(ptrComando,"StartSendFile");
brunofgc 0:1c0a769988ee 152 if(ptr){
brunofgc 0:1c0a769988ee 153 modemCom::status.timeOut=100;
brunofgc 0:1c0a769988ee 154 strtok(ptr,",");//Descartando inicio
brunofgc 0:1c0a769988ee 155 pCharFile = strtok(NULL,",");//Selecionando nome do arquivo
brunofgc 0:1c0a769988ee 156 strcpy(sdCard::nomeArquivoEmRecebimento,pCharFile);
brunofgc 0:1c0a769988ee 157 pCharFile = strtok(NULL,";");//Selecionando string checkSum16BIT
brunofgc 0:1c0a769988ee 158 fileCheckSum16BIT = atoi(pCharFile);
brunofgc 0:1c0a769988ee 159 remove("/sd/RAD/tempFile.bin");
brunofgc 0:1c0a769988ee 160 pc.printf("Iniciando recepcao do server arquivo deviceCfg.\n");
brunofgc 0:1c0a769988ee 161 modemCom::status.recebendoArquivoDoServer = true;
brunofgc 0:1c0a769988ee 162
brunofgc 0:1c0a769988ee 163 sprintf(modemCom::bufIn,"AT+CIPSEND=%u,%lu\r\n",idConnection,10);
brunofgc 0:1c0a769988ee 164 modem.puts(modemCom::bufIn);
brunofgc 0:1c0a769988ee 165 osDelay(100);
brunofgc 0:1c0a769988ee 166 modem.puts("sendData\r\n");
brunofgc 0:1c0a769988ee 167
brunofgc 0:1c0a769988ee 168 pc.printf("sendData\n");
brunofgc 0:1c0a769988ee 169 modemCom::timeOutModem = 250;
brunofgc 0:1c0a769988ee 170 return;
brunofgc 0:1c0a769988ee 171 }
brunofgc 0:1c0a769988ee 172
brunofgc 0:1c0a769988ee 173 ptr=strstr(ptrComando,"StopSendFile");
brunofgc 0:1c0a769988ee 174 if(ptr){
brunofgc 0:1c0a769988ee 175 pc.printf("Finalizando recepcao do server arquivo deviceCfg.\n");
brunofgc 0:1c0a769988ee 176 modemCom::status.recebendoArquivoDoServer = false;
brunofgc 0:1c0a769988ee 177 checkSum16BIT_Lido = sdCard::calcCheckSum16BITFile("/sd/RAD/tempFile.bin");
brunofgc 0:1c0a769988ee 178 if(fileCheckSum16BIT == checkSum16BIT_Lido){
brunofgc 0:1c0a769988ee 179 if(sdCard::file_rename("/sd/RAD/tempFile.bin",sdCard::nomeArquivoEmRecebimento)){
brunofgc 0:1c0a769988ee 180 /*sprintf(diversos::msg,"File Received checkSum16BIT_Lido <%lu>.\r\n",checkSum16BIT_Lido);
brunofgc 0:1c0a769988ee 181 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 182 sprintf(msg,"File Received checkSum16BIT_Lido <%lu>.\r\n",checkSum16BIT_Lido);
brunofgc 0:1c0a769988ee 183 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 184 pc.printf("File Received checkSum16BIT_Lido <%lu>.\r\n",checkSum16BIT_Lido);
brunofgc 0:1c0a769988ee 185
brunofgc 0:1c0a769988ee 186 if(strstr(sdCard::nomeArquivoEmRecebimento,"devices.cfg")!=NULL){
brunofgc 9:cf406384efd9 187 pc.printf("Excluindo arquivo armazenamento.txt e envio.txt .\r\n");
brunofgc 9:cf406384efd9 188 sdCard::excluiArquivo(&sdCard::armazenamento);
brunofgc 9:cf406384efd9 189 sdCard::excluiArquivo(&sdCard::envio);
brunofgc 0:1c0a769988ee 190 pc.printf("Resetando o drome.\r\n");
brunofgc 0:1c0a769988ee 191 hardwareReset=true;
brunofgc 0:1c0a769988ee 192 }
brunofgc 0:1c0a769988ee 193
brunofgc 0:1c0a769988ee 194 }else{
brunofgc 0:1c0a769988ee 195 //modemCom::sendBufferCommandMode(2,"FileCorrupted.\r\n",strlen("FileCorrupted.\r\n"));
brunofgc 4:13ff9c81dc10 196 sprintf(msg,"erro");
brunofgc 0:1c0a769988ee 197 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 198 pc.printf("Recebido correto mas n foi possivel renomear arquivo.\r\n");
brunofgc 0:1c0a769988ee 199 }
brunofgc 0:1c0a769988ee 200
brunofgc 0:1c0a769988ee 201 }else{
brunofgc 0:1c0a769988ee 202 /*sprintf(diversos::msg,"File Corrupted checkSum16BIT_Lido <%lu>.\r\n",checkSum16BIT_Lido);
brunofgc 0:1c0a769988ee 203 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 6:d4ebbaaba295 204 sprintf(msg,"erro",checkSum16BIT_Lido);
brunofgc 0:1c0a769988ee 205 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 206 pc.printf("File Corrupted checkSum16BIT_Lido <%lu>.\r\n",checkSum16BIT_Lido);
brunofgc 0:1c0a769988ee 207 }
brunofgc 0:1c0a769988ee 208 modemCom::status.timeOut=10;
brunofgc 9:cf406384efd9 209 modemCom::timeOutModem = 50;
brunofgc 9:cf406384efd9 210 modemCom::status.timeOut = 1;
brunofgc 0:1c0a769988ee 211 }
brunofgc 0:1c0a769988ee 212
brunofgc 0:1c0a769988ee 213 /*ptr=strstr(ptrComando,"requestFile,");
brunofgc 0:1c0a769988ee 214 if(ptr){
brunofgc 0:1c0a769988ee 215 FILE *fp;
brunofgc 0:1c0a769988ee 216 char c;
brunofgc 0:1c0a769988ee 217 strtok(ptr,",");
brunofgc 0:1c0a769988ee 218 pCharFile = strtok(NULL,";");
brunofgc 0:1c0a769988ee 219
brunofgc 0:1c0a769988ee 220 fp = fopen(pCharFile,"r");
brunofgc 0:1c0a769988ee 221 if(fp!=NULL){
brunofgc 0:1c0a769988ee 222 do{
brunofgc 0:1c0a769988ee 223 c = fgetc(fp);
brunofgc 0:1c0a769988ee 224 if(!feof(fp)){modem.printf("%c",c);}
brunofgc 0:1c0a769988ee 225 modemCom::status.timeOut=10;
brunofgc 0:1c0a769988ee 226 }while(!feof(fp));
brunofgc 0:1c0a769988ee 227 fclose(fp);
brunofgc 0:1c0a769988ee 228 }else{
brunofgc 0:1c0a769988ee 229 modem.printf("Nao foi possivel abrir o arquivo.\n");
brunofgc 0:1c0a769988ee 230 }
brunofgc 0:1c0a769988ee 231 }*/
brunofgc 0:1c0a769988ee 232
brunofgc 1:0e0967c88590 233 ptr=strstr(ptrComando,"execAct:");
brunofgc 1:0e0967c88590 234 if(ptr){
brunofgc 1:0e0967c88590 235 char *pChar;
brunofgc 1:0e0967c88590 236 uint32_t actId;
brunofgc 1:0e0967c88590 237 pChar = strtok(ptr,":");
brunofgc 1:0e0967c88590 238 pChar = strtok(NULL,"");
brunofgc 1:0e0967c88590 239 actId = atoi(pChar);
brunofgc 1:0e0967c88590 240 if(dispositivos[0]->execAct(actId)){
brunofgc 1:0e0967c88590 241 sprintf(msg,"execAct_ack");
brunofgc 1:0e0967c88590 242 }else{
brunofgc 1:0e0967c88590 243 sprintf(msg,"execAct_nack");
brunofgc 1:0e0967c88590 244 }
brunofgc 1:0e0967c88590 245 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 7:ae9c47f62946 246 }
brunofgc 1:0e0967c88590 247
brunofgc 2:55b7b466e742 248 if(strstr(ptr,"enviaDadosAoServer")){
brunofgc 2:55b7b466e742 249 eventosRTC::rotina15Minutos=true;
brunofgc 2:55b7b466e742 250 sprintf(msg,"ack");
brunofgc 2:55b7b466e742 251 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 2:55b7b466e742 252 }
brunofgc 2:55b7b466e742 253
brunofgc 0:1c0a769988ee 254 ptr=strstr(ptrComando,"mbwrite:");
brunofgc 0:1c0a769988ee 255 if(ptr){
brunofgc 0:1c0a769988ee 256 uint8_t addr;
brunofgc 0:1c0a769988ee 257 uint16_t reg;
brunofgc 0:1c0a769988ee 258 uint32_t auxMod;
brunofgc 0:1c0a769988ee 259 char *pChar;
brunofgc 0:1c0a769988ee 260
brunofgc 1:0e0967c88590 261 //IR
brunofgc 1:0e0967c88590 262 if(strstr(ptr,"IR,")){
brunofgc 1:0e0967c88590 263 uint8_t freq=38,porta=0;
brunofgc 1:0e0967c88590 264 pChar = strtok(ptr,",");
brunofgc 1:0e0967c88590 265 porta = atoi(strtok(NULL,","));
brunofgc 1:0e0967c88590 266 porta--; //Trazendo para índice 0;
brunofgc 1:0e0967c88590 267
brunofgc 1:0e0967c88590 268 freq = atoi(strtok(NULL,","));
brunofgc 1:0e0967c88590 269 if(freq == 0){
brunofgc 1:0e0967c88590 270 //Se não tiver frequência, ponha 38.
brunofgc 1:0e0967c88590 271 freq = 38;
brunofgc 1:0e0967c88590 272 }
brunofgc 1:0e0967c88590 273
brunofgc 7:ae9c47f62946 274 pChar = strtok(NULL,"S");
brunofgc 5:7801f913384e 275 deserializaPacoteIR(pChar);
brunofgc 1:0e0967c88590 276 enviaComandoIR(freq,porta);
brunofgc 1:0e0967c88590 277 sprintf(msg,"WriteIR_ack");
brunofgc 1:0e0967c88590 278 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 1:0e0967c88590 279 }
brunofgc 1:0e0967c88590 280
brunofgc 0:1c0a769988ee 281 //Float
brunofgc 0:1c0a769988ee 282 if(strstr(ptr,"float,")){
brunofgc 0:1c0a769988ee 283 float v_float;
brunofgc 0:1c0a769988ee 284
brunofgc 0:1c0a769988ee 285 //Capturando parametros comuns
brunofgc 0:1c0a769988ee 286 pChar = strtok(ptr,",");
brunofgc 0:1c0a769988ee 287
brunofgc 0:1c0a769988ee 288 //Parametro 1
brunofgc 0:1c0a769988ee 289 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 290 addr = atoi(pChar);
brunofgc 0:1c0a769988ee 291
brunofgc 0:1c0a769988ee 292 //Parametro 2
brunofgc 0:1c0a769988ee 293 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 294 reg = atoi(pChar);
brunofgc 0:1c0a769988ee 295
brunofgc 0:1c0a769988ee 296 //Parametro 3
brunofgc 0:1c0a769988ee 297 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 298 //v_float = diversos::stringToFloat(pChar,50);
brunofgc 0:1c0a769988ee 299 v_float = atof(pChar);
brunofgc 1:0e0967c88590 300
brunofgc 1:0e0967c88590 301 //Envio o dado via Modbus
brunofgc 1:0e0967c88590 302 if(!modBusMaster1::writeFloat(addr,reg,1,&v_float)){
brunofgc 1:0e0967c88590 303 pc.printf("Valor <%f> escrito no registrador %lu do endereco modbus %u.\n",v_float,reg,addr);
brunofgc 0:1c0a769988ee 304 /*sprintf(diversos::msg,"WriteFloat_ack");
brunofgc 0:1c0a769988ee 305 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 306
brunofgc 1:0e0967c88590 307 sprintf(msg,"WriteFloat_ack");
brunofgc 1:0e0967c88590 308 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 1:0e0967c88590 309 }else{
brunofgc 1:0e0967c88590 310 pc.printf("Erro ao escrever valor <%f> no registrador %lu do endereco modbus %u.\n",v_float,reg,addr);
brunofgc 1:0e0967c88590 311 /*sprintf(diversos::msg,"WriteFloat_nack");
brunofgc 1:0e0967c88590 312 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 1:0e0967c88590 313
brunofgc 1:0e0967c88590 314 sprintf(msg,"WriteFloat_nack");
brunofgc 0:1c0a769988ee 315 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 1:0e0967c88590 316 }
brunofgc 1:0e0967c88590 317 }
brunofgc 1:0e0967c88590 318
brunofgc 1:0e0967c88590 319 //PWM
brunofgc 1:0e0967c88590 320 if(strstr(ptr,"PWM,")){
brunofgc 1:0e0967c88590 321 float v_float;
brunofgc 1:0e0967c88590 322
brunofgc 1:0e0967c88590 323 //Capturando parametros comuns
brunofgc 1:0e0967c88590 324 pChar = strtok(ptr,",");
brunofgc 1:0e0967c88590 325
brunofgc 1:0e0967c88590 326 //Parametro 1
brunofgc 1:0e0967c88590 327 pChar = strtok(NULL,",");
brunofgc 1:0e0967c88590 328 addr = atoi(pChar);
brunofgc 1:0e0967c88590 329
brunofgc 1:0e0967c88590 330 //Parametro 2
brunofgc 1:0e0967c88590 331 pChar = strtok(NULL,",");
brunofgc 1:0e0967c88590 332 reg = atoi(pChar);
brunofgc 1:0e0967c88590 333
brunofgc 1:0e0967c88590 334 //Parametro 3
brunofgc 1:0e0967c88590 335 pChar = strtok(NULL,",");
brunofgc 1:0e0967c88590 336 //v_float = diversos::stringToFloat(pChar,50);
brunofgc 1:0e0967c88590 337 v_float = atof(pChar);
brunofgc 1:0e0967c88590 338
brunofgc 1:0e0967c88590 339 pc.printf("\r\n\r\nVerificando conteudo de pChar antes de converter para float <%s>.\r\n",pChar);
brunofgc 1:0e0967c88590 340
brunofgc 1:0e0967c88590 341 //Retirando a parte inteira referente ao periodo em us do pwm
brunofgc 1:0e0967c88590 342
brunofgc 1:0e0967c88590 343 auxMod = v_float/10;
brunofgc 1:0e0967c88590 344 v_float = v_float-(auxMod*10);
brunofgc 1:0e0967c88590 345 SD1.period_us(auxMod);
brunofgc 1:0e0967c88590 346 pwmPeriod = auxMod;
brunofgc 1:0e0967c88590 347 switch(reg){
brunofgc 1:0e0967c88590 348 case 0:
brunofgc 1:0e0967c88590 349 SD1.write(v_float);
brunofgc 1:0e0967c88590 350 break;
brunofgc 1:0e0967c88590 351 case 1:
brunofgc 1:0e0967c88590 352 SD2.write(v_float);
brunofgc 1:0e0967c88590 353 break;
brunofgc 1:0e0967c88590 354 case 2:
brunofgc 1:0e0967c88590 355 SD3.write(v_float);
brunofgc 1:0e0967c88590 356 break;
brunofgc 1:0e0967c88590 357 case 3:
brunofgc 1:0e0967c88590 358 SD4.write(v_float);
brunofgc 1:0e0967c88590 359 break;
brunofgc 1:0e0967c88590 360 case 4:
brunofgc 1:0e0967c88590 361 SD5.write(v_float);
brunofgc 1:0e0967c88590 362 break;
brunofgc 1:0e0967c88590 363 case 5:
brunofgc 1:0e0967c88590 364 SD6.write(v_float);
brunofgc 1:0e0967c88590 365 break;
brunofgc 0:1c0a769988ee 366 }
brunofgc 1:0e0967c88590 367 pc.printf("Valor puro %f, %lu escrito como periodo e %f como duty no reg %u.\n",v_float,auxMod,v_float,reg);
brunofgc 1:0e0967c88590 368 /*sprintf(diversos::msg,"WriteFloat_ack");
brunofgc 1:0e0967c88590 369 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 1:0e0967c88590 370
brunofgc 1:0e0967c88590 371 sprintf(msg,"WritePWM_ack");
brunofgc 1:0e0967c88590 372 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 373 }
brunofgc 0:1c0a769988ee 374
brunofgc 0:1c0a769988ee 375 //uint32_t
brunofgc 0:1c0a769988ee 376 if(strstr(ptr,"uint32_t,")){
brunofgc 0:1c0a769988ee 377 uint32_t v_uint32_t;
brunofgc 0:1c0a769988ee 378
brunofgc 0:1c0a769988ee 379 //Capturando parametros comuns
brunofgc 0:1c0a769988ee 380 pChar = strtok(ptr,",");
brunofgc 0:1c0a769988ee 381
brunofgc 0:1c0a769988ee 382 //Parametro 1
brunofgc 0:1c0a769988ee 383 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 384 addr = atoi(pChar);
brunofgc 0:1c0a769988ee 385
brunofgc 0:1c0a769988ee 386 //Parametro 2
brunofgc 0:1c0a769988ee 387 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 388 reg = atoi(pChar);
brunofgc 0:1c0a769988ee 389
brunofgc 0:1c0a769988ee 390 //Parametro 3
brunofgc 0:1c0a769988ee 391 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 392 v_uint32_t = atoi(pChar);
brunofgc 0:1c0a769988ee 393
brunofgc 0:1c0a769988ee 394 if(!modBusMaster1::writeRegister32BIT(addr,reg,1,&v_uint32_t)){
brunofgc 0:1c0a769988ee 395 pc.printf("Valor <%lu> escrito no registrador %lu do endereco modbus %u.\n",v_uint32_t,reg,addr);
brunofgc 0:1c0a769988ee 396 /*sprintf(diversos::msg,"Write_uint32_t_ack");
brunofgc 0:1c0a769988ee 397 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 398
brunofgc 1:0e0967c88590 399 sprintf(msg,"Write_uint32_t_ack");
brunofgc 0:1c0a769988ee 400 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 401 }else{
brunofgc 0:1c0a769988ee 402 pc.printf("Erro ao escrever valor <%lu> no registrador %lu do endereco modbus %u.\n",v_uint32_t,reg,addr);
brunofgc 0:1c0a769988ee 403 /*sprintf(diversos::msg,"Write_uint32_t_nack");
brunofgc 0:1c0a769988ee 404 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 405
brunofgc 1:0e0967c88590 406 sprintf(msg,"Write_uint32_t_nack");
brunofgc 0:1c0a769988ee 407 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 408 }
brunofgc 0:1c0a769988ee 409 }
brunofgc 0:1c0a769988ee 410
brunofgc 0:1c0a769988ee 411 //uint16_t
brunofgc 0:1c0a769988ee 412 if(strstr(ptr,"uint16_t,")){
brunofgc 0:1c0a769988ee 413 uint16_t v_uint16_t;
brunofgc 0:1c0a769988ee 414
brunofgc 0:1c0a769988ee 415 //Capturando parametros comuns
brunofgc 0:1c0a769988ee 416 pChar = strtok(ptr,",");
brunofgc 0:1c0a769988ee 417
brunofgc 0:1c0a769988ee 418 //Parametro 1
brunofgc 0:1c0a769988ee 419 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 420 addr = atoi(pChar);
brunofgc 0:1c0a769988ee 421
brunofgc 0:1c0a769988ee 422 //Parametro 2
brunofgc 0:1c0a769988ee 423 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 424 reg = atoi(pChar);
brunofgc 0:1c0a769988ee 425
brunofgc 0:1c0a769988ee 426 //Parametro 3
brunofgc 0:1c0a769988ee 427 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 428 v_uint16_t = atoi(pChar);
brunofgc 0:1c0a769988ee 429
brunofgc 0:1c0a769988ee 430 if(!modBusMaster1::writeRegister16BIT(addr,reg,1,&v_uint16_t)){
brunofgc 0:1c0a769988ee 431 pc.printf("Valor <%lu> escrito no registrador %lu do endereco modbus %u.\n",v_uint16_t,reg,addr);
brunofgc 0:1c0a769988ee 432 /*sprintf(diversos::msg,"Write_uint16_t_ack");
brunofgc 0:1c0a769988ee 433 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 434
brunofgc 1:0e0967c88590 435 sprintf(msg,"Write_uint16_t_ack");
brunofgc 0:1c0a769988ee 436 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 437 }else{
brunofgc 0:1c0a769988ee 438 pc.printf("Erro ao escrever valor <%lu> no registrador %lu do endereco modbus %u.\n",v_uint16_t,reg,addr);
brunofgc 0:1c0a769988ee 439 /*sprintf(diversos::msg,"Write_uint16_t_nack");
brunofgc 0:1c0a769988ee 440 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg)); */
brunofgc 0:1c0a769988ee 441
brunofgc 1:0e0967c88590 442 sprintf(msg,"Write_uint16_t_nack");
brunofgc 0:1c0a769988ee 443 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 444 }
brunofgc 0:1c0a769988ee 445 }
brunofgc 0:1c0a769988ee 446
brunofgc 0:1c0a769988ee 447 //bit
brunofgc 0:1c0a769988ee 448 if(strstr(ptr,"bit,")){
brunofgc 0:1c0a769988ee 449 bool v_bool;
brunofgc 0:1c0a769988ee 450
brunofgc 0:1c0a769988ee 451 //Capturando parametros comuns
brunofgc 0:1c0a769988ee 452 pChar = strtok(ptr,",");
brunofgc 0:1c0a769988ee 453
brunofgc 0:1c0a769988ee 454 //Parametro 1
brunofgc 0:1c0a769988ee 455 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 456 addr = atoi(pChar);
brunofgc 0:1c0a769988ee 457
brunofgc 0:1c0a769988ee 458 //Parametro 2
brunofgc 0:1c0a769988ee 459 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 460 reg = atoi(pChar);
brunofgc 0:1c0a769988ee 461
brunofgc 0:1c0a769988ee 462 //Parametro 3
brunofgc 0:1c0a769988ee 463 pChar = strtok(NULL,",");
brunofgc 0:1c0a769988ee 464 v_bool = (atoi(pChar) > 0);
brunofgc 0:1c0a769988ee 465
brunofgc 5:7801f913384e 466 if(addr != enderecoControladoraVirtual){
brunofgc 0:1c0a769988ee 467 //writeSingleCoil(uint8_t,uint16_t,bool); //Endereço slave, registrador, bool
brunofgc 0:1c0a769988ee 468 if(!modBusMaster1::writeSingleCoil(addr,reg,v_bool)){
brunofgc 0:1c0a769988ee 469 pc.printf("Valor <%u> escrito no registrador %lu do endereco modbus %u.\n",v_bool,reg,addr);
brunofgc 0:1c0a769988ee 470 /*sprintf(diversos::msg,"Write_bool_ack");
brunofgc 0:1c0a769988ee 471 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 472
brunofgc 1:0e0967c88590 473 sprintf(msg,"Write_bool_ack");
brunofgc 0:1c0a769988ee 474 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 475 }else{
brunofgc 0:1c0a769988ee 476 pc.printf("Erro ao escrever valor <%u> no registrador %lu do endereco modbus %u.\n",v_bool,reg,addr);
brunofgc 0:1c0a769988ee 477 /*sprintf(diversos::msg,"Write_bool_nack");
brunofgc 0:1c0a769988ee 478 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 479
brunofgc 1:0e0967c88590 480 sprintf(msg,"Write_bool_nack");
brunofgc 0:1c0a769988ee 481 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 482 }
brunofgc 0:1c0a769988ee 483 }else{
brunofgc 0:1c0a769988ee 484 switch(reg){
brunofgc 0:1c0a769988ee 485 case 0:
brunofgc 0:1c0a769988ee 486 SD1.write(v_bool*1.0f);
brunofgc 0:1c0a769988ee 487 break;
brunofgc 0:1c0a769988ee 488 case 1:
brunofgc 0:1c0a769988ee 489 SD2.write(v_bool*1.0f);
brunofgc 0:1c0a769988ee 490 break;
brunofgc 0:1c0a769988ee 491 case 2:
brunofgc 0:1c0a769988ee 492 SD3.write(v_bool*1.0f);
brunofgc 0:1c0a769988ee 493 break;
brunofgc 0:1c0a769988ee 494 case 3:
brunofgc 0:1c0a769988ee 495 SD4.write(v_bool*1.0f);
brunofgc 0:1c0a769988ee 496 break;
brunofgc 0:1c0a769988ee 497 case 4:
brunofgc 0:1c0a769988ee 498 SD5.write(v_bool*1.0f);
brunofgc 0:1c0a769988ee 499 break;
brunofgc 0:1c0a769988ee 500 case 5:
brunofgc 0:1c0a769988ee 501 SD6.write(v_bool*1.0f);
brunofgc 0:1c0a769988ee 502 break;
brunofgc 0:1c0a769988ee 503 case 6:
brunofgc 0:1c0a769988ee 504 SD7 = v_bool;
brunofgc 0:1c0a769988ee 505 break;
brunofgc 0:1c0a769988ee 506 case 7:
brunofgc 0:1c0a769988ee 507 SD8 = v_bool;
brunofgc 0:1c0a769988ee 508 break;
brunofgc 0:1c0a769988ee 509 }
brunofgc 0:1c0a769988ee 510 pc.printf("Valor <%u> escrito no registrador %lu do endereco modbus %u.\n",v_bool,reg,addr);
brunofgc 0:1c0a769988ee 511 /*sprintf(diversos::msg,"Write_bool_ack");
brunofgc 0:1c0a769988ee 512 modemCom::sendBufferCommandMode(2,diversos::msg,strlen(diversos::msg));*/
brunofgc 0:1c0a769988ee 513
brunofgc 1:0e0967c88590 514 sprintf(msg,"Write_bool_ack");
brunofgc 0:1c0a769988ee 515 modemCom::sendBufferCommandMode(idConnection,msg,strlen(msg));
brunofgc 0:1c0a769988ee 516 }
brunofgc 0:1c0a769988ee 517 }
brunofgc 9:cf406384efd9 518 modemCom::status.timeOut=5;
brunofgc 0:1c0a769988ee 519 }
brunofgc 0:1c0a769988ee 520
brunofgc 0:1c0a769988ee 521 currentCur = strlen(ptrComando) + 1; //Aqui eu pego onde devo buscar novamente mais algum comando.
brunofgc 0:1c0a769988ee 522 if(currentCur>=totalLengthCommands){
brunofgc 0:1c0a769988ee 523 //modemCom::status.timeOut=10;
brunofgc 0:1c0a769988ee 524 ptrComando = NULL;
brunofgc 0:1c0a769988ee 525 }else{
brunofgc 0:1c0a769988ee 526 ptrComando = strtok(&ptrComando[currentCur],";");
brunofgc 0:1c0a769988ee 527 }
brunofgc 0:1c0a769988ee 528 }while(ptrComando != NULL);//Este loop executa cada instrução.
brunofgc 0:1c0a769988ee 529 pc.printf("Atendidos todos os comandos.\n");
brunofgc 0:1c0a769988ee 530 }