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_set_pin_protection_request dms_pin_protection_req = {
  79         QMI_INIT_SEQUENCE(info,
  80                 .pin_id = QMI_DMS_UIM_PIN_ID_PIN
  81         )
  82 };
  83
  84 #define cmd_dms_set_pin_cb no_cb
  85 static enum qmi_cmd_result
  86 cmd_dms_set_pin_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
  87 {
  88         qmi_set_ptr(&dms_pin_protection_req, info.pin, arg);
  89         return QMI_CMD_DONE;
  90 }
  91
  92 static enum qmi_cmd_result
  93 cmd_dms_set_pin_protection_prepare(struct qmi_msg *msg, char *arg)
  94 {
  95         if (!dms_pin_protection_req.data.info.pin) {
  96                 uqmi_add_error("Missing argument");
  97                 return QMI_CMD_EXIT;
  98         }
  99
 100         int is_enabled;
 101         if (strcasecmp(arg, "disabled") == 0)
 102                 is_enabled = false;
 103         else if (strcasecmp(arg, "enabled") == 0)
 104                 is_enabled = true;
 105         else {
 106                 uqmi_add_error("Invalid value (valid: disabled, enabled)");
 107                 return QMI_CMD_EXIT;
 108         }
 109
 110         qmi_set_ptr(&dms_pin_protection_req, info.protection_enabled, is_enabled);
 111         qmi_set_dms_uim_set_pin_protection_request(msg, &dms_pin_protection_req);
 112         return QMI_CMD_REQUEST;
 113 }
 114
 115 #define cmd_dms_set_pin1_protection_cb no_cb
 116 static enum qmi_cmd_result
 117 cmd_dms_set_pin1_protection_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 118 {
 119         qmi_set_ptr(&dms_pin_protection_req, info.pin_id, QMI_DMS_UIM_PIN_ID_PIN);
 120         return cmd_dms_set_pin_protection_prepare(msg, arg);
 121 }
 122
 123 #define cmd_dms_set_pin2_protection_cb no_cb
 124 static enum qmi_cmd_result
 125 cmd_dms_set_pin2_protection_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 126 {
 127         qmi_set_ptr(&dms_pin_protection_req, info.pin_id, QMI_DMS_UIM_PIN_ID_PIN2);
 128         return cmd_dms_set_pin_protection_prepare(msg, arg);
 129 }
 130
 131 static struct qmi_dms_uim_unblock_pin_request dms_unlock_pin_req = {
 132         QMI_INIT_SEQUENCE(info,
 133                         .pin_id = QMI_DMS_UIM_PIN_ID_PIN
 134                 )
 135         };
 136
 137 #define cmd_dms_set_new_pin_cb no_cb
 138 static enum qmi_cmd_result
 139 cmd_dms_set_new_pin_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 140 {
 141         qmi_set_ptr(&dms_unlock_pin_req, info.new_pin, arg);
 142         return QMI_CMD_DONE;
 143 }
 144
 145 #define cmd_dms_set_puk_cb no_cb
 146 static enum qmi_cmd_result
 147 cmd_dms_set_puk_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 148 {
 149         qmi_set_ptr(&dms_unlock_pin_req, info.puk, arg);
 150         return QMI_CMD_DONE;
 151 }
 152
 153 #define cmd_dms_unblock_pin1_cb no_cb
 154 static enum qmi_cmd_result
 155 cmd_dms_unblock_pin1_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 156 {
 157         qmi_set_ptr(&dms_unlock_pin_req, info.pin_id, QMI_DMS_UIM_PIN_ID_PIN);
 158
 159         if (!dms_unlock_pin_req.data.info.puk || !dms_unlock_pin_req.data.info.new_pin) {
 160                 uqmi_add_error("Missing argument");
 161                 return QMI_CMD_EXIT;
 162         }
 163
 164         qmi_set_dms_uim_unblock_pin_request(msg, &dms_unlock_pin_req);
 165         return QMI_CMD_REQUEST;
 166 }
 167
 168 #define cmd_dms_unblock_pin2_cb no_cb
 169 static enum qmi_cmd_result
 170 cmd_dms_unblock_pin2_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 171 {
 172         qmi_set_ptr(&dms_unlock_pin_req, info.pin_id, QMI_DMS_UIM_PIN_ID_PIN2);
 173
 174         if (!dms_unlock_pin_req.data.info.puk || !dms_unlock_pin_req.data.info.new_pin) {
 175                 uqmi_add_error("Missing argument");
 176                 return QMI_CMD_EXIT;
 177         }
 178
 179         qmi_set_dms_uim_unblock_pin_request(msg, &dms_unlock_pin_req);
 180         return QMI_CMD_REQUEST;
 181 }
 182
 183 static void cmd_dms_get_iccid_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 184 {
 185         struct qmi_dms_uim_get_iccid_response res;
 186
 187         qmi_parse_dms_uim_get_iccid_response(msg, &res);
 188         if (res.data.iccid)
 189                 blobmsg_add_string(&status, NULL, res.data.iccid);
 190 }
 191
 192 static enum qmi_cmd_result
 193 cmd_dms_get_iccid_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 194 {
 195         qmi_set_dms_uim_get_iccid_request(msg);
 196         return QMI_CMD_REQUEST;
 197 }
 198
 199 static void cmd_dms_get_imsi_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 200 {
 201         struct qmi_dms_uim_get_imsi_response res;
 202
 203         qmi_parse_dms_uim_get_imsi_response(msg, &res);
 204         if (res.data.imsi)
 205                 blobmsg_add_string(&status, NULL, res.data.imsi);
 206 }
 207
 208 static enum qmi_cmd_result
 209 cmd_dms_get_imsi_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 210 {
 211         qmi_set_dms_uim_get_imsi_request(msg);
 212         return QMI_CMD_REQUEST;
 213 }
 214
 215 static void cmd_dms_get_msisdn_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 216 {
 217         struct qmi_dms_get_msisdn_response res;
 218
 219         qmi_parse_dms_get_msisdn_response(msg, &res);
 220         if (res.data.msisdn)
 221                 blobmsg_add_string(&status, NULL, res.data.msisdn);
 222 }
 223
 224 static enum qmi_cmd_result
 225 cmd_dms_get_msisdn_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 226 {
 227         qmi_set_dms_get_msisdn_request(msg);
 228         return QMI_CMD_REQUEST;
 229 }
 230
 231 #define cmd_dms_reset_cb no_cb
 232 static enum qmi_cmd_result
 233 cmd_dms_reset_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 234 {
 235         qmi_set_dms_reset_request(msg);
 236         return QMI_CMD_REQUEST;
 237 }
 238
 239 #define cmd_dms_set_operating_mode_cb no_cb
 240 static enum qmi_cmd_result
 241 cmd_dms_set_operating_mode_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
 242 {
 243         static const char *modes[] = {
 244                 [QMI_DMS_OPERATING_MODE_ONLINE] = "online",
 245                 [QMI_DMS_OPERATING_MODE_LOW_POWER] = "low_power",
 246                 [QMI_DMS_OPERATING_MODE_FACTORY_TEST] = "factory_test",
 247                 [QMI_DMS_OPERATING_MODE_OFFLINE] = "offline",
 248                 [QMI_DMS_OPERATING_MODE_RESET] = "reset",
 249                 [QMI_DMS_OPERATING_MODE_SHUTTING_DOWN] = "shutting_down",
 250                 [QMI_DMS_OPERATING_MODE_PERSISTENT_LOW_POWER] = "persistent_low_power",
 251                 [QMI_DMS_OPERATING_MODE_MODE_ONLY_LOW_POWER] = "mode_only_low_power",
 252         };
 253         static struct qmi_dms_set_operating_mode_request sreq = {
 254                 QMI_INIT(mode, QMI_DMS_OPERATING_MODE_ONLINE),
 255         };
 256         int i;
 257
 258         for (i = 0; i < ARRAY_SIZE(modes); i++) {
 259                 if (!modes[i])
 260                         continue;
 261
 262                 if (strcmp(arg, modes[i]) != 0)
 263                         continue;
 264
 265                 sreq.data.mode = i;
 266                 qmi_set_dms_set_operating_mode_request(msg, &sreq);
 267                 return QMI_CMD_REQUEST;
 268         }
 269
 270         return uqmi_add_error("Invalid argument");
 271 }