fc-magnetite: src/g23m-gprs/sm/sm

author	Mychaela Falconia <falcon@freecalypso.org>
date	Mon, 17 Jun 2019 01:36:38 +0000 (2019-06-17)
parents	219afcfc6250
children

rev	line source
183 219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 \| Project : 3G PS
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Module : SM
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 +-----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 \| Copyright 2003 Texas Instruments.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| All rights reserved.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \| This file is confidential and a trade secret of Texas
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| Instruments .
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| The receipt of or possession of this file does not convey
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| any rights to reproduce or disclose its contents or to
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| manufacture, use, or sell anything it may describe, in
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| whole, or in part, without the specific written consent of
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| Texas Instruments.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 +-----------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 \| Purpose: 3G TFT utility functions implementation in the SM entity.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| For design details, see:
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| 8010.908 SM Detailed Specification
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 +---------------------------------------------------------------------------*/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 /==== DECLARATION CONTROL =================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 /==== INCLUDES ============================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #include "sm.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include "sm_tft.h"
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 /==== CONST ===============================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 /==== LOCAL VARS ===========================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 /==== PRIVATE FUNCTIONS ====================================================/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 \| Function : sm_tft_count_tfts_in_mask
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 \| Description : Returns the number of filters (set bits) in a TFT mask.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 \| Parameters : tft_mask - TFT mask
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 static U8 sm_tft_count_tfts_in_mask(U8 tft_mask) /@/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 U8 count_array[16] = {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 (U8)0 /* 0000 /, (U8)1 / 0001 /, (U8)1 / 0010 /, (U8)2 / 0011 */,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 (U8)1 /* 0100 /, (U8)2 / 0101 /, (U8)2 / 0110 /, (U8)3 / 0111 */,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 (U8)1 /* 1000 /, (U8)2 / 1001 /, (U8)2 / 1010 /, (U8)3 / 1011 */,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 (U8)2 /* 1100 /, (U8)3 / 1101 /, (U8)3 / 1110 /, (U8)4 / 1111 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 };
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 return (count_array[(U16)tft_mask >> 4] + count_array[(U16)tft_mask & 15]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 \| Function : sm_tft_is_tft_in_mask
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 \| Description : Returns TRUE if the TFT with the specified ID (bit) is
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 \| set in the specified TFT mask.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 \| Parameters : id - TFT identifier
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 \| tft_mask - TFT mask
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 static BOOL sm_tft_is_tft_in_mask(U8 id, U8 tft_mask) /@/
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 return ((tft_mask & (1UL << id)) != 0);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 \| Function : sm_tft_is_port_range
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 \| Description : Query function returning TRUE if high_limit is not zero, and
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 \| high_limit is greater than (but not equal) to low_limit.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 \| Parameters : low_limit - lower port limit
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 \| high_limit - upper port limit
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 static BOOL sm_tft_is_port_range(U16 low_limit, U16 high_limit)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 return (high_limit != 0 && low_limit < high_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 static /@exposed@/T_NAS_tft_pf *
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 sm_tft_get_active_tft_by_id(/@returned@/ /@partial@/struct T_SM_CONTEXT_DATA *context,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 U8 id)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 TRACE_ASSERT(id < (U8)NAS_SIZE_TFT_FILTER);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 TRACE_ASSERT(context->active_tft.ptr_tft_pf != NULL);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 return (&context->active_tft.ptr_tft_pf[id]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 \| Function : sm_tft_pf_size
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 \| Description : Query function returning the packed size of a packet filter.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 \| Parameters : tft_pf - packet filter
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 static U16 sm_tft_pf_size(T_NAS_tft_pf *tft_pf)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 U16 tft_pf_size = (U16)3; /* Filter ID, precedence and length octet mandatory */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 U16 lower3bits[8] = {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 (U16) 0, /* 0x00: None */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 (U16) 9, /* 0x01: IPv4_SRC_ADDR_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 (U16) 33, /* 0x02: IPv6_SRC_ADDR_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 (U16) 0, /* 0x03: IPv4_SRC_ADDR_MASK + IPv6_SRC_ADDR_MASK -- INVALID! */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 (U16) 3, /* 0x04: PROTOCOL_OR_NEXT_HDR */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 (U16) 12, /* 0x05: IPv4_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 (U16) 36, /* 0x06: IPv6_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 (U16) 0 /* 0x07: IPv4_SRC_ADDR_MASK + IPv6_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR -- INVALID! */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 };
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 U16 upper3bits[8] = {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 (U16) 0, /* 0x00: None */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 (U16) 5, /* 0x20: IPSEC_SPI */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 (U16) 3, /* 0x40: TOS_AND_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 (U16) 5, /* 0x60: IPSEC_SPI + TOS_AND_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 (U16) 4, /* 0x80: FLOW_LABEL */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 (U16) 0, /* 0xa0: IPSEC_SPI + FLOW_LABEL - INVALID! */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 (U16) 7, /* 0xc0: TOS_AND_MASK + FLOW_LABEL */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 (U16) 0 /* 0xe0: IPSEC_SPI + TOS_AND_MASK + FLOW_LABEL - INVALID! */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 };
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 if ((tft_pf->tft_pf_valid_bits & (U8)0x07) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 tft_pf_size += lower3bits[(U16)tft_pf->tft_pf_valid_bits & 0x07];
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 if ((tft_pf->tft_pf_valid_bits & (U8)0xe0) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 tft_pf_size += upper3bits[(U16)tft_pf->tft_pf_valid_bits >> 5];
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 if ((tft_pf->tft_pf_valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 T_NAS_tft_dest_port_range *range = &tft_pf->tft_pf_entry.tft_pf_ipv4.tft_dest_port_range;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 if (sm_tft_is_port_range(range->low_limit, range->high_limit))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 tft_pf_size += (U16)5; /* Destination port range */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 tft_pf_size += (U16)3; /* Single destination port */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 if ((tft_pf->tft_pf_valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 T_NAS_tft_src_port_range *range = &tft_pf->tft_pf_entry.tft_pf_ipv4.tft_src_port_range;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 if (sm_tft_is_port_range(range->low_limit, range->high_limit))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 tft_pf_size += (U16)5; /* Source port range */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 tft_pf_size += (U16)3; /* Single source port */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 return tft_pf_size;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 \| Function : sm_tft_are_equal
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 \| Description : Query function returning TRUE if the two input packet filters
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 \| are equal (same parameters).
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 \| Parameters : tft1 - packet filter 1
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 \| tft2 - packet filter 2
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 static BOOL sm_tft_are_equal(T_NAS_tft_pf tft1, T_NAS_tft_pf tft2)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 U8 valid_bits;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 /* Compare outer-level parameters */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 if (tft1->tft_pf_id != tft2->tft_pf_id \|\|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 tft1->tft_pf_precedence != tft2->tft_pf_precedence \|\|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 tft1->tft_pf_valid_bits != tft2->tft_pf_valid_bits \|\|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 tft1->ctrl_tft_pf_entry != tft2->ctrl_tft_pf_entry)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 return FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 valid_bits = tft1->tft_pf_valid_bits;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 if (tft1->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv4) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 T_NAS_tft_pf_ipv4 *v4_pf_1 = &tft1->tft_pf_entry.tft_pf_ipv4;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 T_NAS_tft_pf_ipv4 *v4_pf_2 = &tft2->tft_pf_entry.tft_pf_ipv4;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 if (((valid_bits & (U8)NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 && v4_pf_1->tft_protocol != v4_pf_2->tft_protocol)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 \|\| ((valid_bits & (U8)NAS_TFT_ID_TOS_AND_MASK) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 && v4_pf_1->tft_tos_and_mask.tos_value != v4_pf_2->tft_tos_and_mask.tos_value
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 && v4_pf_1->tft_tos_and_mask.tos_mask != v4_pf_2->tft_tos_and_mask.tos_mask)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 \|\| ((valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 && memcmp(&v4_pf_1->tft_dest_port_range, &v4_pf_2->tft_dest_port_range, sizeof(T_NAS_tft_dest_port_range)) != 0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 \|\| ((valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 && memcmp(&v4_pf_1->tft_src_port_range, &v4_pf_2->tft_src_port_range, sizeof(T_NAS_tft_src_port_range)) != 0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPSEC_SPI) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 && v4_pf_1->tft_ipsec_spi != v4_pf_2->tft_ipsec_spi)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPv4_SRC_ADDR_MASK) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 && memcmp(&v4_pf_1->tft_ipv4_src_addr_mask, &v4_pf_2->tft_ipv4_src_addr_mask, sizeof(T_NAS_tft_ipv4_src_addr_mask)) != 0))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 return FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 } else if (tft1->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv6)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 T_NAS_tft_pf_ipv6 *v6_pf_1 = &tft1->tft_pf_entry.tft_pf_ipv6;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 T_NAS_tft_pf_ipv6 *v6_pf_2 = &tft2->tft_pf_entry.tft_pf_ipv6;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 if (((valid_bits & (U8)NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 && v6_pf_1->tft_next_hdr != v6_pf_2->tft_next_hdr)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 \|\| ((valid_bits & (U8)NAS_TFT_ID_TOS_AND_MASK) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 && v6_pf_1->tft_tos_and_mask.tos_value != v6_pf_2->tft_tos_and_mask.tos_value
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 && v6_pf_1->tft_tos_and_mask.tos_mask != v6_pf_2->tft_tos_and_mask.tos_mask)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 \|\| ((valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 && memcmp(&v6_pf_1->tft_dest_port_range, &v6_pf_2->tft_dest_port_range, sizeof(T_NAS_tft_dest_port_range)) != 0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 \|\| ((valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 && memcmp(&v6_pf_1->tft_src_port_range, &v6_pf_2->tft_src_port_range, sizeof(T_NAS_tft_src_port_range)) != 0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPSEC_SPI) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 && v6_pf_1->tft_ipsec_spi != v6_pf_2->tft_ipsec_spi)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 \|\| ((valid_bits & (U8)NAS_TFT_ID_FLOW_LABEL) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 && v6_pf_1->tft_flow_label != v6_pf_2->tft_flow_label)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPv6_SRC_ADDR_MASK) != (U8)0
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 && memcmp(&v6_pf_1->tft_ipv6_src_addr_mask, &v6_pf_2->tft_ipv6_src_addr_mask, sizeof(T_NAS_tft_ipv6_src_addr_mask)) != 0))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 return FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 (void)TRACE_EVENT_P1("ERROR: Invalid union controller %d in ctrl_tft_pf_entry!",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 tft1->ctrl_tft_pf_entry);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 return TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 \| Function : sm_tft_copy_ipv4_pf
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 \| Description : Copies an IPv4 TFT filter from src_tft to dst_tft AIM struct.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 \| Parameters : dst_tft - destination aim TFT structs
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 \| src_tft - source TFT structs
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 \| valid_flag - valid flags for filter components
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 static void sm_tft_copy_ipsec_spi(/@out@/T_M_SM_tft_ipsec_spi *dst_spi,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 U32 spi)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 M_SM_BUF_ipsec_spi_value *dst = &dst_spi->ipsec_spi_value;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 (void)TRACE_EVENT_P1("tft_copy: Copying IPSEC SPI filter (SPI 0x%08x)", spi);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 dst->l_ipsec_spi_value = (U16)32;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 dst->o_ipsec_spi_value = (U16)0;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 dst->b_ipsec_spi_value[0] = (U8)((spi >> 24) & 255);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 dst->b_ipsec_spi_value[1] = (U8)((spi >> 16) & 255);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 dst->b_ipsec_spi_value[2] = (U8)((spi >> 8) & 255);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 dst->b_ipsec_spi_value[3] = (U8)( spi & 255);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 static void
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 sm_tft_copy_ipv4_pf(/@out@/ T_M_SM_tft_filter_entry *dst,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 T_NAS_tft_pf_ipv4 *src, U8 valid_flag)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 /* Copy IPv4 address, if present */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 if ((valid_flag & NAS_TFT_ID_IPv4_SRC_ADDR_MASK) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 dst->v_tft_ipv4_addr_mask = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 memcpy(dst->tft_ipv4_addr_mask.src_addr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 src->tft_ipv4_src_addr_mask.tft_ipv4_addr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 (size_t)NAS_SIZE_IPv4_ADDR);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 memcpy(dst->tft_ipv4_addr_mask.addr_mask,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 src->tft_ipv4_src_addr_mask.tft_ipv4_mask,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 (size_t)NAS_SIZE_IPv4_ADDR);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 U8 addr, mask;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 addr = dst->tft_ipv4_addr_mask.src_addr;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 mask = dst->tft_ipv4_addr_mask.addr_mask;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 (void)TRACE_EVENT_P8("tft_copy: Copy IPv4 src addr/mask filter: "
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 "%u.%u.%u.%u/%u.%u.%u.%u",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 addr[0], addr[1], addr[2], addr[3],
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 mask[0], mask[1], mask[2], mask[3]);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 dst->v_tft_ipv4_addr_mask = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 } /* NAS_TFT_ID_IPv4_SRC_ADDR_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 /* IPv6 addr/mask never invluded in IPv4 packet filter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 dst->v_tft_ipv6_addr_mask = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 /* Copy IPv4 protocol number field */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 if ((valid_flag & NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 dst->v_tft_protocol = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 dst->tft_protocol.tft_protocol_val = src->tft_protocol;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 (void)TRACE_EVENT_P1("tft_copy: Copy IPv4 protocol: 0x%02x",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 src->tft_protocol);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 dst->v_tft_protocol = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 } /* NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 /* Copy destination single port/port range parameter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 if ((valid_flag & NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 T_NAS_tft_dest_port_range *port_range = &src->tft_dest_port_range;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit)) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 dst->v_tft_dest_port_range = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 dst->v_tft_dest_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 dst->tft_dest_port_range.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 dst->tft_dest_port_range.high_limit = port_range->high_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 (void)TRACE_EVENT_P2("tft_copy: Copying destination port range filter (ports %d-%d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 port_range->low_limit, port_range->high_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 dst->v_tft_dest_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 dst->v_tft_dest_port = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 dst->tft_dest_port.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 (void)TRACE_EVENT_P1("tft_copy: Copying single destination port filter (port %d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 port_range->low_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 dst->v_tft_dest_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 dst->v_tft_dest_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 } /* NAS_TFT_ID_DEST_PORT_RANGE */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 /* Copy source single port/port range parameter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 if ((valid_flag & NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 T_NAS_tft_src_port_range *port_range = &src->tft_src_port_range;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 dst->v_tft_src_port_range = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 dst->v_tft_src_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 dst->tft_src_port_range.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 dst->tft_src_port_range.high_limit = port_range->high_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 (void)TRACE_EVENT_P2("tft_copy: Copying source port range filter (ports %d-%d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 port_range->low_limit, port_range->high_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 dst->v_tft_src_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 dst->v_tft_src_port = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 dst->tft_src_port.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 (void)TRACE_EVENT_P1("tft_copy: Copying single source port filter (port %d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 port_range->low_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 dst->v_tft_src_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 dst->v_tft_src_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 } /* NAS_TFT_ID_SRC_PORT_RANGE */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 if ((valid_flag & NAS_TFT_ID_IPSEC_SPI) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 dst->v_tft_ipsec_spi = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 sm_tft_copy_ipsec_spi(&dst->tft_ipsec_spi, src->tft_ipsec_spi);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 dst->v_tft_ipsec_spi = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 }/* NAS_TFT_ID_IPSEC_SPI */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 if ((valid_flag & NAS_TFT_ID_TOS_AND_MASK) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 dst->v_tft_tos_and_mask = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 dst->tft_tos_and_mask.tos_value = src->tft_tos_and_mask.tos_value;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 dst->tft_tos_and_mask.tos_mask = src->tft_tos_and_mask.tos_mask;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 dst->v_tft_tos_and_mask = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 } /* NAS_TFT_ID_TOS_AND_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 if ((valid_flag & NAS_TFT_ID_FLOW_LABEL) != (U8)0) {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 (void)TRACE_ERROR("tft_copy: Found flow label in IPv4 packet filter - Discarded...");
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 } /* NAS_TFT_ID_FLOW_LABEL */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 dst->v_tft_flow_label = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 /*
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 \| Function : sm_tft_copy_ipv6_pf
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 \| Description : Copies an IPv6 TFT filter from src_tft to dst_tft AIM struct.
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 \|
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 \| Parameters : dst_tft - destination aim TFT structs
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 \| src_tft - source TFT structs
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 \| valid_flag - valid flags for filter components
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 +------------------------------------------------------------------------------
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 static void
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 sm_tft_copy_ipv6_pf(/@out@/ T_M_SM_tft_filter_entry *dst,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 T_NAS_tft_pf_ipv6 *src, U8 valid_flag)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 /* IPv4 addr/mask never invluded in IPv4 packet filter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 dst->v_tft_ipv4_addr_mask = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 /* Copy IPv6 address, if present */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 if ((valid_flag & NAS_TFT_ID_IPv6_SRC_ADDR_MASK) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 dst->v_tft_ipv6_addr_mask = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 memcpy(dst->tft_ipv6_addr_mask.src_addr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 src->tft_ipv6_src_addr_mask.tft_ipv6_addr,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 (size_t)NAS_SIZE_IPv6_ADDR);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 memcpy(dst->tft_ipv6_addr_mask.addr_mask,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 src->tft_ipv6_src_addr_mask.tft_ipv6_mask,
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 (size_t)NAS_SIZE_IPv6_ADDR);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 /* Dump address/mask */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 char addr[SM_SIZE_FORMATTED_IPv6_ADDR], mask[SM_SIZE_FORMATTED_IPv6_ADDR];
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 (void)TRACE_EVENT_P2("tft_copy: Copy IPv6 src addr/mask filter: %s/%s",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 sm_format_ipv6_addr(dst->tft_ipv6_addr_mask.src_addr, addr),
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 sm_format_ipv6_addr(dst->tft_ipv6_addr_mask.addr_mask, mask));
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 dst->v_tft_ipv6_addr_mask = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 } /* NAS_TFT_ID_IPv6_SRC_ADDR_MASK */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 /* Copy IPv6 next header field */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 if ((valid_flag & NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 dst->v_tft_protocol = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 dst->tft_protocol.tft_protocol_val = src->tft_next_hdr;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 (void)TRACE_EVENT_P1("tft_copy: Copy IPv6 next header field: 0x%02x",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 src->tft_next_hdr);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 dst->v_tft_protocol = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 } /* NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 /* Copy destination single port/port range parameter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 if ((valid_flag & NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 T_NAS_tft_dest_port_range *port_range = &src->tft_dest_port_range;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 dst->v_tft_dest_port_range = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 dst->v_tft_dest_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 dst->tft_dest_port_range.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 dst->tft_dest_port_range.high_limit = port_range->high_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 (void)TRACE_EVENT_P2("tft_copy: Copying destination port range filter (ports %d-%d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 port_range->low_limit, port_range->high_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 dst->v_tft_dest_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 dst->v_tft_dest_port = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 dst->tft_dest_port.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 (void)TRACE_EVENT_P1("tft_copy: Copying single destination port filter (port %d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 port_range->low_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 dst->v_tft_dest_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 dst->v_tft_dest_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 } /* NAS_TFT_ID_DEST_PORT_RANGE */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 /* Copy source single port/port range parameter */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 if ((valid_flag & NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 T_NAS_tft_src_port_range *port_range = &src->tft_src_port_range;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 dst->v_tft_src_port_range = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 dst->v_tft_src_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 dst->tft_src_port_range.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 dst->tft_src_port_range.high_limit = port_range->high_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 (void)TRACE_EVENT_P2("tft_copy: Copying source port range filter (ports %d-%d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 port_range->low_limit, port_range->high_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 dst->v_tft_src_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 dst->v_tft_src_port = (U8)TRUE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 dst->tft_src_port.low_limit = port_range->low_limit;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 #ifdef TFT_DEBUG
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 (void)TRACE_EVENT_P1("tft_copy: Copying single source port filter (port %d)",
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 port_range->low_limit);
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 #endif
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 }
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 } else {
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 dst->v_tft_src_port_range = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 dst->v_tft_src_port = (U8)FALSE;
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 } /* NAS_TFT_ID_SRC_PORT_RANGE */
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499
219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 if ((valid_flag & NAS_TFT_ID_IPSEC_SPI) != (U8)0)

183

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1 /*----------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2 | Project : 3G PS

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3 | Module : SM

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

4 +-----------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

7 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

8 | This file is confidential and a trade secret of Texas

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

9 | Instruments .

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

10 | The receipt of or possession of this file does not convey

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

11 | any rights to reproduce or disclose its contents or to

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

12 | manufacture, use, or sell anything it may describe, in

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

13 | whole, or in part, without the specific written consent of

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

14 | Texas Instruments.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

15 +-----------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

16 | Purpose: 3G TFT utility functions implementation in the SM entity.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

17 | For design details, see:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

18 | 8010.908 SM Detailed Specification

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

19 +---------------------------------------------------------------------------*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

20

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

21 /*==== DECLARATION CONTROL =================================================*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

22

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

23 /*==== INCLUDES ============================================================*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

24

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

25 #include "sm.h"

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

26

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

27 #include "sm_tft.h"

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

28

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

29 /*==== CONST ===============================================================*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

30

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

31 /*==== LOCAL VARS ===========================================================*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

32

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

33 /*==== PRIVATE FUNCTIONS ====================================================*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

34

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

35 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

36 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

37 | Function : sm_tft_count_tfts_in_mask

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

38 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

39 | Description : Returns the number of filters (set bits) in a TFT mask.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

40 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

41 | Parameters : tft_mask - TFT mask

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

42 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

43 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

44 static U8 sm_tft_count_tfts_in_mask(U8 tft_mask) /*@*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

45 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

46 U8 count_array[16] = {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

47 (U8)0 /* 0000 */, (U8)1 /* 0001 */, (U8)1 /* 0010 */, (U8)2 /* 0011 */,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

48 (U8)1 /* 0100 */, (U8)2 /* 0101 */, (U8)2 /* 0110 */, (U8)3 /* 0111 */,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

49 (U8)1 /* 1000 */, (U8)2 /* 1001 */, (U8)2 /* 1010 */, (U8)3 /* 1011 */,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

50 (U8)2 /* 1100 */, (U8)3 /* 1101 */, (U8)3 /* 1110 */, (U8)4 /* 1111 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

51 };

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

52 return (count_array[(U16)tft_mask >> 4] + count_array[(U16)tft_mask & 15]);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

54

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

55 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

56 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

57 | Function : sm_tft_is_tft_in_mask

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

58 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

59 | Description : Returns TRUE if the TFT with the specified ID (bit) is

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

60 | set in the specified TFT mask.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

61 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

62 | Parameters : id - TFT identifier

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

63 | tft_mask - TFT mask

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

64 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

65 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

66 static BOOL sm_tft_is_tft_in_mask(U8 id, U8 tft_mask) /*@*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

67 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

68 return ((tft_mask & (1UL << id)) != 0);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

69 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

70

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

71 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

72 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

73 | Function : sm_tft_is_port_range

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

74 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

75 | Description : Query function returning TRUE if high_limit is not zero, and

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

76 | high_limit is greater than (but not equal) to low_limit.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

77 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

78 | Parameters : low_limit - lower port limit

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

79 | high_limit - upper port limit

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

80 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

81 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

82 static BOOL sm_tft_is_port_range(U16 low_limit, U16 high_limit)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

83 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

84 return (high_limit != 0 && low_limit < high_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

85 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

86

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

87 static /*@exposed@*/T_NAS_tft_pf *

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

88 sm_tft_get_active_tft_by_id(/*@returned@*/ /*@partial@*/struct T_SM_CONTEXT_DATA *context,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

89 U8 id)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

91 TRACE_ASSERT(id < (U8)NAS_SIZE_TFT_FILTER);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

92 TRACE_ASSERT(context->active_tft.ptr_tft_pf != NULL);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

93 return (&context->active_tft.ptr_tft_pf[id]);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

94 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

95

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

96 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

97 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

98 | Function : sm_tft_pf_size

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

99 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

100 | Description : Query function returning the packed size of a packet filter.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

101 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

102 | Parameters : tft_pf - packet filter

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

103 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

104 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

105 static U16 sm_tft_pf_size(T_NAS_tft_pf *tft_pf)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

106 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

107 U16 tft_pf_size = (U16)3; /* Filter ID, precedence and length octet mandatory */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

108

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

109 U16 lower3bits[8] = {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

110 (U16) 0, /* 0x00: None */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

111 (U16) 9, /* 0x01: IPv4_SRC_ADDR_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

112 (U16) 33, /* 0x02: IPv6_SRC_ADDR_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

113 (U16) 0, /* 0x03: IPv4_SRC_ADDR_MASK + IPv6_SRC_ADDR_MASK -- INVALID! */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

114 (U16) 3, /* 0x04: PROTOCOL_OR_NEXT_HDR */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

115 (U16) 12, /* 0x05: IPv4_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

116 (U16) 36, /* 0x06: IPv6_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

117 (U16) 0 /* 0x07: IPv4_SRC_ADDR_MASK + IPv6_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR -- INVALID! */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

118 };

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

119 U16 upper3bits[8] = {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

120 (U16) 0, /* 0x00: None */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

121 (U16) 5, /* 0x20: IPSEC_SPI */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

122 (U16) 3, /* 0x40: TOS_AND_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

123 (U16) 5, /* 0x60: IPSEC_SPI + TOS_AND_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

124 (U16) 4, /* 0x80: FLOW_LABEL */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

125 (U16) 0, /* 0xa0: IPSEC_SPI + FLOW_LABEL - INVALID! */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

126 (U16) 7, /* 0xc0: TOS_AND_MASK + FLOW_LABEL */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

127 (U16) 0 /* 0xe0: IPSEC_SPI + TOS_AND_MASK + FLOW_LABEL - INVALID! */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

128 };

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

129

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

130 if ((tft_pf->tft_pf_valid_bits & (U8)0x07) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

131 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

132 tft_pf_size += lower3bits[(U16)tft_pf->tft_pf_valid_bits & 0x07];

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

133 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

134

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

135 if ((tft_pf->tft_pf_valid_bits & (U8)0xe0) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

136 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

137 tft_pf_size += upper3bits[(U16)tft_pf->tft_pf_valid_bits >> 5];

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

138 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

139

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

140 if ((tft_pf->tft_pf_valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

141 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

142 T_NAS_tft_dest_port_range *range = &tft_pf->tft_pf_entry.tft_pf_ipv4.tft_dest_port_range;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

143 if (sm_tft_is_port_range(range->low_limit, range->high_limit))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

144 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

145 tft_pf_size += (U16)5; /* Destination port range */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

146 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

147 tft_pf_size += (U16)3; /* Single destination port */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

148 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

149 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

150

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

151 if ((tft_pf->tft_pf_valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

152 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

153 T_NAS_tft_src_port_range *range = &tft_pf->tft_pf_entry.tft_pf_ipv4.tft_src_port_range;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

154 if (sm_tft_is_port_range(range->low_limit, range->high_limit))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

155 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

156 tft_pf_size += (U16)5; /* Source port range */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

157 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

158 tft_pf_size += (U16)3; /* Single source port */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

159 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

160 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

161

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

162 return tft_pf_size;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

163 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

164

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

165 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

166 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

167 | Function : sm_tft_are_equal

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

168 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

169 | Description : Query function returning TRUE if the two input packet filters

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

170 | are equal (same parameters).

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

171 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

172 | Parameters : tft1 - packet filter 1

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

173 | tft2 - packet filter 2

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

174 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

175 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

176 static BOOL sm_tft_are_equal(T_NAS_tft_pf *tft1, T_NAS_tft_pf *tft2)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

177 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

178 U8 valid_bits;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

179

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

180 /* Compare outer-level parameters */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

181 if (tft1->tft_pf_id != tft2->tft_pf_id ||

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

182 tft1->tft_pf_precedence != tft2->tft_pf_precedence ||

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

183 tft1->tft_pf_valid_bits != tft2->tft_pf_valid_bits ||

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

184 tft1->ctrl_tft_pf_entry != tft2->ctrl_tft_pf_entry)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

185 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

186 return FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

187 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

188

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

189 valid_bits = tft1->tft_pf_valid_bits;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

190

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

191 if (tft1->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv4) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

192 T_NAS_tft_pf_ipv4 *v4_pf_1 = &tft1->tft_pf_entry.tft_pf_ipv4;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

193 T_NAS_tft_pf_ipv4 *v4_pf_2 = &tft2->tft_pf_entry.tft_pf_ipv4;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

194

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

195 if (((valid_bits & (U8)NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

196 && v4_pf_1->tft_protocol != v4_pf_2->tft_protocol)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

197 || ((valid_bits & (U8)NAS_TFT_ID_TOS_AND_MASK) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

198 && v4_pf_1->tft_tos_and_mask.tos_value != v4_pf_2->tft_tos_and_mask.tos_value

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

199 && v4_pf_1->tft_tos_and_mask.tos_mask != v4_pf_2->tft_tos_and_mask.tos_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

200 || ((valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

201 && memcmp(&v4_pf_1->tft_dest_port_range, &v4_pf_2->tft_dest_port_range, sizeof(T_NAS_tft_dest_port_range)) != 0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

202 || ((valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

203 && memcmp(&v4_pf_1->tft_src_port_range, &v4_pf_2->tft_src_port_range, sizeof(T_NAS_tft_src_port_range)) != 0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

204 || ((valid_bits & (U8)NAS_TFT_ID_IPSEC_SPI) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

205 && v4_pf_1->tft_ipsec_spi != v4_pf_2->tft_ipsec_spi)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

206 || ((valid_bits & (U8)NAS_TFT_ID_IPv4_SRC_ADDR_MASK) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

207 && memcmp(&v4_pf_1->tft_ipv4_src_addr_mask, &v4_pf_2->tft_ipv4_src_addr_mask, sizeof(T_NAS_tft_ipv4_src_addr_mask)) != 0))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

208 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

209 return FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

210 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

211 } else if (tft1->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv6)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

212 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

213 T_NAS_tft_pf_ipv6 *v6_pf_1 = &tft1->tft_pf_entry.tft_pf_ipv6;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

214 T_NAS_tft_pf_ipv6 *v6_pf_2 = &tft2->tft_pf_entry.tft_pf_ipv6;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

215

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

216 if (((valid_bits & (U8)NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

217 && v6_pf_1->tft_next_hdr != v6_pf_2->tft_next_hdr)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

218 || ((valid_bits & (U8)NAS_TFT_ID_TOS_AND_MASK) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219 && v6_pf_1->tft_tos_and_mask.tos_value != v6_pf_2->tft_tos_and_mask.tos_value

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

220 && v6_pf_1->tft_tos_and_mask.tos_mask != v6_pf_2->tft_tos_and_mask.tos_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

221 || ((valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

222 && memcmp(&v6_pf_1->tft_dest_port_range, &v6_pf_2->tft_dest_port_range, sizeof(T_NAS_tft_dest_port_range)) != 0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

223 || ((valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

224 && memcmp(&v6_pf_1->tft_src_port_range, &v6_pf_2->tft_src_port_range, sizeof(T_NAS_tft_src_port_range)) != 0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

225 || ((valid_bits & (U8)NAS_TFT_ID_IPSEC_SPI) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

226 && v6_pf_1->tft_ipsec_spi != v6_pf_2->tft_ipsec_spi)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

227 || ((valid_bits & (U8)NAS_TFT_ID_FLOW_LABEL) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

228 && v6_pf_1->tft_flow_label != v6_pf_2->tft_flow_label)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

229 || ((valid_bits & (U8)NAS_TFT_ID_IPv6_SRC_ADDR_MASK) != (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

230 && memcmp(&v6_pf_1->tft_ipv6_src_addr_mask, &v6_pf_2->tft_ipv6_src_addr_mask, sizeof(T_NAS_tft_ipv6_src_addr_mask)) != 0))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

231 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

232 return FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

233 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

234 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

235 (void)TRACE_EVENT_P1("ERROR: Invalid union controller %d in ctrl_tft_pf_entry!",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

236 tft1->ctrl_tft_pf_entry);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

237 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

238 return TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

239 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

240

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

241 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

242 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

243 | Function : sm_tft_copy_ipv4_pf

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

244 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

245 | Description : Copies an IPv4 TFT filter from src_tft to dst_tft AIM struct.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

246 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

247 | Parameters : dst_tft - destination aim TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

248 | src_tft - source TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

249 | valid_flag - valid flags for filter components

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

250 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

251 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

252 static void sm_tft_copy_ipsec_spi(/*@out@*/T_M_SM_tft_ipsec_spi *dst_spi,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

253 U32 spi)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

254 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

255 M_SM_BUF_ipsec_spi_value *dst = &dst_spi->ipsec_spi_value;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

256 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

257 (void)TRACE_EVENT_P1("tft_copy: Copying IPSEC SPI filter (SPI 0x%08x)", spi);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

258 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

259 dst->l_ipsec_spi_value = (U16)32;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

260 dst->o_ipsec_spi_value = (U16)0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

261 dst->b_ipsec_spi_value[0] = (U8)((spi >> 24) & 255);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

262 dst->b_ipsec_spi_value[1] = (U8)((spi >> 16) & 255);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

263 dst->b_ipsec_spi_value[2] = (U8)((spi >> 8) & 255);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

264 dst->b_ipsec_spi_value[3] = (U8)( spi & 255);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

265 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

266

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

267 static void

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

268 sm_tft_copy_ipv4_pf(/*@out@*/ T_M_SM_tft_filter_entry *dst,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

269 T_NAS_tft_pf_ipv4 *src, U8 valid_flag)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

270 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

271 /* Copy IPv4 address, if present */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

272 if ((valid_flag & NAS_TFT_ID_IPv4_SRC_ADDR_MASK) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

273 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

274 dst->v_tft_ipv4_addr_mask = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

275 memcpy(dst->tft_ipv4_addr_mask.src_addr,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

276 src->tft_ipv4_src_addr_mask.tft_ipv4_addr,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

277 (size_t)NAS_SIZE_IPv4_ADDR);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

278 memcpy(dst->tft_ipv4_addr_mask.addr_mask,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

279 src->tft_ipv4_src_addr_mask.tft_ipv4_mask,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

280 (size_t)NAS_SIZE_IPv4_ADDR);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

281 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

282 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

283 U8 *addr, *mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

284 addr = dst->tft_ipv4_addr_mask.src_addr;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

285 mask = dst->tft_ipv4_addr_mask.addr_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

286 (void)TRACE_EVENT_P8("tft_copy: Copy IPv4 src addr/mask filter: "

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

287 "%u.%u.%u.%u/%u.%u.%u.%u",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

288 addr[0], addr[1], addr[2], addr[3],

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

289 mask[0], mask[1], mask[2], mask[3]);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

290 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

291 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

292 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

293 dst->v_tft_ipv4_addr_mask = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

294 } /* NAS_TFT_ID_IPv4_SRC_ADDR_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

295

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

296 /* IPv6 addr/mask never invluded in IPv4 packet filter */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

297 dst->v_tft_ipv6_addr_mask = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

298

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

299 /* Copy IPv4 protocol number field */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

300 if ((valid_flag & NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

301 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

302 dst->v_tft_protocol = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

303 dst->tft_protocol.tft_protocol_val = src->tft_protocol;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

304 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

305 (void)TRACE_EVENT_P1("tft_copy: Copy IPv4 protocol: 0x%02x",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

306 src->tft_protocol);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

307 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

308 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

309 dst->v_tft_protocol = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

310 } /* NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

311

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

312 /* Copy destination single port/port range parameter */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

313 if ((valid_flag & NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

314 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

315 T_NAS_tft_dest_port_range *port_range = &src->tft_dest_port_range;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

316 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit)) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

317 dst->v_tft_dest_port_range = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

318 dst->v_tft_dest_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

319 dst->tft_dest_port_range.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

320 dst->tft_dest_port_range.high_limit = port_range->high_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

321 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

322 (void)TRACE_EVENT_P2("tft_copy: Copying destination port range filter (ports %d-%d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

323 port_range->low_limit, port_range->high_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

324 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

325 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

326 dst->v_tft_dest_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

327 dst->v_tft_dest_port = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

328 dst->tft_dest_port.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

329 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

330 (void)TRACE_EVENT_P1("tft_copy: Copying single destination port filter (port %d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

331 port_range->low_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

332 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

333 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

334 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

335 dst->v_tft_dest_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

336 dst->v_tft_dest_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

337 } /* NAS_TFT_ID_DEST_PORT_RANGE */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

338

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

339 /* Copy source single port/port range parameter */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

340 if ((valid_flag & NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

341 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

342 T_NAS_tft_src_port_range *port_range = &src->tft_src_port_range;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

343 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

344 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

345 dst->v_tft_src_port_range = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

346 dst->v_tft_src_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

347 dst->tft_src_port_range.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

348 dst->tft_src_port_range.high_limit = port_range->high_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

349 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

350 (void)TRACE_EVENT_P2("tft_copy: Copying source port range filter (ports %d-%d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

351 port_range->low_limit, port_range->high_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

352 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

353 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

354 dst->v_tft_src_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

355 dst->v_tft_src_port = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

356 dst->tft_src_port.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

357 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

358 (void)TRACE_EVENT_P1("tft_copy: Copying single source port filter (port %d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

359 port_range->low_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

360 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

361 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

362 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

363 dst->v_tft_src_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

364 dst->v_tft_src_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

365 } /* NAS_TFT_ID_SRC_PORT_RANGE */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

366

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

367 if ((valid_flag & NAS_TFT_ID_IPSEC_SPI) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

368 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

369 dst->v_tft_ipsec_spi = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

370 sm_tft_copy_ipsec_spi(&dst->tft_ipsec_spi, src->tft_ipsec_spi);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

371 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

372 dst->v_tft_ipsec_spi = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

373 }/* NAS_TFT_ID_IPSEC_SPI */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

374

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

375 if ((valid_flag & NAS_TFT_ID_TOS_AND_MASK) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

376 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

377 dst->v_tft_tos_and_mask = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

378 dst->tft_tos_and_mask.tos_value = src->tft_tos_and_mask.tos_value;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

379 dst->tft_tos_and_mask.tos_mask = src->tft_tos_and_mask.tos_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

380 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

381 dst->v_tft_tos_and_mask = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

382 } /* NAS_TFT_ID_TOS_AND_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

383

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

384 if ((valid_flag & NAS_TFT_ID_FLOW_LABEL) != (U8)0) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

385 (void)TRACE_ERROR("tft_copy: Found flow label in IPv4 packet filter - Discarded...");

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

386 } /* NAS_TFT_ID_FLOW_LABEL */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

387 dst->v_tft_flow_label = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

388 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

389

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

390 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

391 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

392 | Function : sm_tft_copy_ipv6_pf

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

393 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

394 | Description : Copies an IPv6 TFT filter from src_tft to dst_tft AIM struct.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

395 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

396 | Parameters : dst_tft - destination aim TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

397 | src_tft - source TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

398 | valid_flag - valid flags for filter components

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

399 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

400 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

401 static void

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

402 sm_tft_copy_ipv6_pf(/*@out@*/ T_M_SM_tft_filter_entry *dst,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

403 T_NAS_tft_pf_ipv6 *src, U8 valid_flag)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

404 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

405 /* IPv4 addr/mask never invluded in IPv4 packet filter */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

406 dst->v_tft_ipv4_addr_mask = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

407

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

408 /* Copy IPv6 address, if present */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

409 if ((valid_flag & NAS_TFT_ID_IPv6_SRC_ADDR_MASK) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

410 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

411 dst->v_tft_ipv6_addr_mask = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

412 memcpy(dst->tft_ipv6_addr_mask.src_addr,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

413 src->tft_ipv6_src_addr_mask.tft_ipv6_addr,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

414 (size_t)NAS_SIZE_IPv6_ADDR);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

415 memcpy(dst->tft_ipv6_addr_mask.addr_mask,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

416 src->tft_ipv6_src_addr_mask.tft_ipv6_mask,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

417 (size_t)NAS_SIZE_IPv6_ADDR);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

418 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

419 /* Dump address/mask */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

420 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

421 char addr[SM_SIZE_FORMATTED_IPv6_ADDR], mask[SM_SIZE_FORMATTED_IPv6_ADDR];

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

422 (void)TRACE_EVENT_P2("tft_copy: Copy IPv6 src addr/mask filter: %s/%s",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

423 sm_format_ipv6_addr(dst->tft_ipv6_addr_mask.src_addr, addr),

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

424 sm_format_ipv6_addr(dst->tft_ipv6_addr_mask.addr_mask, mask));

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

425 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

426 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

427 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

428 dst->v_tft_ipv6_addr_mask = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

429 } /* NAS_TFT_ID_IPv6_SRC_ADDR_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

430

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

431 /* Copy IPv6 next header field */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

432 if ((valid_flag & NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

433 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

434 dst->v_tft_protocol = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

435 dst->tft_protocol.tft_protocol_val = src->tft_next_hdr;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

436 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

437 (void)TRACE_EVENT_P1("tft_copy: Copy IPv6 next header field: 0x%02x",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

438 src->tft_next_hdr);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

439 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

440 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

441 dst->v_tft_protocol = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

442 } /* NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

443

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

444 /* Copy destination single port/port range parameter */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

445 if ((valid_flag & NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

446 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

447 T_NAS_tft_dest_port_range *port_range = &src->tft_dest_port_range;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

448 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

449 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

450 dst->v_tft_dest_port_range = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

451 dst->v_tft_dest_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

452 dst->tft_dest_port_range.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

453 dst->tft_dest_port_range.high_limit = port_range->high_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

454 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

455 (void)TRACE_EVENT_P2("tft_copy: Copying destination port range filter (ports %d-%d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

456 port_range->low_limit, port_range->high_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

457 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

458 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

459 dst->v_tft_dest_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

460 dst->v_tft_dest_port = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

461 dst->tft_dest_port.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

462 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

463 (void)TRACE_EVENT_P1("tft_copy: Copying single destination port filter (port %d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

464 port_range->low_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

465 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

466 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

467 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

468 dst->v_tft_dest_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

469 dst->v_tft_dest_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

470 } /* NAS_TFT_ID_DEST_PORT_RANGE */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

471

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

472 /* Copy source single port/port range parameter */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

473 if ((valid_flag & NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

474 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

475 T_NAS_tft_src_port_range *port_range = &src->tft_src_port_range;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

476 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

477 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

478 dst->v_tft_src_port_range = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

479 dst->v_tft_src_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

480 dst->tft_src_port_range.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

481 dst->tft_src_port_range.high_limit = port_range->high_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

482 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

483 (void)TRACE_EVENT_P2("tft_copy: Copying source port range filter (ports %d-%d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

484 port_range->low_limit, port_range->high_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

485 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

486 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

487 dst->v_tft_src_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

488 dst->v_tft_src_port = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

489 dst->tft_src_port.low_limit = port_range->low_limit;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

490 #ifdef TFT_DEBUG

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

491 (void)TRACE_EVENT_P1("tft_copy: Copying single source port filter (port %d)",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

492 port_range->low_limit);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

493 #endif

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

494 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

495 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

496 dst->v_tft_src_port_range = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

497 dst->v_tft_src_port = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

498 } /* NAS_TFT_ID_SRC_PORT_RANGE */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

499

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

500 if ((valid_flag & NAS_TFT_ID_IPSEC_SPI) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

501 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

502 dst->v_tft_ipsec_spi = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

503 sm_tft_copy_ipsec_spi(&dst->tft_ipsec_spi, src->tft_ipsec_spi);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

504 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

505 dst->v_tft_ipsec_spi = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

506 } /* NAS_TFT_ID_IPSEC_SPI */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

507

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

508 if ((valid_flag & NAS_TFT_ID_TOS_AND_MASK) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

509 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

510 dst->v_tft_tos_and_mask = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

511 dst->tft_tos_and_mask.tos_value = src->tft_tos_and_mask.tos_value;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

512 dst->tft_tos_and_mask.tos_mask = src->tft_tos_and_mask.tos_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

513 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

514 dst->v_tft_tos_and_mask = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

515 } /* NAS_TFT_ID_TOS_AND_MASK */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

516

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

517 if ((valid_flag & NAS_TFT_ID_FLOW_LABEL) != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

518 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

519 dst->v_tft_flow_label = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

520 dst->tft_flow_label.flow_label_value = src->tft_flow_label;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

521 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

522 dst->v_tft_flow_label = (U8)FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

523 } /* NAS_TFT_ID_FLOW_LABEL */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

524 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

525

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

526 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

527 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

528 | Function : sm_tft_copy_filters

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

529 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

530 | Description : Copies TFT filters from src_tft to dst_tft AIM structs.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

531 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

532 | Parameters : dst_tft - destination aim TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

533 | src_tft - source TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

534 | tft_mask - TFT mask (determines which TFTs to consider)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

535 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

536 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

537 static U8

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

538 sm_tft_copy_filters(/*@special@*/T_M_SM_tft *dst_tft,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

539 /*@in@*/ T_NAS_tft_pf *src_tft,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

540 U8 max_count, U8 tft_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

541 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

542 int i, count;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

543 T_M_SM_tft_filter *dst;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

544 U16 size, total_size = 0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

545 U8 change_mask = (U8)0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

546

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

547 dst_tft->v_tft_filter = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

548

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

549 /* Initialize pointer to air interface TFT */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

550 dst = dst_tft->tft_filter;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

551

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

552 for (i = 0, count = 0; i < (int)max_count; i++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

553 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

554 if (sm_tft_is_tft_in_mask(src_tft->tft_pf_id, tft_mask))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

555 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

556 size = sm_tft_pf_size(src_tft);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

557 /* Only include packet filter, if it fits in air interface message */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

558 if (total_size + size > (U16)255) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

559 break;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

560 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

561

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

562 dst->tft_filter_id = src_tft->tft_pf_id;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

563 dst->tft_filter_prio = src_tft->tft_pf_precedence;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

564

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

565 if (src_tft->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv4) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

566 sm_tft_copy_ipv4_pf(&dst->tft_filter_entry,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

567 &src_tft->tft_pf_entry.tft_pf_ipv4,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

568 src_tft->tft_pf_valid_bits);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

569 } else if (src_tft->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv6) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

570 sm_tft_copy_ipv6_pf(&dst->tft_filter_entry,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

571 &src_tft->tft_pf_entry.tft_pf_ipv6,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

572 src_tft->tft_pf_valid_bits);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

573 } else {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

574 (void)TRACE_EVENT_P1("tft_copy: ERROR! Wrong union controller (%d) "

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

575 "for tft_pf_entry; discarded...",

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

576 src_tft->ctrl_tft_pf_entry);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

577 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

578 /* Update change mask and total TFT size */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

579 change_mask |= (U8)(1UL << dst->tft_filter_id);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

580 total_size += size;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

581 /* Advance to next destination TFT */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

582 dst++;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

583 count++;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

584 } /* if (sm_tft_is_tft_in_mask()) */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

585 /* Skip to next input TFT */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

586 src_tft++;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

587 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

588

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

589 dst_tft->c_tft_filter = (U8)count;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

590

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

591 return change_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

592 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

593

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

594 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

595 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

596 | Function : sm_tft_copy_filter_numbers

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

597 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

598 | Description : Copies filter IDs to dst_tft AIM struct (derived from tft_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

599 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

600 | Parameters : dst_tft - destination aim TFT structs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

601 | tft_mask - TFT mask (determines which TFTs to consider)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

602 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

603 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

604 static void

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

605 sm_tft_copy_filter_numbers(/*@special@*/T_M_SM_tft *dst_tft,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

606 U8 tft_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

607 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

608 int index, dst_idx;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

609

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

610 dst_tft->v_tft_filter_id = (U8)TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

611

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

612 for (index = 0, dst_idx = 0; index < (int)NAS_SIZE_TFT_FILTER; index++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

613 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

614 if (sm_tft_is_tft_in_mask((U8)index, tft_mask))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

615 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

616 dst_tft->tft_filter_id[dst_idx] = (U8)index;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

617 dst_idx++;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

618 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

619 } /* for */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

620

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

621 /* Set counter to the number of filters numbers inserted */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

622 dst_tft->c_tft_filter_id = (U8)dst_idx;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

623 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

624

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

625 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

626 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

627 | Function : sm_tft_update_active_tft

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

628 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

629 | Description : Update context data structure with new active TFT as it would

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

630 | be would the modification succeed.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

631 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

632 | Parameters : context - context data

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

633 | tft_mask - TFT mask (determines which TFTs to consider)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

634 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

635 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

636 static void

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

637 sm_tft_update_active_tft(/*@special@*/struct T_SM_CONTEXT_DATA *context,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

638 U8 change_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

639 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

640 T_NAS_tft_pf *req_tft, *act_tft;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

641 U16 index;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

642 U8 req_mask, act_mask, add_mask, delete_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

643

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

644 req_mask = context->requested_tft.tft_precence_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

645 act_mask = context->active_tft.tft_precence_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

646 add_mask = req_mask & change_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

647 delete_mask = (U8)(0xffUL ^ req_mask) & change_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

648

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

649 if (req_mask == (U8)0) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

650 sm_nw_free_active_tft(context);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

651 return;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

652 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

653

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

654 TRACE_ASSERT(context->requested_tft.ptr_tft_pf != NULL);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

655

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

656 /* Allocate active TFT memory, if required */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

657 if (act_mask == (U8)0 &&

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

658 /*req_mask != (U8)0 &&*/ /*commented out because of previous return*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

659 context->active_tft.ptr_tft_pf == NULL)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

660 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

661 sm_nw_allocate_active_tft(context);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

662 TRACE_ASSERT(context->active_tft.ptr_tft_pf != NULL);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

663 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

664

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

665 /* Loop over TFTs, in order to find any TFTs to delete */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

666 for (index = 0; index < (U16)NAS_SIZE_TFT_FILTER; index++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

667 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

668 if (sm_tft_is_tft_in_mask((U8)index, delete_mask))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

669 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

670 /* Was filter removed ? If so, clear filter from mask and store */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

671 act_mask &= (U8)(0xffUL ^ 1UL << index);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

672 act_tft = sm_tft_get_active_tft_by_id(context, (U8)index);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

673 memset(act_tft, 0, sizeof(T_NAS_tft_pf));

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

674 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

675 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

676

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

677 for (index = 0, req_tft = context->requested_tft.ptr_tft_pf;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

678 index < (U16)context->requested_tft.c_tft_pf;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

679 index++, req_tft++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

680 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

681 U8 pf_id = req_tft->tft_pf_id;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

682

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

683 if (sm_tft_is_tft_in_mask(pf_id, add_mask))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

684 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

685 /* Copy any remaining requested TFTs into active TFT */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

686 act_mask |= (U8)(1UL << pf_id);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

687 act_tft = sm_tft_get_active_tft_by_id(context, pf_id);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

688 memcpy(act_tft, req_tft, sizeof(T_NAS_tft_pf));

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

689 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

690 } /* for */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

691

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

692 context->active_tft.tft_precence_mask = act_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

693 context->active_tft.c_tft_pf = sm_tft_count_tfts_in_mask(act_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

694 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

695

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

696 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

697 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

698 | Function : sm_tft_next_action

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

699 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

700 | Description : Determines the next action to perform (opcode) on the TFTs

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

701 | for a context, and the filters affected.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

702 | (8 upper bits is change mask; 8 lower bits is opcode)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

703 |

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

704 | Parameters : context - context data

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

705 +------------------------------------------------------------------------------

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

706 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

707 static U16 sm_tft_next_action(struct T_SM_CONTEXT_DATA *context)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

708 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

709 U8 req_mask, act_mask, missing_mask, surplus_mask, replace_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

710 U16 index;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

711

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

712 req_mask = context->requested_tft.tft_precence_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

713 act_mask = context->active_tft.tft_precence_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

714

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

715 /* If requested TFT contains 0 filters, remove TFT altogether */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

716 if (context->requested_tft.c_tft_pf == (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

717 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

718 return (U16)M_SM_TFT_OPCODE_DELETE_TFT;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

719 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

720

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

721 TRACE_ASSERT(context->requested_tft.ptr_tft_pf != NULL);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

722

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

723 /* If there are no activate TFT filters, and requested != 0, create new TFT */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

724 if (act_mask == (U8)0 && req_mask != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

725 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

726 return (U16)M_SM_TFT_OPCODE_CREATE_TFT | (U16)req_mask << 8;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

727 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

728

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

729 /* Add filters, if requested filter count > active filter count or

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

730 * requested filters exist, that are not active. */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

731 missing_mask = req_mask & (0xff ^ act_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

732

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

733 if (context->requested_tft.c_tft_pf > context->active_tft.c_tft_pf ||

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

734 missing_mask != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

735 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

736 return (U16)M_SM_TFT_OPCODE_ADD_FILTERS | (U16)missing_mask << 8;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

737 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

738

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

739 /* Delete filters, if requested filter count < active filter count or

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

740 * active filters exist, that are not requested. */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

741 surplus_mask = act_mask & (0xff ^ req_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

742

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

743 if (context->requested_tft.c_tft_pf < context->active_tft.c_tft_pf ||

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

744 surplus_mask != (U8)0)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

745 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

746 return (U16)M_SM_TFT_OPCODE_DELETE_FILTERS | (U16)surplus_mask << 8;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

747 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

748

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

749 /* Now, requested and active TFTs have the same filter *numbers* active;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

750 * We then need to check, whether the *contents* of the filters that

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

751 * have the same number also match. */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

752 for (index = 0, replace_mask = (U8)0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

753 index < (U16)context->requested_tft.c_tft_pf;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

754 index++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

755 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

756 T_NAS_tft_pf *req_tft = &context->requested_tft.ptr_tft_pf[index];

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

757 T_NAS_tft_pf *act_tft = sm_tft_get_active_tft_by_id(context, req_tft->tft_pf_id);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

758

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

759 if (!sm_tft_are_equal(req_tft, act_tft))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

760 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

761 replace_mask |= (U8)(1UL << req_tft->tft_pf_id);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

762 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

763 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

764

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

765 if (replace_mask != (U8)0) {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

766 return (U16)M_SM_TFT_OPCODE_REPLACE_FILTERS | (U16)replace_mask << 8;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

767 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

768

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

769 /* Error. Nothing to change, or invalid configuration */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

770 return (U16)M_SM_TFT_OPCODE_SPARE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

771 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

772

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

773 /*==== PUBLIC FUNCTIONS =====================================================*/

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

774

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

775 U8 sm_tft_precence_mask(T_NAS_tft_pf *tft, U8 count)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

776 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

777 U16 index;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

778 U8 precence_mask = (U8)0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

779

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

780 for (index = 0; index < (U16)count; index++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

781 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

782 precence_mask |= (1UL << tft[index].tft_pf_id);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

783 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

784

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

785 return precence_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

786 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

787

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

788 void sm_tft_convert_to_aim(struct T_SM_CONTEXT_DATA *context,

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

789 /*@out@*/ T_M_SM_tft *dst_tft)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

790 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

791 U8 opcode, filter_mask, change_mask, max_count;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

792 U16 opcode_and_mask;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

793

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

794 T_NAS_tft_pf *src_tft = context->requested_tft.ptr_tft_pf;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

795 max_count = context->requested_tft.c_tft_pf;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

796

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

797 if (src_tft == NULL)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

798 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

799 return;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

800 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

801

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

802 opcode_and_mask = sm_tft_next_action(context);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

803 opcode = (U8)(opcode_and_mask & 0xff);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

804 filter_mask = (U8)(opcode_and_mask >> 8);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

805

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

806 dst_tft->tft_opcode = opcode;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

807

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

808 switch (opcode)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

809 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

810 case M_SM_TFT_OPCODE_CREATE_TFT:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

811 case M_SM_TFT_OPCODE_ADD_FILTERS:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

812 case M_SM_TFT_OPCODE_REPLACE_FILTERS:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

813 TRACE_ASSERT(src_tft != NULL);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

814 /* Copy filter count to air interface message TFT struct */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

815 change_mask = sm_tft_copy_filters(dst_tft, src_tft, max_count, filter_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

816 sm_tft_update_active_tft(context, change_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

817 dst_tft->tft_filter_count = sm_tft_count_tfts_in_mask(change_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

818 break;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

819

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

820 case M_SM_TFT_OPCODE_DELETE_TFT:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

821 /*

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

822 * DELETE TFT can have no fields other than TFT opcode and

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

823 * filter count (== 0), and is thus complete.

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

824 */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

825 context->requested_tft.tft_precence_mask = (U8)0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

826 sm_tft_update_active_tft(context, (U8)0xff);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

827 dst_tft->tft_filter_count = (U8)0;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

828 break;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

829

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

830 case M_SM_TFT_OPCODE_DELETE_FILTERS:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

831 TRACE_ASSERT(src_tft != NULL);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

832 /* Copy filter count to air interface message TFT struct */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

833 sm_tft_copy_filter_numbers(dst_tft, filter_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

834 sm_tft_update_active_tft(context, filter_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

835 dst_tft->tft_filter_count = sm_tft_count_tfts_in_mask(filter_mask);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

836 break;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

837

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

838 default:

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

839 (void)TRACE_EVENT_P1("tft_convert_to_aim: ERROR!"

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

840 "Invalid opcode (%d) - TFT skipped!", opcode);

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

841 break;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

842 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

843 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

844

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

845 BOOL sm_tft_more_to_modify(struct T_SM_CONTEXT_DATA *context)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

846 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

847 int filter;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

848

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

849 (void)TRACE_FUNCTION("sm_tft_more_to_modify");

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

850

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

851 if (context->requested_tft.c_tft_pf != context->active_tft.c_tft_pf ||

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

852 context->requested_tft.tft_precence_mask != context->active_tft.tft_precence_mask)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

853 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

854 return TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

855 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

856 if (context->requested_tft.c_tft_pf > (U8)0

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

857 && context->requested_tft.ptr_tft_pf != NULL

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

858 && context->active_tft.ptr_tft_pf != NULL)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

859 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

860 for (filter = 0; filter < (int)context->requested_tft.c_tft_pf; filter++)

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

861 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

862 if (!sm_tft_are_equal(&context->requested_tft.ptr_tft_pf[filter],

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

863 sm_tft_get_active_tft_by_id(context, context->requested_tft.ptr_tft_pf[filter].tft_pf_id)))

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

864 {

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

865 return TRUE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

866 }

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

867 } /* for */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

868 } /* if (c_tft_pf > 0) */

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

869 return FALSE;

219afcfc6250 src/g23m-gprs: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

870 }

FreeCalypso > hg > fc-magnetite

annotate src/g23m-gprs/sm/sm_tft.c @ 603:b13731665274