int get_imsi(struct msg * msg, struct avp ** avp) { struct avp * nextavp = NULL, * a = NULL; struct avp_hdr * a_hdr = NULL; struct dict_avp_data dictdata; struct avp_hdr *avp_dst; *avp = NULL; CHECK_FCT( fd_dict_getval(dcca_dict.Subscription_Id, &dictdata) ); CHECK_FCT( fd_msg_browse(msg, MSG_BRW_FIRST_CHILD, (void *)&nextavp, NULL) ); while (nextavp) { CHECK_FCT( fd_msg_avp_hdr( nextavp, &avp_dst ) ); if ( (avp_dst->avp_code == dictdata.avp_code) && (avp_dst->avp_vendor == dictdata.avp_vendor) ) { CHECK_FCT( avp_search_child ( nextavp, dcca_dict.Subscription_Id_Type, &a) ); if(a) { CHECK_FCT( fd_msg_avp_hdr( a, &a_hdr ) ); if(a_hdr->avp_value->i32 == 1) { CHECK_FCT( avp_search_child ( nextavp, dcca_dict.Subscription_Id_Data, avp) ); break; } } } /* Otherwise move to next AVP in the message */ CHECK_FCT( fd_msg_browse(nextavp, MSG_BRW_NEXT, (void *)&nextavp, NULL) ); } return 0; }
static inline int s6a_parse_ambr(struct avp *avp_ambr, ambr_t *ambr) { struct avp *avp = NULL; struct avp_hdr *hdr; CHECK_FCT(fd_msg_browse(avp_ambr, MSG_BRW_FIRST_CHILD, &avp, NULL)); if (!avp) { /* Child avps for ambr are mandatory */ return -1; } while(avp) { CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_BANDWIDTH_UL: CHECK_FCT(s6a_parse_bitrate(hdr, &ambr->br_ul)); break; case AVP_CODE_BANDWIDTH_DL: CHECK_FCT(s6a_parse_bitrate(hdr, &ambr->br_dl)); break; default: return -1; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(avp, MSG_BRW_NEXT, &avp, NULL)); } return 0; }
static inline int s6a_parse_apn_configuration_profile(struct avp *avp_apn_conf_prof, apn_config_profile_t *apn_config_profile) { struct avp *avp = NULL; struct avp_hdr *hdr; CHECK_FCT(fd_msg_browse(avp_apn_conf_prof, MSG_BRW_FIRST_CHILD, &avp, NULL)); while(avp) { CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_CONTEXT_IDENTIFIER: apn_config_profile->context_identifier = hdr->avp_value->u32; break; case AVP_CODE_ALL_APN_CONFIG_INC_IND: CHECK_FCT(s6a_parse_all_apn_conf_inc_ind(hdr, &apn_config_profile->all_apn_conf_ind)); break; case AVP_CODE_APN_CONFIGURATION: { DevCheck(apn_config_profile->nb_apns < MAX_APN_PER_UE, apn_config_profile->nb_apns, MAX_APN_PER_UE, 0); CHECK_FCT(s6a_parse_apn_configuration( avp, &apn_config_profile->apn_configuration[apn_config_profile->nb_apns])); apn_config_profile->nb_apns++; } break; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(avp, MSG_BRW_NEXT, &avp, NULL)); } return 0; }
static inline int s6a_parse_eps_subscribed_qos_profile(struct avp *avp_qos, eps_subscribed_qos_profile_t *ptr) { struct avp *avp = NULL; struct avp_hdr *hdr; CHECK_FCT(fd_msg_browse(avp_qos, MSG_BRW_FIRST_CHILD, &avp, NULL)); while(avp) { CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_QCI: CHECK_FCT(s6a_parse_qci(hdr, &ptr->qci)); break; case AVP_CODE_ALLOCATION_RETENTION_PRIORITY: CHECK_FCT(s6a_parse_allocation_retention_priority(avp, &ptr->allocation_retention_priority)); break; default: return -1; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(avp, MSG_BRW_NEXT, &avp, NULL)); } return 0; }
int s6a_parse_experimental_result(struct avp *avp, s6a_experimental_result_t *ptr) { struct avp_hdr *hdr; struct avp *child_avp = NULL; if (!avp) { return EINVAL; } CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); DevAssert(hdr->avp_code == AVP_CODE_EXPERIMENTAL_RESULT); CHECK_FCT(fd_msg_browse(avp, MSG_BRW_FIRST_CHILD, &child_avp, NULL)); while(child_avp) { CHECK_FCT(fd_msg_avp_hdr(child_avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_EXPERIMENTAL_RESULT_CODE: S6A_ERROR("Got experimental error %u:%s\n", hdr->avp_value->u32, experimental_retcode_2_string(hdr->avp_value->u32)); if (ptr) { *ptr = (s6a_experimental_result_t)hdr->avp_value->u32; } break; case AVP_CODE_VENDOR_ID: DevCheck(hdr->avp_value->u32 == 10415, hdr->avp_value->u32, AVP_CODE_VENDOR_ID, 10415); break; default: return -1; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(child_avp, MSG_BRW_NEXT, &child_avp, NULL)); } return 0; }
int s6a_parse_subscription_data(struct avp *avp_subscription_data, subscription_data_t *subscription_data) { struct avp *avp = NULL; struct avp_hdr *hdr; CHECK_FCT(fd_msg_browse(avp_subscription_data, MSG_BRW_FIRST_CHILD, &avp, NULL)); while(avp) { CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_SUBSCRIBER_STATUS: CHECK_FCT(s6a_parse_subscriber_status(hdr, &subscription_data->subscriber_status)); break; case AVP_CODE_MSISDN: CHECK_FCT(s6a_parse_msisdn(hdr, subscription_data->msisdn, &subscription_data->msisdn_length)); break; case AVP_CODE_NETWORK_ACCESS_MODE: CHECK_FCT(s6a_parse_network_access_mode(hdr, &subscription_data->access_mode)); break; case AVP_CODE_ACCESS_RESTRICTION_DATA: CHECK_FCT(s6a_parse_access_restriction_data(hdr, &subscription_data->access_restriction)); break; case AVP_CODE_AMBR: CHECK_FCT(s6a_parse_ambr(avp, &subscription_data->subscribed_ambr)); break; case AVP_CODE_APN_CONFIGURATION_PROFILE: CHECK_FCT(s6a_parse_apn_configuration_profile(avp, &subscription_data->apn_config_profile)); break; case AVP_CODE_SUBSCRIBED_PERIODIC_RAU_TAU_TIMER: subscription_data->rau_tau_timer = hdr->avp_value->u32; break; default: return -1; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(avp, MSG_BRW_NEXT, &avp, NULL)); } return 0; }
static inline int s6a_parse_allocation_retention_priority(struct avp *avp_arp, allocation_retention_priority_t *ptr) { struct avp *avp = NULL; struct avp_hdr *hdr; /* If the Pre-emption-Capability AVP is not present in the * Allocation-Retention-Priority AVP, the default value shall be * PRE-EMPTION_CAPABILITY_DISABLED (1). */ ptr->pre_emp_capability = PRE_EMPTION_CAPABILITY_DISABLED; /* If the Pre-emption-Vulnerability AVP is not present in the * Allocation-Retention-Priority AVP, the default value shall be * PRE-EMPTION_VULNERABILITY_ENABLED (0). */ ptr->pre_emp_vulnerability = PRE_EMPTION_VULNERABILITY_ENABLED; CHECK_FCT(fd_msg_browse(avp_arp, MSG_BRW_FIRST_CHILD, &avp, NULL)); while(avp) { CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_PRIORITY_LEVEL: CHECK_FCT(s6a_parse_priority_level(hdr, &ptr->priority_level)); break; case AVP_CODE_PRE_EMPTION_CAPABILITY: CHECK_FCT(s6a_parse_pre_emp_capability(hdr, &ptr->pre_emp_capability)); break; case AVP_CODE_PRE_EMPTION_VULNERABILITY: CHECK_FCT(s6a_parse_pre_emp_vulnerability(hdr, &ptr->pre_emp_vulnerability)); break; default: return -1; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(avp, MSG_BRW_NEXT, &avp, NULL)); } return 0; }
int avp_search_child ( struct avp * msg, struct dict_object * what, struct avp ** avp ) { struct avp * nextavp; struct dict_avp_data dictdata; struct avp_hdr *avp_dst; TRACE_ENTRY("%p %p %p", msg, what, avp); *avp = NULL; CHECK_FCT( fd_dict_getval(what, &dictdata) ); /* Loop on all top AVPs */ CHECK_FCT( fd_msg_browse(msg, MSG_BRW_FIRST_CHILD, (void *)&nextavp, NULL) ); while (nextavp) { CHECK_FCT( fd_msg_avp_hdr( nextavp, &avp_dst ) ); if ( (avp_dst->avp_code == dictdata.avp_code) && (avp_dst->avp_vendor == dictdata.avp_vendor) ) { break; } /* Otherwise move to next AVP in the message */ CHECK_FCT( fd_msg_browse(nextavp, MSG_BRW_NEXT, (void *)&nextavp, NULL) ); } if (avp) *avp = nextavp; if (avp && nextavp) { struct dictionary * dict; CHECK_FCT( fd_dict_getdict( what, &dict) ); CHECK_FCT_DO( fd_msg_parse_dict( nextavp, dict, NULL ), /* nothing */ ); } if (avp || nextavp) return 0; else return ENOENT; }
static inline int s6a_parse_apn_configuration(struct avp *avp_apn_conf_prof, apn_configuration_t *apn_config) { struct avp *avp = NULL; struct avp_hdr *hdr; CHECK_FCT(fd_msg_browse(avp_apn_conf_prof, MSG_BRW_FIRST_CHILD, &avp, NULL)); while(avp) { CHECK_FCT(fd_msg_avp_hdr(avp, &hdr)); switch(hdr->avp_code) { case AVP_CODE_CONTEXT_IDENTIFIER: apn_config->context_identifier = hdr->avp_value->u32; break; case AVP_CODE_SERVED_PARTY_IP_ADDRESS: if (apn_config->nb_ip_address == 2) { DevMessage("Only two IP addresses can be provided"); } CHECK_FCT(s6a_parse_ip_address(hdr, &apn_config->ip_address[apn_config->nb_ip_address])); apn_config->nb_ip_address++; break; case AVP_CODE_PDN_TYPE: CHECK_FCT(s6a_parse_pdn_type(hdr, &apn_config->pdn_type)); break; case AVP_CODE_SERVICE_SELECTION: CHECK_FCT(s6a_parse_service_selection(hdr, apn_config->service_selection, &apn_config->service_selection_length)); break; case AVP_CODE_EPS_SUBSCRIBED_QOS_PROFILE: CHECK_FCT(s6a_parse_eps_subscribed_qos_profile(avp, &apn_config->subscribed_qos)); break; case AVP_CODE_AMBR: CHECK_FCT(s6a_parse_ambr(avp, &apn_config->ambr)); break; } /* Go to next AVP in the grouped AVP */ CHECK_FCT(fd_msg_browse(avp, MSG_BRW_NEXT, &avp, NULL)); } return 0; }