1 files changed, 70 insertions, 1 deletions

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;
+}