Separation of decoding User Data Header from decoding 7 bit message
[project/uqmi.git] / commands-dms.c
1 #include "qmi-message.h"
2
3 static const char *get_pin_status(int status)
4 {
5         static const char *pin_status[] = {
6                 [QMI_DMS_UIM_PIN_STATUS_NOT_INITIALIZED] = "not_initialized",
7                 [QMI_DMS_UIM_PIN_STATUS_ENABLED_NOT_VERIFIED] = "not_verified",
8                 [QMI_DMS_UIM_PIN_STATUS_ENABLED_VERIFIED] = "verified",
9                 [QMI_DMS_UIM_PIN_STATUS_DISABLED] = "disabled",
10                 [QMI_DMS_UIM_PIN_STATUS_BLOCKED] = "blocked",
11                 [QMI_DMS_UIM_PIN_STATUS_PERMANENTLY_BLOCKED] = "permanently_blocked",
12                 [QMI_DMS_UIM_PIN_STATUS_UNBLOCKED] = "unblocked",
13                 [QMI_DMS_UIM_PIN_STATUS_CHANGED] = "changed",
14         };
15         const char *res = "Unknown";
16
17         if (status < ARRAY_SIZE(pin_status) && pin_status[status])
18                 res = pin_status[status];
19
20         return res;
21 }
22
23 static void cmd_dms_get_pin_status_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
24 {
25         struct qmi_dms_uim_get_pin_status_response res;
26         void *c;
27
28         qmi_parse_dms_uim_get_pin_status_response(msg, &res);
29         c = blobmsg_open_table(&status, NULL);
30         if (res.set.pin1_status) {
31                 blobmsg_add_string(&status, "pin1_status", get_pin_status(res.data.pin1_status.current_status));
32                 blobmsg_add_u32(&status, "pin1_verify_tries", (int32_t) res.data.pin1_status.verify_retries_left);
33                 blobmsg_add_u32(&status, "pin1_unblock_tries", (int32_t) res.data.pin1_status.unblock_retries_left);
34         }
35         if (res.set.pin2_status) {
36                 blobmsg_add_string(&status, "pin2_status", get_pin_status(res.data.pin2_status.current_status));
37                 blobmsg_add_u32(&status, "pin2_verify_tries", (int32_t) res.data.pin2_status.verify_retries_left);
38                 blobmsg_add_u32(&status, "pin2_unblock_tries", (int32_t) res.data.pin2_status.unblock_retries_left);
39         }
40         blobmsg_close_table(&status, c);
41 }
42
43 static enum qmi_cmd_result
44 cmd_dms_get_pin_status_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
45 {
46         qmi_set_dms_uim_get_pin_status_request(msg);
47         return QMI_CMD_REQUEST;
48 }
49
50 #define cmd_dms_verify_pin1_cb no_cb
51 static enum qmi_cmd_result
52 cmd_dms_verify_pin1_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
53 {
54         struct qmi_dms_uim_verify_pin_request data = {
55                 QMI_INIT_SEQUENCE(info,
56                         .pin_id = QMI_DMS_UIM_PIN_ID_PIN,
57                         .pin = arg
58                 )
59         };
60         qmi_set_dms_uim_verify_pin_request(msg, &data);
61         return QMI_CMD_REQUEST;
62 }
63
64 #define cmd_dms_verify_pin2_cb no_cb
65 static enum qmi_cmd_result
66 cmd_dms_verify_pin2_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
67 {
68         struct qmi_dms_uim_verify_pin_request data = {
69                 QMI_INIT_SEQUENCE(info,
70                         .pin_id = QMI_DMS_UIM_PIN_ID_PIN2,
71                         .pin = arg
72                 )
73         };
74         qmi_set_dms_uim_verify_pin_request(msg, &data);
75         return QMI_CMD_REQUEST;
76 }
77
78 static struct qmi_dms_uim_unblock_pin_request dms_unlock_pin_req = {
79         QMI_INIT_SEQUENCE(info,
80                         .pin_id = QMI_DMS_UIM_PIN_ID_PIN
81                 )
82         };
83
84 #define cmd_dms_set_new_pin_cb no_cb
85 static enum qmi_cmd_result
86 cmd_dms_set_new_pin_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
87 {
88         qmi_set_ptr(&dms_unlock_pin_req, info.new_pin, arg);
89         return QMI_CMD_DONE;
90 }
91
92 #define cmd_dms_set_puk_cb no_cb
93 static enum qmi_cmd_result
94 cmd_dms_set_puk_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
95 {
96         qmi_set_ptr(&dms_unlock_pin_req, info.puk, arg);
97         return QMI_CMD_DONE;
98 }
99
100 #define cmd_dms_unblock_pin1_cb no_cb
101 static enum qmi_cmd_result
102 cmd_dms_unblock_pin1_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
103 {
104         qmi_set_ptr(&dms_unlock_pin_req, info.pin_id, QMI_DMS_UIM_PIN_ID_PIN);
105
106         if (!dms_unlock_pin_req.data.info.puk || !dms_unlock_pin_req.data.info.new_pin) {
107                 uqmi_add_error("Missing argument");
108                 return QMI_CMD_EXIT;
109         }
110
111         qmi_set_dms_uim_unblock_pin_request(msg, &dms_unlock_pin_req);
112         return QMI_CMD_REQUEST;
113 }
114
115 #define cmd_dms_unblock_pin2_cb no_cb
116 static enum qmi_cmd_result
117 cmd_dms_unblock_pin2_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
118 {
119         qmi_set_ptr(&dms_unlock_pin_req, info.pin_id, QMI_DMS_UIM_PIN_ID_PIN2);
120
121         if (!dms_unlock_pin_req.data.info.puk || !dms_unlock_pin_req.data.info.new_pin) {
122                 uqmi_add_error("Missing argument");
123                 return QMI_CMD_EXIT;
124         }
125
126         qmi_set_dms_uim_unblock_pin_request(msg, &dms_unlock_pin_req);
127         return QMI_CMD_REQUEST;
128 }
129
130 static void cmd_dms_get_iccid_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
131 {
132         struct qmi_dms_uim_get_iccid_response res;
133
134         qmi_parse_dms_uim_get_iccid_response(msg, &res);
135         if (res.data.iccid)
136                 blobmsg_add_string(&status, NULL, res.data.iccid);
137 }
138
139 static enum qmi_cmd_result
140 cmd_dms_get_iccid_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
141 {
142         qmi_set_dms_uim_get_iccid_request(msg);
143         return QMI_CMD_REQUEST;
144 }
145
146 static void cmd_dms_get_imsi_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
147 {
148         struct qmi_dms_uim_get_imsi_response res;
149
150         qmi_parse_dms_uim_get_imsi_response(msg, &res);
151         if (res.data.imsi)
152                 blobmsg_add_string(&status, NULL, res.data.imsi);
153 }
154
155 static enum qmi_cmd_result
156 cmd_dms_get_imsi_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
157 {
158         qmi_set_dms_uim_get_imsi_request(msg);
159         return QMI_CMD_REQUEST;
160 }
161
162 static void cmd_dms_get_msisdn_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
163 {
164         struct qmi_dms_get_msisdn_response res;
165
166         qmi_parse_dms_get_msisdn_response(msg, &res);
167         if (res.data.msisdn)
168                 blobmsg_add_string(&status, NULL, res.data.msisdn);
169 }
170
171 static enum qmi_cmd_result
172 cmd_dms_get_msisdn_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
173 {
174         qmi_set_dms_get_msisdn_request(msg);
175         return QMI_CMD_REQUEST;
176 }
177
178 #define cmd_dms_reset_cb no_cb
179 static enum qmi_cmd_result
180 cmd_dms_reset_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
181 {
182         qmi_set_dms_reset_request(msg);
183         return QMI_CMD_REQUEST;
184 }
185
186 #define cmd_dms_set_operating_mode_cb no_cb
187 static enum qmi_cmd_result
188 cmd_dms_set_operating_mode_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
189 {
190         static const char *modes[] = {
191                 [QMI_DMS_OPERATING_MODE_ONLINE] = "online",
192                 [QMI_DMS_OPERATING_MODE_LOW_POWER] = "low_power",
193                 [QMI_DMS_OPERATING_MODE_FACTORY_TEST] = "factory_test",
194                 [QMI_DMS_OPERATING_MODE_OFFLINE] = "offline",
195                 [QMI_DMS_OPERATING_MODE_RESET] = "reset",
196                 [QMI_DMS_OPERATING_MODE_SHUTTING_DOWN] = "shutting_down",
197                 [QMI_DMS_OPERATING_MODE_PERSISTENT_LOW_POWER] = "persistent_low_power",
198                 [QMI_DMS_OPERATING_MODE_MODE_ONLY_LOW_POWER] = "mode_only_low_power",
199         };
200         static struct qmi_dms_set_operating_mode_request sreq = {
201                 QMI_INIT(mode, QMI_DMS_OPERATING_MODE_ONLINE),
202         };
203         int i;
204
205         for (i = 0; i < ARRAY_SIZE(modes); i++) {
206                 if (!modes[i])
207                         continue;
208
209                 if (strcmp(arg, modes[i]) != 0)
210                         continue;
211
212                 sreq.data.mode = i;
213                 qmi_set_dms_set_operating_mode_request(msg, &sreq);
214                 return QMI_CMD_REQUEST;
215         }
216
217         return uqmi_add_error("Invalid argument");
218 }