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

annotate src/g23m-gprs/sm/sm_tft.c @ 111:97297555c71a

FFS dev.c flash device table reworked as described in TCS211-fw-arch

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sat, 13 Oct 2018 16:32:07 +0000
parents	d393cd9bb723
children

rev	line source
1 d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1 /*----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2 \| Project : 3G PS
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	3 \| Module : SM
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	4 +-----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	5 \| Copyright 2003 Texas Instruments.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	6 \| All rights reserved.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	7 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	8 \| This file is confidential and a trade secret of Texas
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	9 \| Instruments .
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	10 \| The receipt of or possession of this file does not convey
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	11 \| any rights to reproduce or disclose its contents or to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	12 \| manufacture, use, or sell anything it may describe, in
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	13 \| whole, or in part, without the specific written consent of
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	14 \| Texas Instruments.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	15 +-----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	16 \| Purpose: 3G TFT utility functions implementation in the SM entity.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	17 \| For design details, see:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	18 \| 8010.908 SM Detailed Specification
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	19 +---------------------------------------------------------------------------*/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	20
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	21 /==== DECLARATION CONTROL =================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	22
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	23 /==== INCLUDES ============================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	24
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	25 #include "sm.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	26
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	27 #include "sm_tft.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	28
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	29 /==== CONST ===============================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	30
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	31 /==== LOCAL VARS ===========================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	32
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	33 /==== PRIVATE FUNCTIONS ====================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	34
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	35 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	36 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	37 \| Function : sm_tft_count_tfts_in_mask
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	38 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	39 \| Description : Returns the number of filters (set bits) in a TFT mask.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	40 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	41 \| Parameters : tft_mask - TFT mask
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	42 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	43 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	44 static U8 sm_tft_count_tfts_in_mask(U8 tft_mask) /@/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	45 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	46 U8 count_array[16] = {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	47 (U8)0 /* 0000 /, (U8)1 / 0001 /, (U8)1 / 0010 /, (U8)2 / 0011 */,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	48 (U8)1 /* 0100 /, (U8)2 / 0101 /, (U8)2 / 0110 /, (U8)3 / 0111 */,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	49 (U8)1 /* 1000 /, (U8)2 / 1001 /, (U8)2 / 1010 /, (U8)3 / 1011 */,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	50 (U8)2 /* 1100 /, (U8)3 / 1101 /, (U8)3 / 1110 /, (U8)4 / 1111 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	51 };
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	52 return (count_array[(U16)tft_mask >> 4] + count_array[(U16)tft_mask & 15]);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	53 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	54
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	55 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	56 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	57 \| Function : sm_tft_is_tft_in_mask
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	58 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	59 \| Description : Returns TRUE if the TFT with the specified ID (bit) is
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	60 \| set in the specified TFT mask.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	61 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	62 \| Parameters : id - TFT identifier
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	63 \| tft_mask - TFT mask
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	64 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	65 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	66 static BOOL sm_tft_is_tft_in_mask(U8 id, U8 tft_mask) /@/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	67 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	68 return ((tft_mask & (1UL << id)) != 0);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	69 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	70
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	71 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	72 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	73 \| Function : sm_tft_is_port_range
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	74 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	75 \| Description : Query function returning TRUE if high_limit is not zero, and
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	76 \| high_limit is greater than (but not equal) to low_limit.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	77 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	78 \| Parameters : low_limit - lower port limit
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	79 \| high_limit - upper port limit
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	80 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	81 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	82 static BOOL sm_tft_is_port_range(U16 low_limit, U16 high_limit)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	83 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	84 return (high_limit != 0 && low_limit < high_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	85 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	86
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	87 static /@exposed@/T_NAS_tft_pf *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	88 sm_tft_get_active_tft_by_id(/@returned@/ /@partial@/struct T_SM_CONTEXT_DATA *context,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	89 U8 id)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	90 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	91 TRACE_ASSERT(id < (U8)NAS_SIZE_TFT_FILTER);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	92 TRACE_ASSERT(context->active_tft.ptr_tft_pf != NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	93 return (&context->active_tft.ptr_tft_pf[id]);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	94 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	95
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	96 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	97 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	98 \| Function : sm_tft_pf_size
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	99 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	100 \| Description : Query function returning the packed size of a packet filter.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	101 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	102 \| Parameters : tft_pf - packet filter
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	103 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	104 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	105 static U16 sm_tft_pf_size(T_NAS_tft_pf *tft_pf)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	106 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	107 U16 tft_pf_size = (U16)3; /* Filter ID, precedence and length octet mandatory */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	108
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	109 U16 lower3bits[8] = {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	110 (U16) 0, /* 0x00: None */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	111 (U16) 9, /* 0x01: IPv4_SRC_ADDR_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	112 (U16) 33, /* 0x02: IPv6_SRC_ADDR_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	113 (U16) 0, /* 0x03: IPv4_SRC_ADDR_MASK + IPv6_SRC_ADDR_MASK -- INVALID! */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	114 (U16) 3, /* 0x04: PROTOCOL_OR_NEXT_HDR */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	115 (U16) 12, /* 0x05: IPv4_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	116 (U16) 36, /* 0x06: IPv6_SRC_ADDR_MASK + PROTOCOL_OR_NEXT_HDR */
d393cd9bb723 src/g23m-: initial import from Magnetite 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! */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	118 };
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	119 U16 upper3bits[8] = {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	120 (U16) 0, /* 0x00: None */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	121 (U16) 5, /* 0x20: IPSEC_SPI */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	122 (U16) 3, /* 0x40: TOS_AND_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	123 (U16) 5, /* 0x60: IPSEC_SPI + TOS_AND_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	124 (U16) 4, /* 0x80: FLOW_LABEL */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	125 (U16) 0, /* 0xa0: IPSEC_SPI + FLOW_LABEL - INVALID! */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	126 (U16) 7, /* 0xc0: TOS_AND_MASK + FLOW_LABEL */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	127 (U16) 0 /* 0xe0: IPSEC_SPI + TOS_AND_MASK + FLOW_LABEL - INVALID! */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	128 };
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	129
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	130 if ((tft_pf->tft_pf_valid_bits & (U8)0x07) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	131 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	132 tft_pf_size += lower3bits[(U16)tft_pf->tft_pf_valid_bits & 0x07];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	133 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	134
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	135 if ((tft_pf->tft_pf_valid_bits & (U8)0xe0) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	136 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	137 tft_pf_size += upper3bits[(U16)tft_pf->tft_pf_valid_bits >> 5];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	138 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	139
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	141 {
d393cd9bb723 src/g23m-: initial import from Magnetite 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;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	143 if (sm_tft_is_port_range(range->low_limit, range->high_limit))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	144 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	145 tft_pf_size += (U16)5; /* Destination port range */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	146 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	147 tft_pf_size += (U16)3; /* Single destination port */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	148 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	149 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	150
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	152 {
d393cd9bb723 src/g23m-: initial import from Magnetite 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;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	154 if (sm_tft_is_port_range(range->low_limit, range->high_limit))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	155 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	156 tft_pf_size += (U16)5; /* Source port range */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	157 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	158 tft_pf_size += (U16)3; /* Single source port */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	159 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	160 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	161
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	162 return tft_pf_size;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	163 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	164
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	165 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	166 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	167 \| Function : sm_tft_are_equal
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	168 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	169 \| Description : Query function returning TRUE if the two input packet filters
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	170 \| are equal (same parameters).
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	171 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	172 \| Parameters : tft1 - packet filter 1
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	173 \| tft2 - packet filter 2
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	174 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	175 */
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	177 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	178 U8 valid_bits;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	179
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	180 /* Compare outer-level parameters */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	181 if (tft1->tft_pf_id != tft2->tft_pf_id \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	182 tft1->tft_pf_precedence != tft2->tft_pf_precedence \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	183 tft1->tft_pf_valid_bits != tft2->tft_pf_valid_bits \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	184 tft1->ctrl_tft_pf_entry != tft2->ctrl_tft_pf_entry)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	185 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	186 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	187 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	188
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	189 valid_bits = tft1->tft_pf_valid_bits;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	190
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	191 if (tft1->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv4) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	192 T_NAS_tft_pf_ipv4 *v4_pf_1 = &tft1->tft_pf_entry.tft_pf_ipv4;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	193 T_NAS_tft_pf_ipv4 *v4_pf_2 = &tft2->tft_pf_entry.tft_pf_ipv4;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	194
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	195 if (((valid_bits & (U8)NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	196 && v4_pf_1->tft_protocol != v4_pf_2->tft_protocol)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	197 \|\| ((valid_bits & (U8)NAS_TFT_ID_TOS_AND_MASK) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	200 \|\| ((valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	202 \|\| ((valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	204 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPSEC_SPI) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	205 && v4_pf_1->tft_ipsec_spi != v4_pf_2->tft_ipsec_spi)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	206 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPv4_SRC_ADDR_MASK) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	208 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	209 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	210 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	211 } else if (tft1->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv6)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	212 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	213 T_NAS_tft_pf_ipv6 *v6_pf_1 = &tft1->tft_pf_entry.tft_pf_ipv6;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	214 T_NAS_tft_pf_ipv6 *v6_pf_2 = &tft2->tft_pf_entry.tft_pf_ipv6;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	215
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	216 if (((valid_bits & (U8)NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	217 && v6_pf_1->tft_next_hdr != v6_pf_2->tft_next_hdr)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	218 \|\| ((valid_bits & (U8)NAS_TFT_ID_TOS_AND_MASK) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	221 \|\| ((valid_bits & (U8)NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	223 \|\| ((valid_bits & (U8)NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	225 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPSEC_SPI) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	226 && v6_pf_1->tft_ipsec_spi != v6_pf_2->tft_ipsec_spi)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	227 \|\| ((valid_bits & (U8)NAS_TFT_ID_FLOW_LABEL) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	228 && v6_pf_1->tft_flow_label != v6_pf_2->tft_flow_label)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	229 \|\| ((valid_bits & (U8)NAS_TFT_ID_IPv6_SRC_ADDR_MASK) != (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite 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))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	231 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	232 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	233 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	234 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	235 (void)TRACE_EVENT_P1("ERROR: Invalid union controller %d in ctrl_tft_pf_entry!",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	236 tft1->ctrl_tft_pf_entry);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	237 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	238 return TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	239 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	240
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	241 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	242 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	243 \| Function : sm_tft_copy_ipv4_pf
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	244 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	245 \| Description : Copies an IPv4 TFT filter from src_tft to dst_tft AIM struct.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	246 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	247 \| Parameters : dst_tft - destination aim TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	248 \| src_tft - source TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	249 \| valid_flag - valid flags for filter components
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	250 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	251 */
d393cd9bb723 src/g23m-: initial import from Magnetite 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,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	253 U32 spi)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	254 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	255 M_SM_BUF_ipsec_spi_value *dst = &dst_spi->ipsec_spi_value;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	256 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	257 (void)TRACE_EVENT_P1("tft_copy: Copying IPSEC SPI filter (SPI 0x%08x)", spi);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	258 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	259 dst->l_ipsec_spi_value = (U16)32;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	260 dst->o_ipsec_spi_value = (U16)0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	261 dst->b_ipsec_spi_value[0] = (U8)((spi >> 24) & 255);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	262 dst->b_ipsec_spi_value[1] = (U8)((spi >> 16) & 255);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	263 dst->b_ipsec_spi_value[2] = (U8)((spi >> 8) & 255);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	264 dst->b_ipsec_spi_value[3] = (U8)( spi & 255);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	265 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	266
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	267 static void
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	268 sm_tft_copy_ipv4_pf(/@out@/ T_M_SM_tft_filter_entry *dst,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	269 T_NAS_tft_pf_ipv4 *src, U8 valid_flag)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	270 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	271 /* Copy IPv4 address, if present */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	272 if ((valid_flag & NAS_TFT_ID_IPv4_SRC_ADDR_MASK) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	273 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	274 dst->v_tft_ipv4_addr_mask = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	275 memcpy(dst->tft_ipv4_addr_mask.src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	276 src->tft_ipv4_src_addr_mask.tft_ipv4_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	277 (size_t)NAS_SIZE_IPv4_ADDR);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	278 memcpy(dst->tft_ipv4_addr_mask.addr_mask,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	279 src->tft_ipv4_src_addr_mask.tft_ipv4_mask,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	280 (size_t)NAS_SIZE_IPv4_ADDR);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	281 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	282 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	283 U8 addr, mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	284 addr = dst->tft_ipv4_addr_mask.src_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	285 mask = dst->tft_ipv4_addr_mask.addr_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	286 (void)TRACE_EVENT_P8("tft_copy: Copy IPv4 src addr/mask filter: "
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	287 "%u.%u.%u.%u/%u.%u.%u.%u",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	288 addr[0], addr[1], addr[2], addr[3],
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	289 mask[0], mask[1], mask[2], mask[3]);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	290 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	291 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	292 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	293 dst->v_tft_ipv4_addr_mask = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	294 } /* NAS_TFT_ID_IPv4_SRC_ADDR_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	295
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	296 /* IPv6 addr/mask never invluded in IPv4 packet filter */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	297 dst->v_tft_ipv6_addr_mask = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	298
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	299 /* Copy IPv4 protocol number field */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	300 if ((valid_flag & NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	301 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	302 dst->v_tft_protocol = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	303 dst->tft_protocol.tft_protocol_val = src->tft_protocol;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	304 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	305 (void)TRACE_EVENT_P1("tft_copy: Copy IPv4 protocol: 0x%02x",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	306 src->tft_protocol);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	307 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	308 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	309 dst->v_tft_protocol = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	310 } /* NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	311
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	312 /* Copy destination single port/port range parameter */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	313 if ((valid_flag & NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	314 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	315 T_NAS_tft_dest_port_range *port_range = &src->tft_dest_port_range;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	316 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit)) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	317 dst->v_tft_dest_port_range = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	318 dst->v_tft_dest_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	319 dst->tft_dest_port_range.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	320 dst->tft_dest_port_range.high_limit = port_range->high_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	321 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	322 (void)TRACE_EVENT_P2("tft_copy: Copying destination port range filter (ports %d-%d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	323 port_range->low_limit, port_range->high_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	324 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	325 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	326 dst->v_tft_dest_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	327 dst->v_tft_dest_port = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	328 dst->tft_dest_port.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	329 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	330 (void)TRACE_EVENT_P1("tft_copy: Copying single destination port filter (port %d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	331 port_range->low_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	332 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	333 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	334 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	335 dst->v_tft_dest_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	336 dst->v_tft_dest_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	337 } /* NAS_TFT_ID_DEST_PORT_RANGE */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	338
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	339 /* Copy source single port/port range parameter */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	340 if ((valid_flag & NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	341 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	342 T_NAS_tft_src_port_range *port_range = &src->tft_src_port_range;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	343 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	344 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	345 dst->v_tft_src_port_range = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	346 dst->v_tft_src_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	347 dst->tft_src_port_range.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	348 dst->tft_src_port_range.high_limit = port_range->high_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	349 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	350 (void)TRACE_EVENT_P2("tft_copy: Copying source port range filter (ports %d-%d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	351 port_range->low_limit, port_range->high_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	352 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	353 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	354 dst->v_tft_src_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	355 dst->v_tft_src_port = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	356 dst->tft_src_port.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	357 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	358 (void)TRACE_EVENT_P1("tft_copy: Copying single source port filter (port %d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	359 port_range->low_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	360 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	361 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	362 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	363 dst->v_tft_src_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	364 dst->v_tft_src_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	365 } /* NAS_TFT_ID_SRC_PORT_RANGE */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	366
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	367 if ((valid_flag & NAS_TFT_ID_IPSEC_SPI) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	368 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	369 dst->v_tft_ipsec_spi = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	370 sm_tft_copy_ipsec_spi(&dst->tft_ipsec_spi, src->tft_ipsec_spi);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	371 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	372 dst->v_tft_ipsec_spi = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	373 }/* NAS_TFT_ID_IPSEC_SPI */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	374
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	375 if ((valid_flag & NAS_TFT_ID_TOS_AND_MASK) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	376 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	377 dst->v_tft_tos_and_mask = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	378 dst->tft_tos_and_mask.tos_value = src->tft_tos_and_mask.tos_value;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	379 dst->tft_tos_and_mask.tos_mask = src->tft_tos_and_mask.tos_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	380 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	381 dst->v_tft_tos_and_mask = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	382 } /* NAS_TFT_ID_TOS_AND_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	383
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	384 if ((valid_flag & NAS_TFT_ID_FLOW_LABEL) != (U8)0) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	385 (void)TRACE_ERROR("tft_copy: Found flow label in IPv4 packet filter - Discarded...");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	386 } /* NAS_TFT_ID_FLOW_LABEL */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	387 dst->v_tft_flow_label = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	388 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	389
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	390 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	391 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	392 \| Function : sm_tft_copy_ipv6_pf
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	393 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	394 \| Description : Copies an IPv6 TFT filter from src_tft to dst_tft AIM struct.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	395 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	396 \| Parameters : dst_tft - destination aim TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	397 \| src_tft - source TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	398 \| valid_flag - valid flags for filter components
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	399 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	400 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	401 static void
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	402 sm_tft_copy_ipv6_pf(/@out@/ T_M_SM_tft_filter_entry *dst,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	403 T_NAS_tft_pf_ipv6 *src, U8 valid_flag)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	404 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	405 /* IPv4 addr/mask never invluded in IPv4 packet filter */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	406 dst->v_tft_ipv4_addr_mask = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	407
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	408 /* Copy IPv6 address, if present */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	409 if ((valid_flag & NAS_TFT_ID_IPv6_SRC_ADDR_MASK) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	410 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	411 dst->v_tft_ipv6_addr_mask = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	412 memcpy(dst->tft_ipv6_addr_mask.src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	413 src->tft_ipv6_src_addr_mask.tft_ipv6_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	414 (size_t)NAS_SIZE_IPv6_ADDR);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	415 memcpy(dst->tft_ipv6_addr_mask.addr_mask,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	416 src->tft_ipv6_src_addr_mask.tft_ipv6_mask,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	417 (size_t)NAS_SIZE_IPv6_ADDR);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	418 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	419 /* Dump address/mask */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	420 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	421 char addr[SM_SIZE_FORMATTED_IPv6_ADDR], mask[SM_SIZE_FORMATTED_IPv6_ADDR];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	422 (void)TRACE_EVENT_P2("tft_copy: Copy IPv6 src addr/mask filter: %s/%s",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	423 sm_format_ipv6_addr(dst->tft_ipv6_addr_mask.src_addr, addr),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	424 sm_format_ipv6_addr(dst->tft_ipv6_addr_mask.addr_mask, mask));
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	425 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	426 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	427 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	428 dst->v_tft_ipv6_addr_mask = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	429 } /* NAS_TFT_ID_IPv6_SRC_ADDR_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	430
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	431 /* Copy IPv6 next header field */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	432 if ((valid_flag & NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	433 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	434 dst->v_tft_protocol = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	435 dst->tft_protocol.tft_protocol_val = src->tft_next_hdr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	436 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	437 (void)TRACE_EVENT_P1("tft_copy: Copy IPv6 next header field: 0x%02x",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	438 src->tft_next_hdr);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	439 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	440 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	441 dst->v_tft_protocol = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	442 } /* NAS_TFT_ID_PROTOCOL_OR_NEXT_HDR */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	443
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	444 /* Copy destination single port/port range parameter */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	445 if ((valid_flag & NAS_TFT_ID_DEST_PORT_RANGE) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	446 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	447 T_NAS_tft_dest_port_range *port_range = &src->tft_dest_port_range;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	448 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	449 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	450 dst->v_tft_dest_port_range = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	451 dst->v_tft_dest_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	452 dst->tft_dest_port_range.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	453 dst->tft_dest_port_range.high_limit = port_range->high_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	454 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	455 (void)TRACE_EVENT_P2("tft_copy: Copying destination port range filter (ports %d-%d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	456 port_range->low_limit, port_range->high_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	457 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	458 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	459 dst->v_tft_dest_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	460 dst->v_tft_dest_port = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	461 dst->tft_dest_port.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	462 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	463 (void)TRACE_EVENT_P1("tft_copy: Copying single destination port filter (port %d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	464 port_range->low_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	465 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	466 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	467 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	468 dst->v_tft_dest_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	469 dst->v_tft_dest_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	470 } /* NAS_TFT_ID_DEST_PORT_RANGE */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	471
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	472 /* Copy source single port/port range parameter */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	473 if ((valid_flag & NAS_TFT_ID_SRC_PORT_RANGE) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	474 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	475 T_NAS_tft_src_port_range *port_range = &src->tft_src_port_range;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	476 if (sm_tft_is_port_range(port_range->low_limit, port_range->high_limit))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	477 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	478 dst->v_tft_src_port_range = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	479 dst->v_tft_src_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	480 dst->tft_src_port_range.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	481 dst->tft_src_port_range.high_limit = port_range->high_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	482 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	483 (void)TRACE_EVENT_P2("tft_copy: Copying source port range filter (ports %d-%d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	484 port_range->low_limit, port_range->high_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	485 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	486 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	487 dst->v_tft_src_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	488 dst->v_tft_src_port = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	489 dst->tft_src_port.low_limit = port_range->low_limit;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	490 #ifdef TFT_DEBUG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	491 (void)TRACE_EVENT_P1("tft_copy: Copying single source port filter (port %d)",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	492 port_range->low_limit);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	493 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	494 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	495 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	496 dst->v_tft_src_port_range = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	497 dst->v_tft_src_port = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	498 } /* NAS_TFT_ID_SRC_PORT_RANGE */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	499
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	500 if ((valid_flag & NAS_TFT_ID_IPSEC_SPI) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	501 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	502 dst->v_tft_ipsec_spi = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	503 sm_tft_copy_ipsec_spi(&dst->tft_ipsec_spi, src->tft_ipsec_spi);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	504 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	505 dst->v_tft_ipsec_spi = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	506 } /* NAS_TFT_ID_IPSEC_SPI */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	507
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	508 if ((valid_flag & NAS_TFT_ID_TOS_AND_MASK) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	509 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	510 dst->v_tft_tos_and_mask = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	511 dst->tft_tos_and_mask.tos_value = src->tft_tos_and_mask.tos_value;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	512 dst->tft_tos_and_mask.tos_mask = src->tft_tos_and_mask.tos_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	513 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	514 dst->v_tft_tos_and_mask = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	515 } /* NAS_TFT_ID_TOS_AND_MASK */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	516
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	517 if ((valid_flag & NAS_TFT_ID_FLOW_LABEL) != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	518 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	519 dst->v_tft_flow_label = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	520 dst->tft_flow_label.flow_label_value = src->tft_flow_label;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	521 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	522 dst->v_tft_flow_label = (U8)FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	523 } /* NAS_TFT_ID_FLOW_LABEL */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	524 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	525
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	526 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	527 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	528 \| Function : sm_tft_copy_filters
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	529 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	530 \| Description : Copies TFT filters from src_tft to dst_tft AIM structs.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	531 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	532 \| Parameters : dst_tft - destination aim TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	533 \| src_tft - source TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	534 \| tft_mask - TFT mask (determines which TFTs to consider)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	535 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	536 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	537 static U8
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	538 sm_tft_copy_filters(/@special@/T_M_SM_tft *dst_tft,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	539 /@in@/ T_NAS_tft_pf *src_tft,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	540 U8 max_count, U8 tft_mask)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	541 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	542 int i, count;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	543 T_M_SM_tft_filter *dst;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	544 U16 size, total_size = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	545 U8 change_mask = (U8)0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	546
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	547 dst_tft->v_tft_filter = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	548
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	549 /* Initialize pointer to air interface TFT */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	550 dst = dst_tft->tft_filter;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	551
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	552 for (i = 0, count = 0; i < (int)max_count; i++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	553 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	554 if (sm_tft_is_tft_in_mask(src_tft->tft_pf_id, tft_mask))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	555 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	556 size = sm_tft_pf_size(src_tft);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	557 /* Only include packet filter, if it fits in air interface message */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	558 if (total_size + size > (U16)255) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	559 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	560 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	561
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	562 dst->tft_filter_id = src_tft->tft_pf_id;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	563 dst->tft_filter_prio = src_tft->tft_pf_precedence;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	564
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	565 if (src_tft->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv4) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	566 sm_tft_copy_ipv4_pf(&dst->tft_filter_entry,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	567 &src_tft->tft_pf_entry.tft_pf_ipv4,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	568 src_tft->tft_pf_valid_bits);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	569 } else if (src_tft->ctrl_tft_pf_entry == NAS_is_tft_pf_ipv6) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	570 sm_tft_copy_ipv6_pf(&dst->tft_filter_entry,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	571 &src_tft->tft_pf_entry.tft_pf_ipv6,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	572 src_tft->tft_pf_valid_bits);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	573 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	574 (void)TRACE_EVENT_P1("tft_copy: ERROR! Wrong union controller (%d) "
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	575 "for tft_pf_entry; discarded...",
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	576 src_tft->ctrl_tft_pf_entry);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	577 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	578 /* Update change mask and total TFT size */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	579 change_mask \|= (U8)(1UL << dst->tft_filter_id);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	580 total_size += size;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	581 /* Advance to next destination TFT */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	582 dst++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	583 count++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	584 } /* if (sm_tft_is_tft_in_mask()) */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	585 /* Skip to next input TFT */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	586 src_tft++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	587 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	588
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	589 dst_tft->c_tft_filter = (U8)count;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	590
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	591 return change_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	592 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	593
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	594 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	595 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	596 \| Function : sm_tft_copy_filter_numbers
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	597 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	598 \| Description : Copies filter IDs to dst_tft AIM struct (derived from tft_mask)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	599 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	600 \| Parameters : dst_tft - destination aim TFT structs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	601 \| tft_mask - TFT mask (determines which TFTs to consider)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	602 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	603 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	604 static void
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	605 sm_tft_copy_filter_numbers(/@special@/T_M_SM_tft *dst_tft,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	606 U8 tft_mask)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	607 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	608 int index, dst_idx;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	609
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	610 dst_tft->v_tft_filter_id = (U8)TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	611
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	612 for (index = 0, dst_idx = 0; index < (int)NAS_SIZE_TFT_FILTER; index++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	613 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	614 if (sm_tft_is_tft_in_mask((U8)index, tft_mask))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	615 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	616 dst_tft->tft_filter_id[dst_idx] = (U8)index;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	617 dst_idx++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	618 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	619 } /* for */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	620
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	621 /* Set counter to the number of filters numbers inserted */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	622 dst_tft->c_tft_filter_id = (U8)dst_idx;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	623 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	624
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	625 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	626 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	627 \| Function : sm_tft_update_active_tft
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	628 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	629 \| Description : Update context data structure with new active TFT as it would
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	630 \| be would the modification succeed.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	631 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	632 \| Parameters : context - context data
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	633 \| tft_mask - TFT mask (determines which TFTs to consider)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	634 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	635 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	636 static void
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	637 sm_tft_update_active_tft(/@special@/struct T_SM_CONTEXT_DATA *context,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	638 U8 change_mask)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	639 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	640 T_NAS_tft_pf req_tft, act_tft;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	641 U16 index;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	642 U8 req_mask, act_mask, add_mask, delete_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	643
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	644 req_mask = context->requested_tft.tft_precence_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	645 act_mask = context->active_tft.tft_precence_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	646 add_mask = req_mask & change_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	647 delete_mask = (U8)(0xffUL ^ req_mask) & change_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	648
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	649 if (req_mask == (U8)0) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	650 sm_nw_free_active_tft(context);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	651 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	652 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	653
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	654 TRACE_ASSERT(context->requested_tft.ptr_tft_pf != NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	655
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	656 /* Allocate active TFT memory, if required */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	657 if (act_mask == (U8)0 &&
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	658 /req_mask != (U8)0 &&/ /commented out because of previous return/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	659 context->active_tft.ptr_tft_pf == NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	660 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	661 sm_nw_allocate_active_tft(context);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	662 TRACE_ASSERT(context->active_tft.ptr_tft_pf != NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	663 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	664
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	665 /* Loop over TFTs, in order to find any TFTs to delete */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	666 for (index = 0; index < (U16)NAS_SIZE_TFT_FILTER; index++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	667 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	668 if (sm_tft_is_tft_in_mask((U8)index, delete_mask))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	669 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	670 /* Was filter removed ? If so, clear filter from mask and store */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	671 act_mask &= (U8)(0xffUL ^ 1UL << index);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	672 act_tft = sm_tft_get_active_tft_by_id(context, (U8)index);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	673 memset(act_tft, 0, sizeof(T_NAS_tft_pf));
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	674 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	675 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	676
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	677 for (index = 0, req_tft = context->requested_tft.ptr_tft_pf;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	678 index < (U16)context->requested_tft.c_tft_pf;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	679 index++, req_tft++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	680 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	681 U8 pf_id = req_tft->tft_pf_id;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	682
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	683 if (sm_tft_is_tft_in_mask(pf_id, add_mask))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	684 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	685 /* Copy any remaining requested TFTs into active TFT */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	686 act_mask \|= (U8)(1UL << pf_id);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	687 act_tft = sm_tft_get_active_tft_by_id(context, pf_id);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	688 memcpy(act_tft, req_tft, sizeof(T_NAS_tft_pf));
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	689 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	690 } /* for */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	691
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	692 context->active_tft.tft_precence_mask = act_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	693 context->active_tft.c_tft_pf = sm_tft_count_tfts_in_mask(act_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	694 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	695
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	696 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	697 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	698 \| Function : sm_tft_next_action
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	699 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	700 \| Description : Determines the next action to perform (opcode) on the TFTs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	701 \| for a context, and the filters affected.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	702 \| (8 upper bits is change mask; 8 lower bits is opcode)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	703 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	704 \| Parameters : context - context data
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	705 +------------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	706 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	707 static U16 sm_tft_next_action(struct T_SM_CONTEXT_DATA *context)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	708 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	709 U8 req_mask, act_mask, missing_mask, surplus_mask, replace_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	710 U16 index;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	711
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	712 req_mask = context->requested_tft.tft_precence_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	713 act_mask = context->active_tft.tft_precence_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	714
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	715 /* If requested TFT contains 0 filters, remove TFT altogether */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	716 if (context->requested_tft.c_tft_pf == (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	717 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	718 return (U16)M_SM_TFT_OPCODE_DELETE_TFT;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	719 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	720
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	721 TRACE_ASSERT(context->requested_tft.ptr_tft_pf != NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	722
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	723 /* If there are no activate TFT filters, and requested != 0, create new TFT */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	724 if (act_mask == (U8)0 && req_mask != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	725 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	726 return (U16)M_SM_TFT_OPCODE_CREATE_TFT \| (U16)req_mask << 8;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	727 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	728
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	729 /* Add filters, if requested filter count > active filter count or
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	730 * requested filters exist, that are not active. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	731 missing_mask = req_mask & (0xff ^ act_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	732
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	733 if (context->requested_tft.c_tft_pf > context->active_tft.c_tft_pf \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	734 missing_mask != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	735 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	736 return (U16)M_SM_TFT_OPCODE_ADD_FILTERS \| (U16)missing_mask << 8;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	737 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	738
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	739 /* Delete filters, if requested filter count < active filter count or
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	740 * active filters exist, that are not requested. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	741 surplus_mask = act_mask & (0xff ^ req_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	742
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	743 if (context->requested_tft.c_tft_pf < context->active_tft.c_tft_pf \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	744 surplus_mask != (U8)0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	745 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	746 return (U16)M_SM_TFT_OPCODE_DELETE_FILTERS \| (U16)surplus_mask << 8;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	747 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	748
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	749 /* Now, requested and active TFTs have the same filter numbers active;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	750 * We then need to check, whether the contents of the filters that
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	751 * have the same number also match. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	752 for (index = 0, replace_mask = (U8)0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	753 index < (U16)context->requested_tft.c_tft_pf;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	754 index++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	755 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	756 T_NAS_tft_pf *req_tft = &context->requested_tft.ptr_tft_pf[index];
d393cd9bb723 src/g23m-: initial import from Magnetite 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);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	758
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	759 if (!sm_tft_are_equal(req_tft, act_tft))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	760 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	761 replace_mask \|= (U8)(1UL << req_tft->tft_pf_id);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	762 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	763 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	764
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	765 if (replace_mask != (U8)0) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	766 return (U16)M_SM_TFT_OPCODE_REPLACE_FILTERS \| (U16)replace_mask << 8;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	767 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	768
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	769 /* Error. Nothing to change, or invalid configuration */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	770 return (U16)M_SM_TFT_OPCODE_SPARE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	771 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	772
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	773 /==== PUBLIC FUNCTIONS =====================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	774
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	775 U8 sm_tft_precence_mask(T_NAS_tft_pf *tft, U8 count)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	776 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	777 U16 index;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	778 U8 precence_mask = (U8)0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	779
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	780 for (index = 0; index < (U16)count; index++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	781 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	782 precence_mask \|= (1UL << tft[index].tft_pf_id);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	783 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	784
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	785 return precence_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	786 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	787
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	788 void sm_tft_convert_to_aim(struct T_SM_CONTEXT_DATA *context,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	789 /@out@/ T_M_SM_tft *dst_tft)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	790 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	791 U8 opcode, filter_mask, change_mask, max_count;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	792 U16 opcode_and_mask;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	793
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	794 T_NAS_tft_pf *src_tft = context->requested_tft.ptr_tft_pf;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	795 max_count = context->requested_tft.c_tft_pf;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	796
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	797 if (src_tft == NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	798 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	799 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	800 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	801
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	802 opcode_and_mask = sm_tft_next_action(context);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	803 opcode = (U8)(opcode_and_mask & 0xff);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	804 filter_mask = (U8)(opcode_and_mask >> 8);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	805
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	806 dst_tft->tft_opcode = opcode;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	807
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	808 switch (opcode)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	809 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	810 case M_SM_TFT_OPCODE_CREATE_TFT:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	811 case M_SM_TFT_OPCODE_ADD_FILTERS:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	812 case M_SM_TFT_OPCODE_REPLACE_FILTERS:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	813 TRACE_ASSERT(src_tft != NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	814 /* Copy filter count to air interface message TFT struct */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	815 change_mask = sm_tft_copy_filters(dst_tft, src_tft, max_count, filter_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	816 sm_tft_update_active_tft(context, change_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	817 dst_tft->tft_filter_count = sm_tft_count_tfts_in_mask(change_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	818 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	819
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	820 case M_SM_TFT_OPCODE_DELETE_TFT:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	821 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	822 * DELETE TFT can have no fields other than TFT opcode and
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	823 * filter count (== 0), and is thus complete.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	824 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	825 context->requested_tft.tft_precence_mask = (U8)0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	826 sm_tft_update_active_tft(context, (U8)0xff);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	827 dst_tft->tft_filter_count = (U8)0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	828 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	829
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	830 case M_SM_TFT_OPCODE_DELETE_FILTERS:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	831 TRACE_ASSERT(src_tft != NULL);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	832 /* Copy filter count to air interface message TFT struct */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	833 sm_tft_copy_filter_numbers(dst_tft, filter_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	834 sm_tft_update_active_tft(context, filter_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	835 dst_tft->tft_filter_count = sm_tft_count_tfts_in_mask(filter_mask);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	836 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	837
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	838 default:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	839 (void)TRACE_EVENT_P1("tft_convert_to_aim: ERROR!"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	840 "Invalid opcode (%d) - TFT skipped!", opcode);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	841 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	842 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	843 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	844
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	845 BOOL sm_tft_more_to_modify(struct T_SM_CONTEXT_DATA *context)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	846 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	847 int filter;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	848
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	849 (void)TRACE_FUNCTION("sm_tft_more_to_modify");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	850
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	851 if (context->requested_tft.c_tft_pf != context->active_tft.c_tft_pf \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	852 context->requested_tft.tft_precence_mask != context->active_tft.tft_precence_mask)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	853 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	854 return TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	855 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	856 if (context->requested_tft.c_tft_pf > (U8)0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	857 && context->requested_tft.ptr_tft_pf != NULL
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	858 && context->active_tft.ptr_tft_pf != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	859 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	860 for (filter = 0; filter < (int)context->requested_tft.c_tft_pf; filter++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	861 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	862 if (!sm_tft_are_equal(&context->requested_tft.ptr_tft_pf[filter],
d393cd9bb723 src/g23m-: initial import from Magnetite 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)))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	864 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	865 return TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	866 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	867 } /* for */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	868 } /* if (c_tft_pf > 0) */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	869 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	870 }

FreeCalypso > hg > fc-selenite

annotate src/g23m-gprs/sm/sm_tft.c @ 111:97297555c71a