Bruno Cavalcanti / Mbed 2 deprecated brunoDrome

teste de publish

Dependencies:   DS1820 HighSpeedAnalogIn devices mbed

diversos.cpp@22:cb832a9bc704, 2018-02-06 (annotated)

Committer:
brunofgc
Date:
Tue Feb 06 22:07:10 2018 +0000
Revision:
22:cb832a9bc704
Parent:
21:b9315cdd9275
Child:
25:a6da63ed025b
Dando Pau em reprogramar (devices.cfg)

Who changed what in which revision?

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