From a1727baa9c57466517e76b635e7c27bf177acda2 Mon Sep 17 00:00:00 2001 From: Serhii Kostiuk Date: Tue, 18 Jun 2019 17:11:03 +0300 Subject: [MTR-MTQ] Quectel support for sms-utils - Added new "manufacturer" field to the "global_core" structure - Added the "atcmd_plus_gmi_read()" function to fetch manufacturer identification - Added a call to the "atcmd_plus_gmi_read()" in "sms_atcmd_init()" - Added "is_telit_model()" and "is_quectel_model()" functions to pick a proper manufacturer-specific command in "atcmd_plus_iccid_read()" and, possibly, other commands in the future - Tabs VS spaces. This project uses tabs --- src/atcmd.c | 71 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++- 1 file changed, 70 insertions(+), 1 deletion(-) (limited to 'src/atcmd.c') diff --git a/src/atcmd.c b/src/atcmd.c index 595a91a..9e230c5 100644 --- a/src/atcmd.c +++ b/src/atcmd.c @@ -1243,6 +1243,50 @@ int atcmd_plus_gmm_read(int fd) return 0; } +/* Manufacturer identification is needed to pick proper manufacturer-specific commands. + * For example, in atcmd_plus_iccid_read() function. */ +int atcmd_plus_gmi_read(int fd) +{ + char buf[ATCMD_LINE_SIZE]; + char *save; + char *token; + int tmp; + + atcmd_writeline(fd, "AT+GMI"); + //Swallow extra "\r\n" + tmp = atcmd_readline(fd, buf, sizeof(buf)); + if (tmp <= 0) { + log_debug("expected \\r\\n but it was not received"); + return -1; + } + + //Read manufacturer string + tmp = atcmd_readline(fd, buf, sizeof(buf)); + if (tmp <= 0) { + log_debug("expected manufacturer but it was not received"); + return -1; + } + + save = buf; + token = atcmd_value_tok(&save); + if (!token) { + log_debug("atcmd_value_tok manufacturer"); + return -1; + } + free(Global.core.manufacturer); + Global.core.manufacturer = strdup(token); + + log_debug("manufacturer: %s", Global.core.manufacturer); + + tmp = atcmd_expect_line(fd, buf, sizeof(buf), "OK"); + if (tmp <= 0) { + log_debug("expected OK but it was not received"); + return -1; + } + + return 0; +} + /* ICCID needed for LNA3 to determine carrier */ int atcmd_plus_iccid_read(int fd) { @@ -1348,12 +1392,18 @@ static int sms_atcmd_init(int fd) return -1; } - tmp = atcmd_plus_gmm_read(fd); + tmp = atcmd_plus_gmm_read(fd); if (tmp < 0) { log_error("failed to read radio model"); return -1; } + tmp = atcmd_plus_gmi_read(fd); + if (tmp < 0) { + log_error("failed to read radio manufacturer"); + return -1; + } + tmp = atcmd_plus_iccid_read(fd); if (tmp < 0) { log_error("failed to read SIM ICCID"); @@ -1494,3 +1544,22 @@ int isCdmaTypeModel() !strcmp(Global.core.model, "CE910-DUAL")); } +int is_telit_model() +{ + if (!strcmp(Global.core.manufacturer, "Telit")) { + log_debug("Found Telit model"); + return 1; + } + + return 0; +} + +int is_quectel_model() +{ + if (!strcmp(Global.core.manufacturer, "Quectel")) { + log_debug("Found Quectel model"); + return 1; + } + + return 0; +} -- cgit v1.2.3 From 63db795dce4e752d0d36a48faf1652f650dfb240 Mon Sep 17 00:00:00 2001 From: Serhii Kostiuk Date: Tue, 18 Jun 2019 17:22:51 +0300 Subject: [MTR-MTQ] Quectel support for sms-utils Added support of Quectel-specific commands into the "atcmd_plus_iccid_read()" function --- src/atcmd.c | 12 +++++++++++- 1 file changed, 11 insertions(+), 1 deletion(-) (limited to 'src/atcmd.c') diff --git a/src/atcmd.c b/src/atcmd.c index 9e230c5..694782d 100644 --- a/src/atcmd.c +++ b/src/atcmd.c @@ -1294,8 +1294,18 @@ int atcmd_plus_iccid_read(int fd) char *save; char *token; int tmp; + char* command; - atcmd_writeline(fd, "AT#CCID"); + if (is_telit_model()) { + command = "AT#CCID"; + } else if (is_quectel_model()) { + command = "AT+QCCID"; + } else { + log_error("unsupported modem manufacturer, unable to detect ICCID"); + return -1; + } + + atcmd_writeline(fd, command); //Swallow extra "\r\n" tmp = atcmd_readline(fd, buf, sizeof(buf)); if (tmp <= 0) { -- cgit v1.2.3 From 026a3d974673fe2d87793c93496c2bb829ccf1d6 Mon Sep 17 00:00:00 2001 From: Serhii Kostiuk Date: Tue, 18 Jun 2019 17:22:51 +0300 Subject: [MTR-MTQ] Quectel support for sms-utils Switched from dynamically-allocated to statically-allocated variables for data fetched from the modem. --- src/atcmd.c | 13 +++++-------- 1 file changed, 5 insertions(+), 8 deletions(-) (limited to 'src/atcmd.c') diff --git a/src/atcmd.c b/src/atcmd.c index 694782d..a216ab6 100644 --- a/src/atcmd.c +++ b/src/atcmd.c @@ -1229,8 +1229,7 @@ int atcmd_plus_gmm_read(int fd) log_debug("atcmd_value_tok model"); return -1; } - free(Global.core.model); - Global.core.model = strdup(token); + strncpy(Global.core.model, token, MODEL_LEN); log_debug("model: %s", Global.core.model); @@ -1273,8 +1272,7 @@ int atcmd_plus_gmi_read(int fd) log_debug("atcmd_value_tok manufacturer"); return -1; } - free(Global.core.manufacturer); - Global.core.manufacturer = strdup(token); + strncpy(Global.core.manufacturer, token, MANUFACTURER_LEN); log_debug("manufacturer: %s", Global.core.manufacturer); @@ -1340,8 +1338,7 @@ int atcmd_plus_iccid_read(int fd) token = ++tmp; } log_debug("token[0]=%2.2x token[1]=%2.2x",token[0],token[1]); - free(Global.core.iccid); - Global.core.iccid = strdup(token); + strncpy(Global.core.iccid, token, ICCID_LEN); log_debug("iccid: %s", Global.core.iccid); @@ -1556,7 +1553,7 @@ int isCdmaTypeModel() int is_telit_model() { - if (!strcmp(Global.core.manufacturer, "Telit")) { + if (!strncmp(Global.core.manufacturer, "Telit", MANUFACTURER_LEN)) { log_debug("Found Telit model"); return 1; } @@ -1566,7 +1563,7 @@ int is_telit_model() int is_quectel_model() { - if (!strcmp(Global.core.manufacturer, "Quectel")) { + if (!strncmp(Global.core.manufacturer, "Quectel", MANUFACTURER_LEN)) { log_debug("Found Quectel model"); return 1; } -- cgit v1.2.3