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

annotate src/g23m-gprs/sm/sm_tft.c @ 701:35e7f9d0379f

targets: add TARGET_HAS_BUZZER to c11x, c139 and dsample This new target config preprocessor symbol was introduced in Tourmaline in connection with the new approach to playing buzzer melodies via PWT, properly omitting the responsible code on targets where BU output controls the vibrator instead. That code is not present in Magnetite and we have no plans to backport it here, but target header files should be kept consistent between the two trees, especially given that we plan to support FC Venus target in Magnetite.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 26 Mar 2022 19:51:34 +0000
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)
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 @ 701:35e7f9d0379f