Как легко разобрать ответ AT-команды от модуля GSM?

Question

Я пытаюсь проанализировать следующий вывод, полученный от модуля GSM в Arduino, чтобы получить только часть Напряжение (3.900V). Однако я не могу заставить его работать.

"    
+CBC: 0,66,3.900V

OK
"

Я пробовал следующий код, но он не работает и даже падает.

    float getVoltage() {
        if (atCmd("AT+CBC\r") == 1) {
            char *p = strchr(buffer, ',');
            if (p) {
                p += 3; // get voltage 
                int vo = atof(p) ;
                p = strchr(p, '.');
                if (p) vo += *(p + 1) - '0';    // ??
                return vo;
            }
        }
        return 0;
    }

Как это можно сделать лучше или прозрачнее?

Answer 1

Вы можете сделать это, используя функцию C strtok для токенизации буфера

void setup() {
  Serial.begin(115200);

  char buffer[20]  = "+CBC: 1,66,3.900V";

  const char* delims = " ,V";
  char* tok = strtok(buffer, delims); // +CVB:

  tok = strtok(NULL, delims);
  int first = atoi(tok);

  tok = strtok(NULL, delims);
  int second = atoi(tok);

  tok = strtok(NULL, delims);
  float voltage = atof(tok);

  Serial.println(first);
  Serial.println(second);
  Serial.println(voltage);

}

void loop() {
}

Answer 2

Это исправлено:

    float getVoltage() {
        if (atCmd("AT+CBC\r") == 1) {
            char *p = strchr(buffer, 'V');
            if (p) {
                p -= 5;  // get voltage
                double vo = atof(p) ;
                //printf("%1.3f\n", vo);
                return vo;
            }
        }
        return 0;
    }