bool SA818::applyConfig() {
    char buffer [50];

   int cmdsize = 15;
   char verif[cmdsize+1] = {'+','D','M','O','S','E','T','G','R','O','U','P',':','0','\r','\n'};
   char buff[cmdsize*2];
   int i = 0;
   
   sprintf(buffer, "AT+DMOSETGROUP=%d,%s,%s,%04d,%d,%04d\r\n", _CONF_bandwidth, _CONF_TXfreq, _CONF_RXfreq, _CONF_TXCTCSS, _CONF_squeltch, _CONF_RXCTCSS);
   Serial.print(buffer);
   Serial.flush();

   long start = millis();
   while((start + SA818_CONTACT_TIMEOUT) > millis()) {
      if(i == 0) {
         buff[i] = Serial.read();
      }
      if(buff[i] == verif[0] || i>0) {
         delay((SA818_SERBPS / 1000) * 2 ); //Makes sure that the bit has time to come. Espetially that the implementation is wierd

         i++;
         buff[i] = Serial.read();

         if(buff[i] != verif[i]) {
            return false;
         }
         if(i >= cmdsize) {
            return true;
         }
      }
   }
   return (start + SA818_CONTACT_TIMEOUT) < millis();
}