teste de publish
Dependencies: DS1820 HighSpeedAnalogIn devices mbed
diversos.cpp@9:cf406384efd9, 2017-08-09 (annotated)
- 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?
User | Revision | Line number | New 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 | } |