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"
99 #include "commands-wms.c"
101 #define __uqmi_command(_name, _optname, _arg, _type) \
102 [__UQMI_COMMAND_##_name] = { \
105 .prepare = cmd_##_name##_prepare, \
106 .cb = cmd_##_name##_cb, \
109 const struct uqmi_cmd_handler uqmi_cmd_handler
[__UQMI_COMMAND_LAST
] = {
112 #undef __uqmi_command
114 static struct uqmi_cmd
*cmds
;
117 void uqmi_add_command(char *arg
, int cmd
)
121 cmds
= realloc(cmds
, n_cmds
* sizeof(*cmds
));
122 cmds
[idx
].handler
= &uqmi_cmd_handler
[cmd
];
123 cmds
[idx
].arg
= optarg
;
126 static void uqmi_print_result(struct blob_attr
*data
)
128 struct blob_attr
*cur
;
131 blob_for_each_attr(cur
, data
, rem
) {
132 switch (blobmsg_type(cur
)) {
133 case BLOBMSG_TYPE_STRING
:
134 printf("%s=%s\n", blobmsg_name(cur
), (char *) blobmsg_data(cur
));
136 case BLOBMSG_TYPE_INT32
:
137 printf("%s=%d\n", blobmsg_name(cur
), (int32_t) blobmsg_get_u32(cur
));
139 case BLOBMSG_TYPE_INT8
:
140 printf("%s=%s\n", blobmsg_name(cur
), blobmsg_get_u8(cur
) ? "true" : "false");
146 static bool __uqmi_run_commands(struct qmi_dev
*qmi
, bool option
)
148 static char buf
[2048];
149 static struct qmi_request req
;
152 for (i
= 0; i
< n_cmds
; i
++) {
153 enum qmi_cmd_result res
;
154 bool cmd_option
= cmds
[i
].handler
->type
== CMD_TYPE_OPTION
;
155 bool do_break
= false;
157 if (cmd_option
!= option
)
160 blob_buf_init(&status
, 0);
161 if (cmds
[i
].handler
->type
> QMI_SERVICE_CTL
&&
162 qmi_service_connect(qmi
, cmds
[i
].handler
->type
, -1)) {
163 blobmsg_printf(&status
, "error", "failed to connect to service");
166 res
= cmds
[i
].handler
->prepare(qmi
, &req
, (void *) buf
, cmds
[i
].arg
);
169 if (res
== QMI_CMD_REQUEST
) {
170 qmi_request_start(qmi
, &req
, (void *) buf
, cmds
[i
].handler
->cb
);
171 req
.no_error_cb
= true;
172 if (qmi_request_wait(qmi
, &req
))
173 blobmsg_add_string(&status
, "error", qmi_get_error_str(req
.ret
));
174 } else if (res
== QMI_CMD_EXIT
) {
178 uqmi_print_result(status
.head
);
185 void uqmi_run_commands(struct qmi_dev
*qmi
)
187 if (__uqmi_run_commands(qmi
, true))
188 __uqmi_run_commands(qmi
, false);