7 #include "qmi-errors.h"
8 #include "qmi-errors.c"
10 bool cancel_all_requests = false;
12 #define __qmi_service(_n) [__##_n] = _n
13 static const uint8_t qmi_services[__QMI_SERVICE_LAST] = {
24 void dump_packet(const char *prefix, void *ptr, int len)
26 unsigned char *data = ptr;
29 fprintf(stderr, "%s:", prefix);
30 for (i = 0; i < len; i++)
31 fprintf(stderr, " %02x", data[i]);
32 fprintf(stderr, "\n");
37 qmi_get_service_idx(QmiService svc)
41 for (i = 0; i < ARRAY_SIZE(qmi_services); i++)
42 if (qmi_services[i] == svc)
48 static void __qmi_request_complete(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
60 tlv_buf = qmi_msg_get_tlv_buf(msg, &tlv_len);
61 req->ret = qmi_check_message_status(tlv_buf, tlv_len);
65 req->ret = QMI_ERROR_CANCELLED;
68 if (req->cb && (msg || !req->no_error_cb))
69 req->cb(qmi, req, msg);
72 *req->complete = true;
73 uloop_cancelled = true;
77 static void qmi_process_msg(struct qmi_dev *qmi, struct qmi_msg *msg)
79 struct qmi_request *req;
82 if (msg->qmux.service == QMI_SERVICE_CTL)
83 tid = msg->ctl.transaction;
85 tid = le16_to_cpu(msg->svc.transaction);
87 list_for_each_entry(req, &qmi->req, list) {
88 if (req->service != msg->qmux.service)
94 __qmi_request_complete(qmi, req, msg);
99 static void qmi_notify_read(struct ustream *us, int bytes)
101 struct qmi_dev *qmi = container_of(us, struct qmi_dev, sf.stream);
107 buf = ustream_get_read_buf(us, &len);
111 if (len < offsetof(struct qmi_msg, flags))
114 msg = (struct qmi_msg *) buf;
115 msg_len = le16_to_cpu(msg->qmux.len) + 1;
119 dump_packet("Received packet", msg, msg_len);
120 qmi_process_msg(qmi, msg);
121 ustream_consume(us, msg_len);
125 int qmi_request_start(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, request_cb cb)
127 int len = qmi_complete_request_message(msg);
130 memset(req, 0, sizeof(*req));
132 req->service = msg->qmux.service;
133 if (req->service == QMI_SERVICE_CTL) {
134 tid = qmi->ctl_tid++;
135 msg->ctl.transaction = tid;
137 int idx = qmi_get_service_idx(req->service);
142 tid = qmi->service_data[idx].tid++;
143 msg->svc.transaction = cpu_to_le16(tid);
144 msg->qmux.client = qmi->service_data[idx].client_id;
150 list_add(&req->list, &qmi->req);
152 dump_packet("Send packet", msg, len);
153 ustream_write(&qmi->sf.stream, (void *) msg, len, false);
157 void qmi_request_cancel(struct qmi_dev *qmi, struct qmi_request *req)
160 __qmi_request_complete(qmi, req, NULL);
163 int qmi_request_wait(struct qmi_dev *qmi, struct qmi_request *req)
165 bool complete = false;
172 *req->complete = true;
174 req->complete = &complete;
176 cancelled = uloop_cancelled;
177 uloop_cancelled = false;
180 if (cancel_all_requests)
181 qmi_request_cancel(qmi, req);
183 uloop_cancelled = cancelled;
186 if (req->complete == &complete)
187 req->complete = NULL;
192 struct qmi_connect_request {
193 struct qmi_request req;
197 static void qmi_connect_service_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
199 struct qmi_ctl_allocate_cid_response res;
200 struct qmi_connect_request *creq = container_of(req, struct qmi_connect_request, req);
205 qmi_parse_ctl_allocate_cid_response(msg, &res);
206 creq->cid = res.data.allocation_info.cid;
209 int qmi_service_connect(struct qmi_dev *qmi, QmiService svc, int client_id)
211 struct qmi_ctl_allocate_cid_request creq = {
212 QMI_INIT(service, svc)
214 struct qmi_connect_request req;
215 int idx = qmi_get_service_idx(svc);
216 struct qmi_msg *msg = &msgbuf.msg;
221 if (qmi->service_connected & (1 << idx))
225 qmi_set_ctl_allocate_cid_request(msg, &creq);
226 qmi_request_start(qmi, &req.req, msg, qmi_connect_service_cb);
227 qmi_request_wait(qmi, &req.req);
234 qmi->service_keep_cid |= (1 << idx);
237 qmi->service_data[idx].connected = true;
238 qmi->service_data[idx].client_id = client_id;
239 qmi->service_data[idx].tid = 1;
240 qmi->service_connected |= (1 << idx);
245 static void __qmi_service_disconnect(struct qmi_dev *qmi, int idx)
247 int client_id = qmi->service_data[idx].client_id;
248 struct qmi_ctl_release_cid_request creq = {
249 QMI_INIT_SEQUENCE(release_info,
250 .service = qmi_services[idx],
254 struct qmi_request req;
255 struct qmi_msg *msg = &msgbuf.msg;
257 qmi->service_connected &= ~(1 << idx);
258 qmi->service_data[idx].client_id = -1;
259 qmi->service_data[idx].tid = 0;
261 qmi_set_ctl_release_cid_request(msg, &creq);
262 qmi_request_start(qmi, &req, msg, NULL);
263 qmi_request_wait(qmi, &req);
266 int qmi_service_release_client_id(struct qmi_dev *qmi, QmiService svc)
268 int idx = qmi_get_service_idx(svc);
269 qmi->service_release_cid |= 1 << idx;
273 static void qmi_close_all_services(struct qmi_dev *qmi)
275 uint32_t connected = qmi->service_connected;
278 qmi->service_keep_cid &= ~qmi->service_release_cid;
279 for (idx = 0; connected; idx++, connected >>= 1) {
280 if (!(connected & 1))
283 if (qmi->service_keep_cid & (1 << idx))
286 __qmi_service_disconnect(qmi, idx);
290 int qmi_service_get_client_id(struct qmi_dev *qmi, QmiService svc)
292 int idx = qmi_get_service_idx(svc);
297 qmi->service_keep_cid |= (1 << idx);
298 return qmi->service_data[idx].client_id;
301 int qmi_device_open(struct qmi_dev *qmi, const char *path)
303 struct ustream *us = &qmi->sf.stream;
308 fd = open(path, O_RDWR | O_EXCL | O_NONBLOCK | O_NOCTTY);
312 us->notify_read = qmi_notify_read;
313 ustream_fd_init(&qmi->sf, fd);
314 INIT_LIST_HEAD(&qmi->req);
320 void qmi_device_close(struct qmi_dev *qmi)
322 struct qmi_request *req;
324 qmi_close_all_services(qmi);
325 ustream_free(&qmi->sf.stream);
326 close(qmi->sf.fd.fd);
328 while (!list_empty(&qmi->req)) {
329 req = list_first_entry(&qmi->req, struct qmi_request, list);
330 qmi_request_cancel(qmi, req);
334 QmiService qmi_service_get_by_name(const char *str)
336 static const struct {
340 { "dms", QMI_SERVICE_DMS },
341 { "nas", QMI_SERVICE_NAS },
342 { "pds", QMI_SERVICE_PDS },
343 { "wds", QMI_SERVICE_WDS },
344 { "wms", QMI_SERVICE_WMS },
345 { "wda", QMI_SERVICE_WDA },
349 for (i = 0; i < ARRAY_SIZE(services); i++) {
350 if (!strcasecmp(str, services[i].name))
351 return services[i].svc;
357 const char *qmi_get_error_str(int code)
361 for (i = 0; i < ARRAY_SIZE(qmi_errors); i++) {
362 if (qmi_errors[i].code == code)
363 return qmi_errors[i].text;
366 return "Unknown error";