7 #include <libubox/blobmsg.h>
12 static struct blob_buf status;
14 static void no_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
18 static void cmd_version_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
20 struct qmi_ctl_get_version_info_response res;
24 qmi_parse_ctl_get_version_info_response(msg, &res);
25 for (i = 0; i < res.data.service_list_n; i++) {
26 sprintf(name_buf, "service_%d", res.data.service_list[i].service);
27 blobmsg_printf(&status, name_buf, "%d,%d",
28 res.data.service_list[i].major_version,
29 res.data.service_list[i].minor_version);
33 static enum qmi_cmd_result
34 cmd_version_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
36 qmi_set_ctl_get_version_info_request(msg);
37 return QMI_CMD_REQUEST;
40 #define cmd_get_client_id_cb no_cb
41 static enum qmi_cmd_result
42 cmd_get_client_id_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
44 QmiService svc = qmi_service_get_by_name(arg);
47 fprintf(stderr, "Invalid service name '%s'\n", arg);
51 if (qmi_service_connect(qmi, svc, -1)) {
52 fprintf(stderr, "Failed to connect to service\n");
56 printf("%d\n", qmi_service_get_client_id(qmi, svc));
60 #define cmd_set_client_id_cb no_cb
61 static enum qmi_cmd_result
62 cmd_set_client_id_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
70 fprintf(stderr, "Invalid argument\n");
76 id = strtoul(s, &s, 0);
78 fprintf(stderr, "Invalid argument\n");
82 svc = qmi_service_get_by_name(arg);
84 fprintf(stderr, "Invalid service name '%s'\n", arg);
88 if (qmi_service_connect(qmi, svc, id)) {
89 fprintf(stderr, "Failed to connect to service\n");
96 #include "commands-wds.c"
97 #include "commands-dms.c"
98 #include "commands-nas.c"
100 #define __uqmi_command(_name, _optname, _arg, _type) \
101 [__UQMI_COMMAND_##_name] = { \
104 .prepare = cmd_##_name##_prepare, \
105 .cb = cmd_##_name##_cb, \
108 const struct uqmi_cmd_handler uqmi_cmd_handler[__UQMI_COMMAND_LAST] = {
111 #undef __uqmi_command
113 static struct uqmi_cmd *cmds;
116 void uqmi_add_command(char *arg, int cmd)
120 cmds = realloc(cmds, n_cmds * sizeof(*cmds));
121 cmds[idx].handler = &uqmi_cmd_handler[cmd];
122 cmds[idx].arg = optarg;
125 static void uqmi_print_result(struct blob_attr *data)
127 struct blob_attr *cur;
130 blob_for_each_attr(cur, data, rem) {
131 switch (blobmsg_type(cur)) {
132 case BLOBMSG_TYPE_STRING:
133 printf("%s=%s\n", blobmsg_name(cur), (char *) blobmsg_data(cur));
135 case BLOBMSG_TYPE_INT32:
136 printf("%s=%d\n", blobmsg_name(cur), (int32_t) blobmsg_get_u32(cur));
138 case BLOBMSG_TYPE_INT8:
139 printf("%s=%s\n", blobmsg_name(cur), blobmsg_get_u8(cur) ? "true" : "false");
145 static bool __uqmi_run_commands(struct qmi_dev *qmi, bool option)
147 static char buf[2048];
148 static struct qmi_request req;
151 for (i = 0; i < n_cmds; i++) {
152 enum qmi_cmd_result res;
153 bool cmd_option = cmds[i].handler->type == CMD_TYPE_OPTION;
154 bool do_break = false;
156 if (cmd_option != option)
159 blob_buf_init(&status, 0);
160 if (cmds[i].handler->type > QMI_SERVICE_CTL &&
161 qmi_service_connect(qmi, cmds[i].handler->type, -1)) {
162 blobmsg_printf(&status, "error", "failed to connect to service");
165 res = cmds[i].handler->prepare(qmi, &req, (void *) buf, cmds[i].arg);
168 if (res == QMI_CMD_REQUEST) {
169 qmi_request_start(qmi, &req, (void *) buf, cmds[i].handler->cb);
170 req.no_error_cb = true;
171 if (qmi_request_wait(qmi, &req))
172 blobmsg_add_string(&status, "error", qmi_get_error_str(req.ret));
173 } else if (res == QMI_CMD_EXIT) {
177 uqmi_print_result(status.head);
184 void uqmi_run_commands(struct qmi_dev *qmi)
186 if (__uqmi_run_commands(qmi, true))
187 __uqmi_run_commands(qmi, false);