80 lines
2.4 KiB
C
80 lines
2.4 KiB
C
#include <string.h>
|
|
|
|
#include "memory.h"
|
|
#include "conf_emm.h"
|
|
#include "fs.h"
|
|
|
|
void gen_emm_data(emm_nvdata_t *emm_data, const char *hplmn, const char *msin, int ehplmn_count, const networks_t networks) {
|
|
memset(emm_data, 0, sizeof(emm_nvdata_t));
|
|
int hplmn_index = get_plmn_index(hplmn, networks);
|
|
plmn_conf_param_t *conf = &networks.items[hplmn_index].conf;
|
|
emm_data->imsi.length = 8;
|
|
emm_data->imsi.u.num.parity = get_msin_parity(msin, conf->mcc, conf->mnc);
|
|
emm_data->imsi.u.num.digit1 = conf->mcc[0];
|
|
emm_data->imsi.u.num.digit2 = conf->mcc[1];
|
|
emm_data->imsi.u.num.digit3 = conf->mcc[2];
|
|
|
|
emm_data->imsi.u.num.digit4 = conf->mnc[0];
|
|
emm_data->imsi.u.num.digit5 = conf->mnc[1];
|
|
|
|
if (strlen(conf->mnc) == 3) {
|
|
emm_data->rplmn.MNCdigit3 = conf->mnc[2];
|
|
|
|
emm_data->imsi.u.num.digit6 = conf->mnc[2];
|
|
emm_data->imsi.u.num.digit7 = msin[0];
|
|
emm_data->imsi.u.num.digit8 = msin[1];
|
|
emm_data->imsi.u.num.digit9 = msin[2];
|
|
emm_data->imsi.u.num.digit10 = msin[3];
|
|
emm_data->imsi.u.num.digit11 = msin[4];
|
|
emm_data->imsi.u.num.digit12 = msin[5];
|
|
emm_data->imsi.u.num.digit13 = msin[6];
|
|
emm_data->imsi.u.num.digit14 = msin[7];
|
|
emm_data->imsi.u.num.digit15 = msin[8];
|
|
|
|
} else {
|
|
emm_data->rplmn.MNCdigit3 = 0xf;
|
|
|
|
emm_data->imsi.u.num.digit6 = msin[0];
|
|
emm_data->imsi.u.num.digit7 = msin[1];
|
|
emm_data->imsi.u.num.digit8 = msin[2];
|
|
emm_data->imsi.u.num.digit9 = msin[3];
|
|
emm_data->imsi.u.num.digit10 = msin[4];
|
|
emm_data->imsi.u.num.digit11 = msin[5];
|
|
emm_data->imsi.u.num.digit12 = msin[6];
|
|
emm_data->imsi.u.num.digit13 = msin[7];
|
|
emm_data->imsi.u.num.digit14 = msin[8];
|
|
emm_data->imsi.u.num.digit15 = msin[9];
|
|
|
|
}
|
|
|
|
emm_data->rplmn.MCCdigit1 = conf->mcc[0];
|
|
emm_data->rplmn.MCCdigit2 = conf->mcc[1];
|
|
emm_data->rplmn.MCCdigit3 = conf->mcc[2];
|
|
emm_data->rplmn.MNCdigit1 = conf->mnc[0];
|
|
emm_data->rplmn.MNCdigit2 = conf->mnc[1];
|
|
|
|
emm_data->eplmn.n_plmns = ehplmn_count;
|
|
}
|
|
|
|
bool write_emm_data(const char *directory, int user_id, emm_nvdata_t *emm_data) {
|
|
int rc;
|
|
char* filename = make_filename(directory, EMM_NVRAM_FILENAME, user_id);
|
|
rc = memory_write(filename, emm_data, sizeof(emm_nvdata_t));
|
|
free(filename);
|
|
if (rc != RETURNok) {
|
|
perror("ERROR\t: memory_write() failed");
|
|
exit(false);
|
|
}
|
|
return(true);
|
|
}
|
|
|
|
int get_msin_parity(const char * msin, const char *mcc, const char *mnc) {
|
|
int imsi_size = strlen(msin) + strlen(mcc)
|
|
+ strlen(mnc);
|
|
int result = (imsi_size % 2 == 0) ? 0 : 1;
|
|
return result;
|
|
|
|
}
|
|
|
|
|