7 #include "qmi-errors.h"
8 #include "qmi-errors.c"
10 #define __qmi_service(_n) [__##_n] = _n
11 static const uint8_t qmi_services[__QMI_SERVICE_LAST] = {
22 void dump_packet(const char *prefix, void *ptr, int len)
24 unsigned char *data = ptr;
27 fprintf(stderr, "%s:", prefix);
28 for (i = 0; i < len; i++)
29 fprintf(stderr, " %02x", data[i]);
30 fprintf(stderr, "\n");
35 qmi_get_service_idx(QmiService svc)
39 for (i = 0; i < ARRAY_SIZE(qmi_services); i++)
40 if (qmi_services[i] == svc)
46 static void __qmi_request_complete(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
58 tlv_buf = qmi_msg_get_tlv_buf(msg, &tlv_len);
59 req->ret = qmi_check_message_status(tlv_buf, tlv_len);
63 if (req->cb && (msg || !req->no_error_cb))
64 req->cb(qmi, req, msg);
67 *req->complete = true;
68 uloop_cancelled = true;
72 static void qmi_process_msg(struct qmi_dev *qmi, struct qmi_msg *msg)
74 struct qmi_request *req;
77 if (msg->qmux.service == QMI_SERVICE_CTL)
78 tid = msg->ctl.transaction;
80 tid = le16_to_cpu(msg->svc.transaction);
82 list_for_each_entry(req, &qmi->req, list) {
83 if (req->service != msg->qmux.service)
89 __qmi_request_complete(qmi, req, msg);
94 static void qmi_notify_read(struct ustream *us, int bytes)
96 struct qmi_dev *qmi = container_of(us, struct qmi_dev, sf.stream);
103 buf = ustream_get_read_buf(us, &len);
107 if (len < offsetof(struct qmi_msg, flags))
110 msg = (struct qmi_msg *) buf;
111 msg_len = le16_to_cpu(msg->qmux.len) + 1;
115 dump_packet("Received packet", msg, msg_len);
116 qmi_process_msg(qmi, msg);
117 ustream_consume(us, msg_len);
121 int qmi_request_start(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, request_cb cb)
123 int len = qmi_complete_request_message(msg);
128 memset(req, 0, sizeof(*req));
130 req->service = msg->qmux.service;
131 if (req->service == QMI_SERVICE_CTL) {
132 tid = qmi->ctl_tid++;
133 msg->ctl.transaction = tid;
135 int idx = qmi_get_service_idx(req->service);
140 tid = qmi->service_data[idx].tid++;
141 msg->svc.transaction = cpu_to_le16(tid);
142 msg->qmux.client = qmi->service_data[idx].client_id;
148 list_add(&req->list, &qmi->req);
150 dump_packet("Send packet", msg, len);
151 ustream_write(&qmi->sf.stream, (void *) msg, len, false);
155 void qmi_request_cancel(struct qmi_dev *qmi, struct qmi_request *req)
158 __qmi_request_complete(qmi, req, NULL);
161 int qmi_request_wait(struct qmi_dev *qmi, struct qmi_request *req)
163 bool complete = false;
170 *req->complete = true;
172 req->complete = &complete;
174 cancelled = uloop_cancelled;
175 uloop_cancelled = false;
177 uloop_cancelled = cancelled;
180 if (req->complete == &complete)
181 req->complete = NULL;
186 struct qmi_connect_request {
187 struct qmi_request req;
191 static void qmi_connect_service_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
193 struct qmi_ctl_allocate_cid_response res;
194 struct qmi_connect_request *creq = container_of(req, struct qmi_connect_request, req);
199 qmi_parse_ctl_allocate_cid_response(msg, &res);
200 creq->cid = res.data.allocation_info.cid;
203 int qmi_service_connect(struct qmi_dev *qmi, QmiService svc, int client_id)
205 struct qmi_ctl_allocate_cid_request creq = {
206 QMI_INIT(service, svc)
208 struct qmi_connect_request req;
209 int idx = qmi_get_service_idx(svc);
210 struct qmi_msg *msg = &msgbuf.msg;
215 if (qmi->service_connected & (1 << idx))
219 qmi_set_ctl_allocate_cid_request(msg, &creq);
220 qmi_request_start(qmi, &req.req, msg, qmi_connect_service_cb);
221 qmi_request_wait(qmi, &req.req);
229 qmi->service_data[idx].connected = true;
230 qmi->service_data[idx].client_id = client_id;
231 qmi->service_data[idx].tid = 1;
232 qmi->service_connected |= (1 << idx);
237 static void __qmi_service_disconnect(struct qmi_dev *qmi, int idx)
239 int client_id = qmi->service_data[idx].client_id;
240 struct qmi_ctl_release_cid_request creq = {
241 QMI_INIT_SEQUENCE(release_info,
242 .service = qmi_services[idx],
246 struct qmi_request req;
247 struct qmi_msg *msg = &msgbuf.msg;
249 qmi->service_connected &= ~(1 << idx);
250 qmi->service_data[idx].client_id = -1;
251 qmi->service_data[idx].tid = 0;
253 qmi_set_ctl_release_cid_request(msg, &creq);
254 qmi_request_start(qmi, &req, msg, NULL);
255 qmi_request_wait(qmi, &req);
258 static void qmi_close_all_services(struct qmi_dev *qmi)
260 uint32_t connected = qmi->service_connected;
263 for (idx = 0; connected; idx++, connected >>= 1) {
264 if (!(connected & 1))
267 if (qmi->service_keep_cid & (1 << idx))
270 __qmi_service_disconnect(qmi, idx);
274 int qmi_service_get_client_id(struct qmi_dev *qmi, QmiService svc)
276 int idx = qmi_get_service_idx(svc);
281 qmi->service_keep_cid |= (1 << idx);
282 return qmi->service_data[idx].client_id;
285 int qmi_device_open(struct qmi_dev *qmi, const char *path)
287 struct ustream *us = &qmi->sf.stream;
292 fd = open(path, O_RDWR | O_EXCL | O_NONBLOCK | O_NOCTTY);
296 us->notify_read = qmi_notify_read;
297 ustream_fd_init(&qmi->sf, fd);
298 INIT_LIST_HEAD(&qmi->req);
304 void qmi_device_close(struct qmi_dev *qmi)
306 struct qmi_request *req;
309 qmi_close_all_services(qmi);
310 ustream_free(&qmi->sf.stream);
311 close(qmi->sf.fd.fd);
313 while (!list_empty(&qmi->req)) {
314 req = list_first_entry(&qmi->req, struct qmi_request, list);
315 qmi_request_cancel(qmi, req);
319 QmiService qmi_service_get_by_name(const char *str)
321 static const struct {
325 { "dms", QMI_SERVICE_DMS },
326 { "nas", QMI_SERVICE_NAS },
327 { "pds", QMI_SERVICE_PDS },
328 { "wds", QMI_SERVICE_WDS },
329 { "wms", QMI_SERVICE_WMS },
333 for (i = 0; i < ARRAY_SIZE(services); i++) {
334 if (!strcasecmp(str, services[i].name))
335 return services[i].svc;
341 const char *qmi_get_error_str(int code)
345 for (i = 0; i < ARRAY_SIZE(qmi_errors); i++) {
346 if (qmi_errors[i].code == code)
347 return qmi_errors[i].text;
350 return "Unknown error";