| /* (C) 2009,2010 by Holger Hans Peter Freyther <zecke@selfish.org> |
| * (C) 2009,2010 by On-Waves |
| * All Rights Reserved |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License along |
| * with this program; if not, write to the Free Software Foundation, Inc., |
| * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| * |
| */ |
| |
| #include <osmocom/gsm/gsm0808.h> |
| #include <osmocom/gsm/protocol/gsm_08_08.h> |
| #include <osmocom/gsm/gsm48.h> |
| |
| #include <arpa/inet.h> |
| |
| #define BSSMAP_MSG_SIZE 512 |
| #define BSSMAP_MSG_HEADROOM 128 |
| |
| static void put_data_16(uint8_t *data, const uint16_t val) |
| { |
| memcpy(data, &val, sizeof(val)); |
| } |
| |
| struct msgb *gsm0808_create_layer3(struct msgb *msg_l3, uint16_t nc, uint16_t cc, int lac, uint16_t _ci) |
| { |
| uint8_t *data; |
| uint8_t *ci; |
| struct msgb* msg; |
| struct gsm48_loc_area_id *lai; |
| |
| msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap cmpl l3"); |
| if (!msg) |
| return NULL; |
| |
| /* create the bssmap header */ |
| msg->l3h = msgb_put(msg, 2); |
| msg->l3h[0] = 0x0; |
| |
| /* create layer 3 header */ |
| data = msgb_put(msg, 1); |
| data[0] = BSS_MAP_MSG_COMPLETE_LAYER_3; |
| |
| /* create the cell header */ |
| data = msgb_put(msg, 3); |
| data[0] = GSM0808_IE_CELL_IDENTIFIER; |
| data[1] = 1 + sizeof(*lai) + 2; |
| data[2] = CELL_IDENT_WHOLE_GLOBAL; |
| |
| lai = (struct gsm48_loc_area_id *) msgb_put(msg, sizeof(*lai)); |
| gsm48_generate_lai(lai, cc, nc, lac); |
| |
| ci = msgb_put(msg, 2); |
| put_data_16(ci, htons(_ci)); |
| |
| /* copy the layer3 data */ |
| data = msgb_put(msg, msgb_l3len(msg_l3) + 2); |
| data[0] = GSM0808_IE_LAYER_3_INFORMATION; |
| data[1] = msgb_l3len(msg_l3); |
| memcpy(&data[2], msg_l3->l3h, data[1]); |
| |
| /* update the size */ |
| msg->l3h[1] = msgb_l3len(msg) - 2; |
| |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_reset(void) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: reset"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 6); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 0x04; |
| msg->l3h[2] = 0x30; |
| msg->l3h[3] = 0x04; |
| msg->l3h[4] = 0x01; |
| msg->l3h[5] = 0x20; |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_clear_complete(void) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: clear complete"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 3); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 1; |
| msg->l3h[2] = BSS_MAP_MSG_CLEAR_COMPLETE; |
| |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_clear_command(uint8_t reason) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: clear command"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_tv_put(msg, BSSAP_MSG_BSS_MANAGEMENT, 4); |
| msgb_v_put(msg, BSS_MAP_MSG_CLEAR_CMD); |
| msgb_tlv_put(msg, GSM0808_IE_CAUSE, 1, &reason); |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_cipher_complete(struct msgb *layer3, uint8_t alg_id) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "cipher-complete"); |
| if (!msg) |
| return NULL; |
| |
| /* send response with BSS override for A5/1... cheating */ |
| msg->l3h = msgb_put(msg, 3); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 0xff; |
| msg->l3h[2] = BSS_MAP_MSG_CIPHER_MODE_COMPLETE; |
| |
| /* include layer3 in case we have at least two octets */ |
| if (layer3 && msgb_l3len(layer3) > 2) { |
| msg->l4h = msgb_put(msg, msgb_l3len(layer3) + 2); |
| msg->l4h[0] = GSM0808_IE_LAYER_3_MESSAGE_CONTENTS; |
| msg->l4h[1] = msgb_l3len(layer3); |
| memcpy(&msg->l4h[2], layer3->l3h, msgb_l3len(layer3)); |
| } |
| |
| /* and the optional BSS message */ |
| msg->l4h = msgb_put(msg, 2); |
| msg->l4h[0] = GSM0808_IE_CHOSEN_ENCR_ALG; |
| msg->l4h[1] = alg_id; |
| |
| /* update the size */ |
| msg->l3h[1] = msgb_l3len(msg) - 2; |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_cipher_reject(uint8_t cause) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: clear complete"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 4); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 2; |
| msg->l3h[2] = BSS_MAP_MSG_CIPHER_MODE_REJECT; |
| msg->l3h[3] = cause; |
| |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_classmark_update(const uint8_t *classmark_data, uint8_t length) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "classmark-update"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 3); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 0xff; |
| msg->l3h[2] = BSS_MAP_MSG_CLASSMARK_UPDATE; |
| |
| msg->l4h = msgb_put(msg, length); |
| memcpy(msg->l4h, classmark_data, length); |
| |
| /* update the size */ |
| msg->l3h[1] = msgb_l3len(msg) - 2; |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_sapi_reject(uint8_t link_id) |
| { |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: sapi 'n' reject"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 5); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 3; |
| msg->l3h[2] = BSS_MAP_MSG_SAPI_N_REJECT; |
| msg->l3h[3] = link_id; |
| msg->l3h[4] = GSM0808_CAUSE_BSS_NOT_EQUIPPED; |
| |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_assignment_completed(uint8_t rr_cause, |
| uint8_t chosen_channel, uint8_t encr_alg_id, |
| uint8_t speech_mode) |
| { |
| uint8_t *data; |
| |
| struct msgb *msg = msgb_alloc(35, "bssmap: ass compl"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 3); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 0xff; |
| msg->l3h[2] = BSS_MAP_MSG_ASSIGMENT_COMPLETE; |
| |
| /* write 3.2.2.22 */ |
| data = msgb_put(msg, 2); |
| data[0] = GSM0808_IE_RR_CAUSE; |
| data[1] = rr_cause; |
| |
| /* write cirtcuit identity code 3.2.2.2 */ |
| /* write cell identifier 3.2.2.17 */ |
| /* write chosen channel 3.2.2.33 when BTS picked it */ |
| data = msgb_put(msg, 2); |
| data[0] = GSM0808_IE_CHOSEN_CHANNEL; |
| data[1] = chosen_channel; |
| |
| /* write chosen encryption algorithm 3.2.2.44 */ |
| data = msgb_put(msg, 2); |
| data[0] = GSM0808_IE_CHOSEN_ENCR_ALG; |
| data[1] = encr_alg_id; |
| |
| /* write circuit pool 3.2.2.45 */ |
| /* write speech version chosen: 3.2.2.51 when BTS picked it */ |
| if (speech_mode != 0) { |
| data = msgb_put(msg, 2); |
| data[0] = GSM0808_IE_SPEECH_VERSION; |
| data[1] = speech_mode; |
| } |
| |
| /* write LSA identifier 3.2.2.15 */ |
| |
| |
| /* update the size */ |
| msg->l3h[1] = msgb_l3len(msg) - 2; |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_assignment_failure(uint8_t cause, uint8_t *rr_cause) |
| { |
| uint8_t *data; |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: ass fail"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 6); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 0xff; |
| msg->l3h[2] = BSS_MAP_MSG_ASSIGMENT_FAILURE; |
| msg->l3h[3] = GSM0808_IE_CAUSE; |
| msg->l3h[4] = 1; |
| msg->l3h[5] = cause; |
| |
| /* RR cause 3.2.2.22 */ |
| if (rr_cause) { |
| data = msgb_put(msg, 2); |
| data[0] = GSM0808_IE_RR_CAUSE; |
| data[1] = *rr_cause; |
| } |
| |
| /* Circuit pool 3.22.45 */ |
| /* Circuit pool list 3.2.2.46 */ |
| |
| /* update the size */ |
| msg->l3h[1] = msgb_l3len(msg) - 2; |
| return msg; |
| } |
| |
| struct msgb *gsm0808_create_clear_rqst(uint8_t cause) |
| { |
| struct msgb *msg; |
| |
| msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "bssmap: clear rqst"); |
| if (!msg) |
| return NULL; |
| |
| msg->l3h = msgb_put(msg, 2 + 4); |
| msg->l3h[0] = BSSAP_MSG_BSS_MANAGEMENT; |
| msg->l3h[1] = 4; |
| |
| msg->l3h[2] = BSS_MAP_MSG_CLEAR_RQST; |
| msg->l3h[3] = GSM0808_IE_CAUSE; |
| msg->l3h[4] = 1; |
| msg->l3h[5] = cause; |
| return msg; |
| } |
| |
| void gsm0808_prepend_dtap_header(struct msgb *msg, uint8_t link_id) |
| { |
| uint8_t *hh = msgb_push(msg, 3); |
| hh[0] = BSSAP_MSG_DTAP; |
| hh[1] = link_id; |
| hh[2] = msg->len - 3; |
| } |
| |
| struct msgb *gsm0808_create_dtap(struct msgb *msg_l3, uint8_t link_id) |
| { |
| struct dtap_header *header; |
| uint8_t *data; |
| struct msgb *msg = msgb_alloc_headroom(BSSMAP_MSG_SIZE, BSSMAP_MSG_HEADROOM, |
| "dtap"); |
| if (!msg) |
| return NULL; |
| |
| /* DTAP header */ |
| msg->l3h = msgb_put(msg, sizeof(*header)); |
| header = (struct dtap_header *) &msg->l3h[0]; |
| header->type = BSSAP_MSG_DTAP; |
| header->link_id = link_id; |
| header->length = msgb_l3len(msg_l3); |
| |
| /* Payload */ |
| data = msgb_put(msg, header->length); |
| memcpy(data, msg_l3->l3h, header->length); |
| |
| return msg; |
| } |
| |
| static const struct tlv_definition bss_att_tlvdef = { |
| .def = { |
| [GSM0808_IE_IMSI] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_TMSI] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_CELL_IDENTIFIER_LIST] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_CHANNEL_NEEDED] = { TLV_TYPE_TV }, |
| [GSM0808_IE_EMLPP_PRIORITY] = { TLV_TYPE_TV }, |
| [GSM0808_IE_CHANNEL_TYPE] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_PRIORITY] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_CIRCUIT_IDENTITY_CODE] = { TLV_TYPE_FIXED, 2 }, |
| [GSM0808_IE_DOWNLINK_DTX_FLAG] = { TLV_TYPE_TV }, |
| [GSM0808_IE_INTERFERENCE_BAND_TO_USE] = { TLV_TYPE_TV }, |
| [GSM0808_IE_CLASSMARK_INFORMATION_T2] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_GROUP_CALL_REFERENCE] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_TALKER_FLAG] = { TLV_TYPE_T }, |
| [GSM0808_IE_CONFIG_EVO_INDI] = { TLV_TYPE_TV }, |
| [GSM0808_IE_LSA_ACCESS_CTRL_SUPPR] = { TLV_TYPE_TV }, |
| [GSM0808_IE_SERVICE_HANDOVER] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_ENCRYPTION_INFORMATION] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_CIPHER_RESPONSE_MODE] = { TLV_TYPE_TV }, |
| [GSM0808_IE_CELL_IDENTIFIER] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_CHOSEN_CHANNEL] = { TLV_TYPE_TV }, |
| [GSM0808_IE_LAYER_3_INFORMATION] = { TLV_TYPE_TLV }, |
| [GSM0808_IE_SPEECH_VERSION] = { TLV_TYPE_TV }, |
| [GSM0808_IE_CHOSEN_ENCR_ALG] = { TLV_TYPE_TV }, |
| }, |
| }; |
| |
| const struct tlv_definition *gsm0808_att_tlvdef(void) |
| { |
| return &bss_att_tlvdef; |
| } |
| |
| static const struct value_string gsm0808_msgt_names[] = { |
| { BSS_MAP_MSG_ASSIGMENT_RQST, "ASSIGNMENT REQ" }, |
| { BSS_MAP_MSG_ASSIGMENT_COMPLETE, "ASSIGNMENT COMPL" }, |
| { BSS_MAP_MSG_ASSIGMENT_FAILURE, "ASSIGNMENT FAIL" }, |
| |
| { BSS_MAP_MSG_HANDOVER_RQST, "HANDOVER REQ" }, |
| { BSS_MAP_MSG_HANDOVER_REQUIRED, "HANDOVER REQUIRED" }, |
| { BSS_MAP_MSG_HANDOVER_RQST_ACKNOWLEDGE,"HANDOVER REQ ACK" }, |
| { BSS_MAP_MSG_HANDOVER_CMD, "HANDOVER CMD" }, |
| { BSS_MAP_MSG_HANDOVER_COMPLETE, "HANDOVER COMPLETE" }, |
| { BSS_MAP_MSG_HANDOVER_SUCCEEDED, "HANDOVER SUCCESS" }, |
| { BSS_MAP_MSG_HANDOVER_FAILURE, "HANDOVER FAILURE" }, |
| { BSS_MAP_MSG_HANDOVER_PERFORMED, "HANDOVER PERFORMED" }, |
| { BSS_MAP_MSG_HANDOVER_CANDIDATE_ENQUIRE, "HANDOVER CAND ENQ" }, |
| { BSS_MAP_MSG_HANDOVER_CANDIDATE_RESPONSE, "HANDOVER CAND RESP" }, |
| { BSS_MAP_MSG_HANDOVER_REQUIRED_REJECT, "HANDOVER REQ REJ" }, |
| { BSS_MAP_MSG_HANDOVER_DETECT, "HANDOVER DETECT" }, |
| |
| { BSS_MAP_MSG_CLEAR_CMD, "CLEAR COMMAND" }, |
| { BSS_MAP_MSG_CLEAR_COMPLETE, "CLEAR COMPLETE" }, |
| { BSS_MAP_MSG_CLEAR_RQST, "CLEAR REQUEST" }, |
| { BSS_MAP_MSG_SAPI_N_REJECT, "SAPI N REJECT" }, |
| { BSS_MAP_MSG_CONFUSION, "CONFUSION" }, |
| |
| { BSS_MAP_MSG_SUSPEND, "SUSPEND" }, |
| { BSS_MAP_MSG_RESUME, "RESUME" }, |
| { BSS_MAP_MSG_CONNECTION_ORIENTED_INFORMATION, "CONN ORIENT INFO" }, |
| { BSS_MAP_MSG_PERFORM_LOCATION_RQST, "PERFORM LOC REQ" }, |
| { BSS_MAP_MSG_LSA_INFORMATION, "LSA INFORMATION" }, |
| { BSS_MAP_MSG_PERFORM_LOCATION_RESPONSE, "PERFORM LOC RESP" }, |
| { BSS_MAP_MSG_PERFORM_LOCATION_ABORT, "PERFORM LOC ABORT" }, |
| { BSS_MAP_MSG_COMMON_ID, "COMMON ID" }, |
| |
| { BSS_MAP_MSG_RESET, "RESET" }, |
| { BSS_MAP_MSG_RESET_ACKNOWLEDGE, "RESET ACK" }, |
| { BSS_MAP_MSG_OVERLOAD, "OVERLOAD" }, |
| { BSS_MAP_MSG_RESET_CIRCUIT, "RESET CIRCUIT" }, |
| { BSS_MAP_MSG_RESET_CIRCUIT_ACKNOWLEDGE, "RESET CIRCUIT ACK" }, |
| { BSS_MAP_MSG_MSC_INVOKE_TRACE, "MSC INVOKE TRACE" }, |
| { BSS_MAP_MSG_BSS_INVOKE_TRACE, "BSS INVOKE TRACE" }, |
| { BSS_MAP_MSG_CONNECTIONLESS_INFORMATION, "CONNLESS INFO" }, |
| |
| { BSS_MAP_MSG_BLOCK, "BLOCK" }, |
| { BSS_MAP_MSG_BLOCKING_ACKNOWLEDGE, "BLOCK ACK" }, |
| { BSS_MAP_MSG_UNBLOCK, "UNBLOCK" }, |
| { BSS_MAP_MSG_UNBLOCKING_ACKNOWLEDGE, "UNBLOCK ACK" }, |
| { BSS_MAP_MSG_CIRCUIT_GROUP_BLOCK, "CIRC GROUP BLOCK" }, |
| { BSS_MAP_MSG_CIRCUIT_GROUP_BLOCKING_ACKNOWLEDGE, "CIRC GORUP BLOCK ACK" }, |
| { BSS_MAP_MSG_CIRCUIT_GROUP_UNBLOCK, "CIRC GROUP UNBLOCK" }, |
| { BSS_MAP_MSG_CIRCUIT_GROUP_UNBLOCKING_ACKNOWLEDGE, "CIRC GROUP UNBLOCK ACK" }, |
| { BSS_MAP_MSG_UNEQUIPPED_CIRCUIT, "UNEQUIPPED CIRCUIT" }, |
| { BSS_MAP_MSG_CHANGE_CIRCUIT, "CHANGE CIRCUIT" }, |
| { BSS_MAP_MSG_CHANGE_CIRCUIT_ACKNOWLEDGE, "CHANGE CIRCUIT ACK" }, |
| |
| { BSS_MAP_MSG_RESOURCE_RQST, "RESOURCE REQ" }, |
| { BSS_MAP_MSG_RESOURCE_INDICATION, "RESOURCE IND" }, |
| { BSS_MAP_MSG_PAGING, "PAGING" }, |
| { BSS_MAP_MSG_CIPHER_MODE_CMD, "CIPHER MODE CMD" }, |
| { BSS_MAP_MSG_CLASSMARK_UPDATE, "CLASSMARK UPDATE" }, |
| { BSS_MAP_MSG_CIPHER_MODE_COMPLETE, "CIPHER MODE COMPLETE" }, |
| { BSS_MAP_MSG_QUEUING_INDICATION, "QUEUING INDICATION" }, |
| { BSS_MAP_MSG_COMPLETE_LAYER_3, "COMPLETE LAYER 3" }, |
| { BSS_MAP_MSG_CLASSMARK_RQST, "CLASSMARK REQ" }, |
| { BSS_MAP_MSG_CIPHER_MODE_REJECT, "CIPHER MODE REJECT" }, |
| { BSS_MAP_MSG_LOAD_INDICATION, "LOAD IND" }, |
| |
| /* FIXME: VGCS/VBS */ |
| |
| { 0, NULL } |
| }; |
| |
| const char *gsm0808_bssmap_name(uint8_t msg_type) |
| { |
| return get_value_string(gsm0808_msgt_names, msg_type); |
| } |
| |
| static const struct value_string gsm0808_bssap_names[] = { |
| { BSSAP_MSG_BSS_MANAGEMENT, "MANAGEMENT" }, |
| { BSSAP_MSG_DTAP, "DTAP" }, |
| }; |
| |
| const char *gsm0808_bssap_name(uint8_t msg_type) |
| { |
| return get_value_string(gsm0808_bssap_names, msg_type); |
| } |