diff options
| -rw-r--r-- | .gitignore | 1 | ||||
| -rw-r--r-- | gatchat/test-qcdm.c | 174 |
2 files changed, 175 insertions, 0 deletions
@@ -42,3 +42,4 @@ unit/test-stkutil plugins/*-ofono.rules gatchat/gsmdial gatchat/test-server +gatchat/test-qcdm diff --git a/gatchat/test-qcdm.c b/gatchat/test-qcdm.c index ca304bcf..c8a31748 100644 --- a/gatchat/test-qcdm.c +++ b/gatchat/test-qcdm.c @@ -23,7 +23,181 @@ #include <config.h> #endif +#include <stdio.h> + +#include <glib.h> + +#include "gattty.h" +#include "gatutil.h" +#include "gathdlc.h" + +static gboolean option_debug = FALSE; +static gchar *option_device = NULL; + +static GMainLoop *event_loop; + +struct version_info { + char comp_date[11]; + char comp_time[8]; + char rel_date[11]; + char rel_time[8]; + char model[8]; + guint8 scm; + guint8 mob_cai_rev; + guint8 mob_model; + guint16 mob_firmware_rev; + guint8 slot_cycle_index; + guint8 msm_ver; + guint8 unknown; +} __attribute__ ((packed)); + +static void parse_qcdm(const unsigned char *buf, gsize len) +{ + struct version_info *verinfo; + char str[12]; + guint8 cmd = buf[0]; + + switch (cmd) { + case 0x00: + g_print("==> Version information\n"); + verinfo = (struct version_info *) (buf + 1); + snprintf(str, 12, "%s", verinfo->comp_date); + g_print("Compiled Date: %s\n", str); + snprintf(str, 9, "%s", verinfo->comp_time); + g_print("Compiled Time: %s\n", str); + snprintf(str, 12, "%s", verinfo->rel_date); + g_print("Release Date: %s\n", str); + snprintf(str, 9, "%s", verinfo->rel_time); + g_print("Release Time: %s\n", str); + snprintf(str, 9, "%s", verinfo->model); + g_print("Model: %s\n", str); + g_print("MSM version: %d\n", verinfo->msm_ver); + break; + case 0x13: + g_print("==> Invalid command response\n"); + break; + case 0x4b: + g_print("==> Subsystem response\n"); + break; + case 0x51: + g_print("==> Features response\n"); + break; + default: + g_print("==> Unknown command 0x%02x\n", cmd); + break; + } +} + +static void hdlc_debug(const char *str, void *data) +{ + g_print("%s: %s\n", (const char *) data, str); +} + +static void hdlc_receive(const unsigned char *buf, gsize len, void *data) +{ + if (option_debug == TRUE) + g_at_util_debug_dump(TRUE, buf, len, hdlc_debug, "QCDM"); + + parse_qcdm(buf, len); +} + +static void send_command(GAtHDLC *hdlc, guint8 cmd) +{ + unsigned char cmdbuf[1]; + + cmdbuf[0] = cmd; + + if (option_debug == TRUE) + g_at_util_debug_dump(FALSE, cmdbuf, sizeof(cmdbuf), + hdlc_debug, "QCDM"); + + g_at_hdlc_send(hdlc, cmdbuf, sizeof(cmdbuf)); +} + +static void send_subsys_command(GAtHDLC *hdlc, guint8 id, guint16 cmd) +{ + unsigned char cmdbuf[4]; + + cmdbuf[0] = 0x4b; + cmdbuf[1] = id; + cmdbuf[2] = cmd & 0xff; + cmdbuf[3] = cmd >> 8; + + if (option_debug == TRUE) + g_at_util_debug_dump(FALSE, cmdbuf, sizeof(cmdbuf), + hdlc_debug, "QCDM"); + + g_at_hdlc_send(hdlc, cmdbuf, sizeof(cmdbuf)); +} + +static GOptionEntry options[] = { + { "debug", 'd', 0, G_OPTION_ARG_NONE, &option_debug, + "Enable debugging" }, + { "device", 'n', 0, G_OPTION_ARG_STRING, &option_device, + "Specify device" }, + { NULL }, +}; + int main(int argc, char **argv) { + GOptionContext *context; + GError *err = NULL; + GIOChannel *channel; + GAtHDLC *hdlc; + + context = g_option_context_new(NULL); + g_option_context_add_main_entries(context, options, NULL); + + if (g_option_context_parse(context, &argc, &argv, &err) == FALSE) { + if (err != NULL) { + g_printerr("%s\n", err->message); + g_error_free(err); + return 1; + } + + g_printerr("An unknown error occurred\n"); + return 1; + } + + g_option_context_free(context); + + if (!option_device) + option_device = g_strdup("/dev/ttyUSB1"); + + g_print("Device: %s\n", option_device); + + channel = g_at_tty_open(option_device, NULL); + if (!channel) { + g_printerr("Failed to open QCDM device\n"); + return 1; + } + + event_loop = g_main_loop_new(NULL, FALSE); + + hdlc = g_at_hdlc_new(channel); + + g_io_channel_unref(channel); + + if (!hdlc) + return 1; + + if (option_debug == TRUE) + g_at_hdlc_set_debug(hdlc, hdlc_debug, "HDLC"); + + g_at_hdlc_set_receive(hdlc, hdlc_receive, NULL); + + send_command(hdlc, 0x00); /* Version info */ + send_command(hdlc, 0x51); /* Features query */ + + send_subsys_command(hdlc, 250, 7); /* Novatel modem status */ + + g_main_loop_run(event_loop); + + g_at_hdlc_unref(hdlc); + + g_main_loop_unref(event_loop); + + g_free(option_device); + return 0; } |