fc-magnetite: src/g23m-fad/ip/ip

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 12 Oct 2016 05:40:46 +0000
parents
children

rev	line source
174 90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 +----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Project :
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul :
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 +----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \| All rights reserved.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| Instruments Berlin, AG
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| The receipt of or possession of this file does not convey
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| whole, or in part, without the specific written consent of
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 \| Texas Instruments Berlin, AG.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 +----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| Purpose : This Modul defines the functions for processing
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| of incomming primitives for the component
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 \| Internet Protocol of the mobile station
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 +----------------------------------------------------------------------------
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #define ENTITY_IP
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 /==== INCLUDES ===================================================/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include <string.h>
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #include "typedefs.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 #include "pconst.cdg"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include "vsi.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "macdef.h" /* Get PFREE_DESC2 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 #include "pconst.cdg"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "custom.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "gsm.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "cnf_ip.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "mon_ip.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 #include "prim.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 #include "pei.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 #include "tok.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 #include "ccdapi.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #include "dti.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 #include "ip.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "ip_udp.h"
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 \| PROJECT : WAP MODULE : ip_kerf.c \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 \| STATE : code ROUTINE : ip_packet_validator \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 PURPOSE : Checks for IP packet validity
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 BOOL ip_packet_validator (T_desc_list2 * desc_list)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 TRACE_FUNCTION ("ip_packet_validator()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 if (desc_list == NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 TRACE_ERROR ("desc_list == NULL in IP validator.");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 /* Loop once through all the list */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 register T_desc2 * desc = (T_desc2 *) desc_list->first;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 register unsigned length = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 while (desc != NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 /* Check consistency of descs */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 if (desc->size < desc->offset + desc->len)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 TRACE_ERROR (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 "Packet dropped: "
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 "desc->size < desc->offset + desc->len in IP validator."
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 );
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 /* This is a mistake. Must be DTI1. */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 /* desc->offset = 0; */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 /* desc->size = desc->len; */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 /* Make sure that all offsets are 0 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 if (desc->offset != 0)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 memmove (desc->buffer, desc->buffer + desc->offset, desc->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 desc->offset = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 /* Calculate the sum of lengths */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 length += desc->len;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 desc = (T_desc2 *) desc->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 /* Check desc_list->list_len */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 if (desc_list->list_len != length)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 TRACE_ERROR (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 "Packet dropped: "
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 "desc_list->list_len != length in IP validator."
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 );
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 /* This is a mistake. But we could live with it. */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 /* desc_list->list_len = (USHORT) length; */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 /* Need at least LEN_IP_HEADER_B bytes for one header */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 if (length < LEN_IP_HEADER_B)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 TRACE_ERROR (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 "Packet dropped: "
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 "length < LEN_IP_HEADER_B in IP validator."
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 );
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 /* Have enough bytes, but they may be distributed */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 desc = (T_desc2 *) desc_list->first;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 if (desc->len < LEN_IP_HEADER_B)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 /* Collect all bytes in one desc */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 T_desc2 * bigdesc = M_ALLOC (offsetof (T_desc2, buffer) + length);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 if (bigdesc == NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 TRACE_ERROR ("Not enough memory in IP validator.");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 bigdesc->next = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 bigdesc->offset = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 bigdesc->len = (USHORT) length;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 bigdesc->size = (USHORT) length;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 /* Loop again through all the list */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 length = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 while (desc != NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 T_desc2 * removable = desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 memcpy (bigdesc->buffer + length, desc->buffer, desc->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 length += desc->len;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 desc = (T_desc2 *) desc->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 MFREE (removable);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 desc_list->first = (ULONG) bigdesc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 desc = bigdesc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 /* Need at least GET_IP_HEADER_LEN_B() bytes for the IP header */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 if (length < (unsigned) GET_IP_HEADER_LEN_B (desc->buffer))
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 TRACE_ERROR (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 "Packet dropped: "
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 "length < GET_IP_HEADER_LEN_B() in IP validator."
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 );
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 /* Survived */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 return TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 \| STATE : code ROUTINE : free_primitive_data_ind \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 * Set a DTI_DATA_IND primitive free and the pointer to NULL
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 void free_primitive_data_ind (T_DTI2_DATA_IND ** dti_data_ind)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 TRACE_FUNCTION ("free_primitive_data_ind()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 if (dti_data_ind != NULL && *dti_data_ind != NULL) {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 PFREE_DESC2 (* dti_data_ind);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 *dti_data_ind = NULL;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 \| STATE : code ROUTINE : free_primitive_data_req \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 * Set a DTI_DATA_REQ primitive free and the pointer to NULL
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 void free_primitive_data_req (T_DTI2_DATA_REQ ** dti_data_req)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 TRACE_FUNCTION ("free_primitive_data_req()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 if (dti_data_req != NULL && *dti_data_req != NULL) {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 PFREE_DESC2 (* dti_data_req);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 *dti_data_req = NULL;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 \| PROJECT : WAP MODULE : IP \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 \| STATE : code ROUTINE : set_desc_len \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 * Set the new desc length and fix desc_list length
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 void set_desc_len (T_desc_list2 * desc_list, T_desc2 * desc, USHORT len_desc)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 TRACE_FUNCTION ("set_desc_len()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 desc_list->list_len = (USHORT) (desc_list->list_len + len_desc - desc->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 desc->len = len_desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 \| PROJECT : WAP MODULE : IP \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 \| STATE : code ROUTINE : del_rest_descs \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 * Free the next desc(s) from desc. Fix the list_len in desc_list
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 void del_rest_descs (T_desc_list2 * desc_list, T_desc2 * desc)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 BOOL go = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 T_desc2 * p_desc_last, * p_desc_start;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 TRACE_FUNCTION ("del_rest_descs()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 if (desc->next > 0)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 p_desc_start = desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 desc = (T_desc2 *) desc->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 do
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 p_desc_last = desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 if (desc->next > 0)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 desc = (T_desc2 *) desc->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 go = FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 desc_list->list_len = (USHORT)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 (desc_list->list_len - p_desc_last->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 MFREE (p_desc_last);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 while (go);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 desc = p_desc_start;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 desc->next = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 \| STATE : code ROUTINE : del_descs \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 * Free the desc(s)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 void del_descs (T_desc2 * desc)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 BOOL go = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 T_desc2 * p_desc_last;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 TRACE_FUNCTION ("del_descs()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 do
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 p_desc_last = desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 if (desc->next > 0)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 desc = (T_desc2 *) desc->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 go = FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 MFREE (p_desc_last);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 while (go);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 /** filter_out_in_desc
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 * cuts length bytes out of a T_desc2::buffer, starting at 'start'.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 * @param desc Pointer to a T_desc2
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 * @param start Start of the block to be cut out
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 * @param length Length of the block to be cut out
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 * @return TRUE if parameters are valid, FALSE if parameters are invalid
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 static BOOL filter_out_in_desc (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 T_desc2 * desc,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 USHORT start,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 USHORT length
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 ) {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 TRACE_FUNCTION ("filter_out_in_desc()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 if (desc != NULL && start + length <= desc->len) {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 memmove (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 desc->buffer + start,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 desc->buffer + start + length,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 desc->len - start - length
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 );
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 desc->len = (USHORT) (desc->len - length);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 return TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 } else {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 TRACE_ERROR ("Parameters are invalid in filter_out_in_desc().");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 return FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 /** truncate_descs
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 * truncates a T_desc_list2 to no more than new_length bytes.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 * @param desc_list Pointer to a T_desc_list2
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 * @param new_length Maximal new length of that T_desc_list2
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 void truncate_descs (T_desc_list2 * desc_list, USHORT new_length)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 TRACE_FUNCTION ("truncate_descs()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 if (desc_list != NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 T_desc2 pp_desc = (T_desc2 ) & desc_list->first;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 desc_list->list_len = 0; /* Will be recalculated, anyway */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 /* First a loop over all T_descs which will remain. */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 while (*pp_desc != NULL && new_length != 0)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 if (new_length < (*pp_desc)->len)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 (*pp_desc)->len = new_length;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 new_length = (USHORT) (new_length - (*pp_desc)->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 desc_list->list_len = /* Recalculation */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 (USHORT) (desc_list->list_len + (*pp_desc)->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 pp_desc = (T_desc2 *) & (pp_desc)->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 /* Second a loop over all T_descs which have to be deleted, if any. */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 while (*pp_desc != NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 T_desc2 * p_desc_removable = *pp_desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 pp_desc = (T_desc2 ) p_desc_removable->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 MFREE (p_desc_removable);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 /* This way, new_length==0 at function call results in
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 * desc_list->first==NULL at function return. */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 /* Third a loop over all T_descs which have to be created, if any.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 * (If it were Prokrustes, not truncation,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 * we would have to allocate new T_descs here.)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 * while (new_length != 0) { ... } */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 TRACE_ERROR ("truncate_descs() called without T_desc_list2.");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 TRACE_ASSERT (0);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 \| STATE : code ROUTINE : insert_sort_descs \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 * Insert a new descriptor sorted by fragment offset.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 * The less value at first. Filter out descs with same offset.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 static void insert_sort_desc (T_desc_list2 * desc_list, T_desc2 * p_new_desc)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 if (desc_list != NULL && p_new_desc != NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 T_desc2 * desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 T_desc2 * p_desc_last;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 UBYTE * ip_header;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 USHORT offset, new_offset;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 offset = 0xffff;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 ip_header = p_new_desc->buffer;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 new_offset = (USHORT) GET_IP_FRAG_OFFSET (ip_header);/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) /
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 desc = (T_desc2 *) desc_list->first;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 p_desc_last = NULL;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 while (desc NEQ NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 ip_header = desc->buffer;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 offset = (USHORT) GET_IP_FRAG_OFFSET (ip_header);/lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) /
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 if (new_offset <= offset)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 break;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 p_desc_last = desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 desc = (T_desc2 *) desc->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 if (new_offset EQ offset)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 /* Two descriptors with the same offset
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 * Throw away the new one */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 MFREE (p_new_desc);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 /* Insert descriptor after p_desc_last */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 if (p_desc_last EQ NULL)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 p_new_desc->next = desc_list->first;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 desc_list->first = (ULONG) p_new_desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 p_new_desc->next = p_desc_last->next;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 p_desc_last->next = (ULONG) p_new_desc;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 /* Add the length of the new descriptor */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 desc_list->list_len = (USHORT) (desc_list->list_len + p_new_desc->len);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 /*
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 \| STATE : code ROUTINE : reassemble_fragments \|
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 +--------------------------------------------------------------------+
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 *
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 * Reassemble fragments coming in downlink
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 void reassemble_fragments (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 T_DTI2_DATA_IND ** dti_data_ind,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 T_LOLA * p_dl,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 UBYTE * ip_header,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 BOOL first_segment,
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 /* BOOL middle_segment, */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 BOOL last_segment /,/
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 /* USHORT fragm_offset */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 ) {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 USHORT fragm_id, header_len_b, offset;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 UBYTE fragm_prot;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 ULONG server_source_addr;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 BOOL found_source_addr = FALSE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 TRACE_FUNCTION ("reassemble_fragments()");
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 fragm_id = (USHORT) GET_IP_IDENT (ip_header);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 fragm_prot = GET_IP_PROT (ip_header);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 server_source_addr = GET_IP_SOURCE_ADDR (ip_header);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 /* Check source address from server */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 p_dl->pos_server = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 do
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 if (p_dl->ip_source_addr_segment[p_dl->pos_server] NEQ server_source_addr)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 p_dl->pos_server++;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 else
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 found_source_addr = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 } while (! found_source_addr && p_dl->pos_server < MAX_SEGM_SERVER);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 /* Select the server - by only one server p_dl->pos_server = 0 */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 if (p_dl->pos_server EQ MAX_SEGM_SERVER)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 p_dl->pos_server = 0;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 p_dl->ip_source_addr_segment[p_dl->pos_server] = server_source_addr;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 /* Check if it is the first or the last segment */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 if (first_segment)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 p_dl->got_first_segment[p_dl->pos_server] = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 if (last_segment)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 p_dl->got_last_segment[p_dl->pos_server] = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 /* Is it the first of any segment type? */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 if (p_dl->state_reassembly[p_dl->pos_server] EQ NO_SEGMENTS)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 p_dl->data_ind_reassembly[p_dl->pos_server] = *dti_data_ind;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 p_dl->state_reassembly[p_dl->pos_server] = READ_SEGMENT;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 p_dl->id_reassemble[p_dl->pos_server] = fragm_id;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 p_dl->prot_reassemble[p_dl->pos_server] = fragm_prot;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 /* Start reassembly timer */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 /* Implementation problem: the timer index must be
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 * layer variable is not forwarded to the function.
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 * It works, because layer is ever set to 0 in the moment. */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 vsi_t_start (VSI_CALLER p_dl->pos_server, TIME_REASSEMBLY);
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 p_dl->timer_reass_running[p_dl->pos_server] = TRUE;
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 }
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 /* Check the fragment ID and protocol. If not the same - free resources */
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 else if (
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 (p_dl->id_reassemble[p_dl->pos_server] NEQ fragm_id) OR
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 (p_dl->prot_reassemble[p_dl->pos_server] NEQ fragm_prot)
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 ) {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 if (p_dl->timer_reass_running[p_dl->pos_server])
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 {
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 /* Implementation problem: the timer index must be
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The
90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 * layer variable is not forwarded to the function.

174

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2 +----------------------------------------------------------------------------

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

3 | Project :

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

4 | Modul :

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

5 +----------------------------------------------------------------------------

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

8 |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

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

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

10 | Instruments Berlin, AG

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

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

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

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

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

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

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

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

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

15 | Texas Instruments Berlin, AG.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

16 +----------------------------------------------------------------------------

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

17 | Purpose : This Modul defines the functions for processing

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

18 | of incomming primitives for the component

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

19 | Internet Protocol of the mobile station

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

20 +----------------------------------------------------------------------------

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

21 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

22

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

23 #define ENTITY_IP

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

24

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

25 /*==== INCLUDES ===================================================*/

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

26

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

27 #include <string.h>

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

28 #include "typedefs.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

29 #include "pconst.cdg"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

30 #include "vsi.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

31 #include "macdef.h" /* Get PFREE_DESC2 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

32 #include "pconst.cdg"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

33 #include "custom.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

34 #include "gsm.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

35 #include "cnf_ip.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

36 #include "mon_ip.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

37 #include "prim.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

38 #include "pei.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

39 #include "tok.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

40 #include "ccdapi.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

41 #include "dti.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

42 #include "ip.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

43 #include "ip_udp.h"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

44

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

45 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

46 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

47 | PROJECT : WAP MODULE : ip_kerf.c |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

48 | STATE : code ROUTINE : ip_packet_validator |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

49 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

50

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

51 PURPOSE : Checks for IP packet validity

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

52 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

53 BOOL ip_packet_validator (T_desc_list2 * desc_list)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

54 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

55 TRACE_FUNCTION ("ip_packet_validator()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

56

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

57 if (desc_list == NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

58 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

59 TRACE_ERROR ("desc_list == NULL in IP validator.");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

60 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

61 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

62

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

63 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

64 /* Loop once through all the list */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

65 register T_desc2 * desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

66 register unsigned length = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

67 while (desc != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

68 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

69 /* Check consistency of descs */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

70 if (desc->size < desc->offset + desc->len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

71 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

72 TRACE_ERROR (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

73 "Packet dropped: "

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

74 "desc->size < desc->offset + desc->len in IP validator."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

75 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

76 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

77 /* This is a mistake. Must be DTI1. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

78 /* desc->offset = 0; */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

79 /* desc->size = desc->len; */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

80 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

81 /* Make sure that all offsets are 0 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

82 if (desc->offset != 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

83 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

84 memmove (desc->buffer, desc->buffer + desc->offset, desc->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

85 desc->offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

86 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

87 /* Calculate the sum of lengths */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

88 length += desc->len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

89 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

90 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

91 /* Check desc_list->list_len */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

92 if (desc_list->list_len != length)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

93 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

94 TRACE_ERROR (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

95 "Packet dropped: "

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

96 "desc_list->list_len != length in IP validator."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

97 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

98 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

99 /* This is a mistake. But we could live with it. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

100 /* desc_list->list_len = (USHORT) length; */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

101 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

102

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

103 /* Need at least LEN_IP_HEADER_B bytes for one header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

104 if (length < LEN_IP_HEADER_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

105 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

106 TRACE_ERROR (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

107 "Packet dropped: "

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

108 "length < LEN_IP_HEADER_B in IP validator."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

109 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

110 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

111 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

112

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

113 /* Have enough bytes, but they may be distributed */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

114 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

115 if (desc->len < LEN_IP_HEADER_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

116 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

117 /* Collect all bytes in one desc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

118 T_desc2 * bigdesc = M_ALLOC (offsetof (T_desc2, buffer) + length);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

119 if (bigdesc == NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

120 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

121 TRACE_ERROR ("Not enough memory in IP validator.");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

122 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

123 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

124

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

125 bigdesc->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

126 bigdesc->offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

127 bigdesc->len = (USHORT) length;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

128 bigdesc->size = (USHORT) length;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

129

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

130 /* Loop again through all the list */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

131 length = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

132 while (desc != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

133 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

134 T_desc2 * removable = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

135 memcpy (bigdesc->buffer + length, desc->buffer, desc->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

136 length += desc->len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

137 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

138 MFREE (removable);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

139 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

140 desc_list->first = (ULONG) bigdesc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

141 desc = bigdesc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

142 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

143

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

144 /* Need at least GET_IP_HEADER_LEN_B() bytes for the IP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

145 if (length < (unsigned) GET_IP_HEADER_LEN_B (desc->buffer))

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

146 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

147 TRACE_ERROR (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

148 "Packet dropped: "

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

149 "length < GET_IP_HEADER_LEN_B() in IP validator."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

150 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

151 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

152 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

153

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

154 /* Survived */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

155 return TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

156 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

157 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

158

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

159 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

160 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

161 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

162 | STATE : code ROUTINE : free_primitive_data_ind |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

163 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

164 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

165 * Set a DTI_DATA_IND primitive free and the pointer to NULL

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

166 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

167 void free_primitive_data_ind (T_DTI2_DATA_IND ** dti_data_ind)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

168 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

169 TRACE_FUNCTION ("free_primitive_data_ind()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

170

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

171 if (dti_data_ind != NULL && *dti_data_ind != NULL) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

172 PFREE_DESC2 (* dti_data_ind);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

173 *dti_data_ind = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

174 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

175 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

176

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

177 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

178 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

179 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

180 | STATE : code ROUTINE : free_primitive_data_req |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

181 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

182 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

183 * Set a DTI_DATA_REQ primitive free and the pointer to NULL

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

184 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

185 void free_primitive_data_req (T_DTI2_DATA_REQ ** dti_data_req)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

186 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

187 TRACE_FUNCTION ("free_primitive_data_req()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

188

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

189 if (dti_data_req != NULL && *dti_data_req != NULL) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

190 PFREE_DESC2 (* dti_data_req);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

191 *dti_data_req = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

192 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

193 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

194

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

195 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

196 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

197 | PROJECT : WAP MODULE : IP |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

198 | STATE : code ROUTINE : set_desc_len |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

199 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

200 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

201 * Set the new desc length and fix desc_list length

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

202 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

203 void set_desc_len (T_desc_list2 * desc_list, T_desc2 * desc, USHORT len_desc)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

204 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

205 TRACE_FUNCTION ("set_desc_len()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

206

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

207 desc_list->list_len = (USHORT) (desc_list->list_len + len_desc - desc->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

208 desc->len = len_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

209 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

210

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

211 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

212 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

213 | PROJECT : WAP MODULE : IP |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

214 | STATE : code ROUTINE : del_rest_descs |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

215 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

216 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

217 * Free the next desc(s) from desc. Fix the list_len in desc_list

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

218 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

219 void del_rest_descs (T_desc_list2 * desc_list, T_desc2 * desc)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

220 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

221 BOOL go = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

222 T_desc2 * p_desc_last, * p_desc_start;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

223

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

224 TRACE_FUNCTION ("del_rest_descs()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

225

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

226 if (desc->next > 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

227 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

228 p_desc_start = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

229 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

230

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

231 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

232 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

233 p_desc_last = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

234

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

235 if (desc->next > 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

236 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

237 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

238 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

239

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

240 desc_list->list_len = (USHORT)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

241 (desc_list->list_len - p_desc_last->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

242 MFREE (p_desc_last);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

243 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

244 while (go);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

245

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

246 desc = p_desc_start;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

247 desc->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

248 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

249 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

250

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

251 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

252 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

253 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

254 | STATE : code ROUTINE : del_descs |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

255 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

256 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

257 * Free the desc(s)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

258 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

259 void del_descs (T_desc2 * desc)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

260 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

261 BOOL go = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

262 T_desc2 * p_desc_last;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

263

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

264 TRACE_FUNCTION ("del_descs()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

265

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

266 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

267 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

268 p_desc_last = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

269

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

270 if (desc->next > 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

271 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

272 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

273 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

274

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

275 MFREE (p_desc_last);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

276 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

277 while (go);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

278 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

279

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

280 /** filter_out_in_desc

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

281 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

282 * cuts length bytes out of a T_desc2::buffer, starting at 'start'.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

283 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

284 * @param desc Pointer to a T_desc2

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

285 * @param start Start of the block to be cut out

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

286 * @param length Length of the block to be cut out

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

287 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

288 * @return TRUE if parameters are valid, FALSE if parameters are invalid

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

289 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

290 static BOOL filter_out_in_desc (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

291 T_desc2 * desc,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

292 USHORT start,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

293 USHORT length

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

294 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

295 TRACE_FUNCTION ("filter_out_in_desc()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

296

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

297 if (desc != NULL && start + length <= desc->len) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

298 memmove (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

299 desc->buffer + start,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

300 desc->buffer + start + length,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

301 desc->len - start - length

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

302 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

303 desc->len = (USHORT) (desc->len - length);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

304 return TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

305 } else {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

306 TRACE_ERROR ("Parameters are invalid in filter_out_in_desc().");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

307 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

308 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

309 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

310

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

311 /** truncate_descs

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

312 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

313 * truncates a T_desc_list2 to no more than new_length bytes.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

314 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

315 * @param desc_list Pointer to a T_desc_list2

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

316 * @param new_length Maximal new length of that T_desc_list2

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

317 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

318 void truncate_descs (T_desc_list2 * desc_list, USHORT new_length)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

319 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

320 TRACE_FUNCTION ("truncate_descs()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

321

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

322 if (desc_list != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

323 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

324 T_desc2 ** pp_desc = (T_desc2 **) & desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

325 desc_list->list_len = 0; /* Will be recalculated, anyway */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

326

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

327 /* First a loop over all T_descs which will remain. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

328 while (*pp_desc != NULL && new_length != 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

329 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

330 if (new_length < (*pp_desc)->len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

331 (*pp_desc)->len = new_length;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

332 new_length = (USHORT) (new_length - (*pp_desc)->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

333 desc_list->list_len = /* Recalculation */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

334 (USHORT) (desc_list->list_len + (*pp_desc)->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

335 pp_desc = (T_desc2 **) & (*pp_desc)->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

336 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

337

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

338 /* Second a loop over all T_descs which have to be deleted, if any. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

339 while (*pp_desc != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

340 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

341 T_desc2 * p_desc_removable = *pp_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

342 *pp_desc = (T_desc2 *) p_desc_removable->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

343 MFREE (p_desc_removable);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

344 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

345

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

346 /* This way, new_length==0 at function call results in

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

347 * desc_list->first==NULL at function return. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

348

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

349 /* Third a loop over all T_descs which have to be created, if any.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

350 * (If it were Prokrustes, not truncation,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

351 * we would have to allocate new T_descs here.)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

352 * while (new_length != 0) { ... } */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

353 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

354 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

355 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

356 TRACE_ERROR ("truncate_descs() called without T_desc_list2.");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

357 TRACE_ASSERT (0);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

358 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

359 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

360

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

361 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

362 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

363 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

364 | STATE : code ROUTINE : insert_sort_descs |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

365 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

366 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

367 * Insert a new descriptor sorted by fragment offset.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

368 * The less value at first. Filter out descs with same offset.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

369 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

370 static void insert_sort_desc (T_desc_list2 * desc_list, T_desc2 * p_new_desc)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

371 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

372 if (desc_list != NULL && p_new_desc != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

373 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

374 T_desc2 * desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

375 T_desc2 * p_desc_last;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

376 UBYTE * ip_header;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

377 USHORT offset, new_offset;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

378

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

379 offset = 0xffff;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

380 ip_header = p_new_desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

381 new_offset = (USHORT) GET_IP_FRAG_OFFSET (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

382 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

383 p_desc_last = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

384

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

385 while (desc NEQ NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

386 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

387 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

388 offset = (USHORT) GET_IP_FRAG_OFFSET (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

389 if (new_offset <= offset)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

390 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

391 p_desc_last = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

392 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

393 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

394

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

395 if (new_offset EQ offset)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

396 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

397 /* Two descriptors with the same offset

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

398 * Throw away the new one */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

399 MFREE (p_new_desc);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

400 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

401 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

402 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

403 /* Insert descriptor after p_desc_last */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

404 if (p_desc_last EQ NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

405 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

406 p_new_desc->next = desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

407 desc_list->first = (ULONG) p_new_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

408 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

409 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

410 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

411 p_new_desc->next = p_desc_last->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

412 p_desc_last->next = (ULONG) p_new_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

413 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

414

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

415 /* Add the length of the new descriptor */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

416 desc_list->list_len = (USHORT) (desc_list->list_len + p_new_desc->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

417 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

418 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

419 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

420

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

421 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

422 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

423 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

424 | STATE : code ROUTINE : reassemble_fragments |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

425 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

426 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

427 * Reassemble fragments coming in downlink

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

428 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

429 void reassemble_fragments (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

430 T_DTI2_DATA_IND ** dti_data_ind,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

431 T_LOLA * p_dl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

432 UBYTE * ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

433 BOOL first_segment,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

434 /* BOOL middle_segment, */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

435 BOOL last_segment /*,*/

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

436 /* USHORT fragm_offset */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

437 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

438 USHORT fragm_id, header_len_b, offset;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

439 UBYTE fragm_prot;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

440 ULONG server_source_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

441 BOOL found_source_addr = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

442

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

443 TRACE_FUNCTION ("reassemble_fragments()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

444

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

445 fragm_id = (USHORT) GET_IP_IDENT (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

446 fragm_prot = GET_IP_PROT (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

447 server_source_addr = GET_IP_SOURCE_ADDR (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

448

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

449 /* Check source address from server */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

450 p_dl->pos_server = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

451 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

452 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

453 if (p_dl->ip_source_addr_segment[p_dl->pos_server] NEQ server_source_addr)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

454 p_dl->pos_server++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

455 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

456 found_source_addr = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

457

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

458 } while (! found_source_addr && p_dl->pos_server < MAX_SEGM_SERVER);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

459

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

460 /* Select the server - by only one server p_dl->pos_server = 0 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

461 if (p_dl->pos_server EQ MAX_SEGM_SERVER)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

462 p_dl->pos_server = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

463

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

464 p_dl->ip_source_addr_segment[p_dl->pos_server] = server_source_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

465

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

466 /* Check if it is the first or the last segment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

467 if (first_segment)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

468 p_dl->got_first_segment[p_dl->pos_server] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

469

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

470 if (last_segment)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

471 p_dl->got_last_segment[p_dl->pos_server] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

472

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

473 /* Is it the first of any segment type? */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

474 if (p_dl->state_reassembly[p_dl->pos_server] EQ NO_SEGMENTS)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

475 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

476 p_dl->data_ind_reassembly[p_dl->pos_server] = *dti_data_ind;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

477 p_dl->state_reassembly[p_dl->pos_server] = READ_SEGMENT;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

478 p_dl->id_reassemble[p_dl->pos_server] = fragm_id;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

479 p_dl->prot_reassemble[p_dl->pos_server] = fragm_prot;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

480

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

481 /* Start reassembly timer */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

482

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

483 /* Implementation problem: the timer index must be

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

484 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

485 * layer variable is not forwarded to the function.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

486 * It works, because layer is ever set to 0 in the moment. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

487

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

488 vsi_t_start (VSI_CALLER p_dl->pos_server, TIME_REASSEMBLY);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

489 p_dl->timer_reass_running[p_dl->pos_server] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

490 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

491 /* Check the fragment ID and protocol. If not the same - free resources */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

492 else if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

493 (p_dl->id_reassemble[p_dl->pos_server] NEQ fragm_id) OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

494 (p_dl->prot_reassemble[p_dl->pos_server] NEQ fragm_prot)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

495 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

496 if (p_dl->timer_reass_running[p_dl->pos_server])

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

497 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

498 /* Implementation problem: the timer index must be

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

499 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

500 * layer variable is not forwarded to the function.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

501 * It works, because layer is ever set to 0 in the moment. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

502

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

503 csf_stop_timer (p_dl->pos_server);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

504 p_dl->timer_reass_running[p_dl->pos_server] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

505 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

506

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

507 p_dl->drop_packet = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

508 p_dl->state_reassembly[p_dl->pos_server] = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

509

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

510 free_primitive_data_ind (p_dl->data_ind_reassembly + p_dl->pos_server);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

511

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

512 /* Note: We could generate an ICMP packet */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

513 return;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

514 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

515 else /* Got correct segments before */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

516 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

517 /* Note: The whole datagram must be in the same descriptor */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

518 /* Note: The timeout value should be changed to MAX (TTL, TIME_REASSEMBLY) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

519

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

520 BOOL all_fragments_received = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

521

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

522 T_desc_list2 * desc_list = & p_dl->data_ind_reassembly[p_dl->pos_server]->desc_list2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

523 T_desc2 * desc = (T_desc2 *) p_dl->dti_data_ind->desc_list2.first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

524

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

525 if (desc == NULL || (T_desc2 *) desc_list->first == NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

526 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

527 TRACE_ERROR ("Pointer is NULL.");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

528 return;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

529 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

530

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

531 /* Insert the descriptor in the right position, according to the offset */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

532 insert_sort_desc (desc_list, desc);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

533

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

534 /* Check if got all fragments */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

535

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

536 if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

537 p_dl->got_first_segment[p_dl->pos_server] AND

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

538 p_dl->got_last_segment[p_dl->pos_server]

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

539 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

540 BOOL go = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

541 USHORT data_len, next_offset;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

542 UBYTE * ip_packet;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

543 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

544 ip_packet = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

545 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

546 data_len = (USHORT) (desc->len - header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

547 next_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

548 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

549 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

550 if ((T_desc2 *) desc->next != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

551 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

552 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

553 ip_packet = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

554 next_offset = (USHORT) GET_IP_FRAG_OFFSET_B (ip_packet);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

555 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

556

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

557 if ((T_desc2 *) desc->next != NULL)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

558 data_len = (USHORT) (data_len + desc->len - header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

559 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

560 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

561 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

562 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

563 while (go);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

564

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

565 if (data_len >= next_offset)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

566 all_fragments_received = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

567 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

568

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

569 /* Reassemble the fragments */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

570

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

571 if (all_fragments_received)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

572 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

573 BOOL go = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

574 USHORT len_fragments, header_len_b_first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

575 T_desc2 * p_desc_first, * p_desc_last;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

576 UBYTE * ip_packet;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

577

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

578 p_dl->state_reassembly[p_dl->pos_server] = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

579

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

580 if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

581 desc_list == NULL ||

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

582 (T_desc2 *) desc_list->first == NULL ||

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

583 (T_desc2 *) ((T_desc2*)desc_list->first)->next == NULL

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

584 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

585 TRACE_ERROR ("Pointer is NULL.");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

586 return;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

587 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

588

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

589 /* Fix the first desc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

590 p_desc_first = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

591 ip_packet = p_desc_first->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

592 header_len_b_first = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

593

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

594 /* Start from next desc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

595 desc = (T_desc2 *) p_desc_first->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

596 ip_packet = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

597 offset = (USHORT) GET_IP_FRAG_OFFSET_B (ip_packet);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

598 p_desc_first->len = (USHORT) (offset + header_len_b_first);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

599 len_fragments = offset;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

600

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

601 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

602 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

603 if (desc->next NEQ 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

604 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

605 p_desc_last = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

606 desc = (T_desc2 *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

607

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

608 /* Get the fragment offset */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

609 ip_packet = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

610 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

611 offset = (USHORT) GET_IP_FRAG_OFFSET_B (ip_packet);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

612

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

613 /* Filter out IP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

614 ip_packet = p_desc_last->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

615 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

616 filter_out_in_desc (p_desc_last, 0, header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

617

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

618 len_fragments = (USHORT) (len_fragments + p_desc_last->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

619 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

620 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

621 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

622 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

623

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

624 /* Filter out last IP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

625 ip_packet = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

626 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

627 filter_out_in_desc (desc, 0, header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

628

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

629 len_fragments = (USHORT) (len_fragments + desc->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

630 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

631 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

632 while (go);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

633

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

634 /* Build the IP datagram */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

635

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

636 /* Implementation problem: the timer index must be

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

637 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

638 * layer variable is not forwarded to the function.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

639 * It works, because layer is ever set to 0 in the moment. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

640

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

641 csf_stop_timer (p_dl->pos_server);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

642 p_dl->timer_reass_running[p_dl->pos_server] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

643 /* PFREE (dti_data_ind); */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

644 /* Is being freed elsewhere. Would anyway have false level of indirection. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

645 p_dl->data_ind_reassembly[p_dl->pos_server]->desc_list2.list_len =

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

646 (USHORT) (len_fragments + header_len_b_first);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

647

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

648 *dti_data_ind = p_dl->data_ind_reassembly[p_dl->pos_server];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

649 p_desc_first = (T_desc2 *) (*dti_data_ind)->desc_list2.first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

650 ip_packet = p_desc_first->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

651

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

652 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

653 ULONG dest_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

654 UBYTE ttl;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

655 dest_addr = GET_IP_DEST_ADDR (ip_packet);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

656 ttl = GET_IP_TTL (ip_packet);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

657

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

658 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

659 ip_packet,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

660 fragm_id,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

661 (UBYTE) (header_len_b_first >> 2),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

662 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

663 ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

664 p_dl->ip_source_addr_segment[p_dl->pos_server],

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

665 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

666 (UBYTE) (len_fragments + header_len_b_first),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

667 NO_OFFSET_FRAG,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

668 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

669 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

670 fragm_prot

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

671 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

672 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

673 p_dl->data_ind_reassembly[p_dl->pos_server] = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

674 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

675 /* else */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

676 /* PFREE (dti_data_ind); */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

677 /* Is being freed elsewhere. Would anyway have false level of indirection. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

678 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

679

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

680 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

681

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

682 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

683 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

684 | PROJECT : WAP MODULE : IP |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

685 | STATE : code ROUTINE : put_desc_first_pos |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

686 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

687 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

688 * Put desc on the first position of a desc_list.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

689 * Set the new list_len in desc_list.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

690 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

691 void put_desc_first_pos (T_desc_list2 * desc_list, T_desc2 * p_desc_new)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

692 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

693 ULONG help;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

694 T_desc2 * p_desc_help;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

695

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

696 TRACE_FUNCTION ("put_desc_first_pos()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

697

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

698 p_desc_help = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

699

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

700 if (p_desc_help NEQ p_desc_new)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

701 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

702 help = desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

703 desc_list->first = (ULONG) p_desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

704 p_desc_new->next = help;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

705 desc_list->list_len = (USHORT) (desc_list->list_len + p_desc_new->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

706 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

707 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

708

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

709 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

710 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

711 | PROJECT : GSM-FaD (8444) MODULE : IP_KER |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

712 | STATE : code ROUTINE : copy_from_descs_to_desc |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

713 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

714 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

715 * Copy data from one or more descs into desc_new. Possible to use offset.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

716 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

717 void copy_from_descs_to_desc (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

718 T_desc2 ** desc,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

719 T_desc2 * desc_new,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

720 USHORT copy_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

721 USHORT offset_desc,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

722 USHORT offset_desc_new,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

723 USHORT * pos_copy,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

724 USHORT * total_len_copy

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

725 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

726 BOOL go = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

727 *pos_copy = offset_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

728 *total_len_copy = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

729

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

730 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

731 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

732 while (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

733 (*pos_copy < (*desc)->len) AND

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

734 (offset_desc_new < desc_new->len) AND

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

735 (*total_len_copy < copy_len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

736 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

737 desc_new->buffer[offset_desc_new] = (*desc)->buffer[*pos_copy];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

738 offset_desc_new ++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

739 (*pos_copy)++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

740 (*total_len_copy)++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

741 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

742

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

743 if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

744 (*total_len_copy >= copy_len) OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

745 (offset_desc_new >= desc_new->len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

746 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

747 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

748 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

749 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

750 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

751 if (*pos_copy >= (*desc)->len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

752 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

753 if ((*desc)->next > 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

754 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

755 *desc = (T_desc2 *) (*desc)->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

756 *pos_copy = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

757 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

758 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

759 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

760 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

761 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

762 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

763 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

764 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

765 while (go);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

766 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

767

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

768 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

769 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

770 | PROJECT : WAP MODULE : IP |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

771 | STATE : code ROUTINE : make_new_desc |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

772 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

773 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

774 * Malloc a new desc. Init buffer 0 if buff_init_0 = TRUE

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

775 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

776 BOOL make_new_desc (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

777 T_desc2 ** p_desc_new,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

778 USHORT malloc_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

779 BOOL buff_init_0

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

780 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

781 TRACE_FUNCTION ("make_new_desc()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

782

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

783 MALLOC (*p_desc_new, offsetof (T_desc2, buffer) + malloc_len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

784 /* The target compiler issues a warning

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

785 * "pointer type conversion may violate alignment constraints"

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

786 * here and everywhere where MALLOC is being used. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

787

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

788 if (*p_desc_new EQ 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

789 return FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

790

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

791 if (buff_init_0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

792 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

793 USHORT i;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

794 for (i = 0; i < malloc_len; i++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

795 (*p_desc_new)->buffer[i] = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

796 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

797 (*p_desc_new)->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

798 (*p_desc_new)->offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

799 (*p_desc_new)->len = malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

800 (*p_desc_new)->size = malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

801 return TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

802 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

803

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

804 #if 0

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

805 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

806 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

807 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

808 | STATE : code ROUTINE : sort_descs_id_up |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

809 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

810 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

811 * Sort the descs with fragment offset. The less value at

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

812 * first. Filter out descs with same offset.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

813 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

814 USHORT sort_descs_id_up (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

815 T_desc_list * desc_list,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

816 ULONG sort_array[2][MAX_SEGMENTS]

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

817 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

818 T_desc * desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

819 USHORT i, n_descs, code;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

820 BOOL go = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

821 ULONG addr, wert;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

822 UBYTE * ip_header;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

823

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

824 TRACE_FUNCTION ("sort_descs_id_up()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

825

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

826 desc = (T_desc *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

827 n_descs = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

828 code = GO_ON_SEGMENTING;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

829

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

830 if (desc->next > 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

831 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

832 /* Write desc address and search-value into sort_array */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

833

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

834 desc = (T_desc *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

835

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

836 i = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

837 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

838 sort_array[1][i] = GET_IP_FRAG_OFFSET (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

839 sort_array[0][i++] = desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

840

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

841 do

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

842 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

843 if (desc->next > 0 AND i < MAX_SEGMENTS)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

844 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

845 desc = (T_desc *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

846 sort_array[0][i] = (ULONG) desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

847 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

848 sort_array[1][i++] = GET_IP_FRAG_OFFSET (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

849 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

850 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

851 go = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

852 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

853 while (go);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

854

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

855 /* Sort the array if not overflow */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

856

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

857 if (i < MAX_SEGMENTS)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

858 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

859 n_descs = i;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

860

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

861 for (i = 0; i < n_descs - 1; i++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

862 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

863 USHORT min, j;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

864 min = i;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

865

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

866 for (j = i + 1; j < n_descs; j++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

867 if (sort_array[1][j] < sort_array[1][min])

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

868 min = j;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

869

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

870 addr = sort_array[0][i];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

871 wert = sort_array[1][i];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

872 sort_array[0][i] = sort_array[0][min];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

873 sort_array[1][i] = sort_array[1][min];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

874 sort_array[0][min] = addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

875 sort_array[1][min] = wert;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

876 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

877

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

878 /* Filter out descs with same fragment offset */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

879 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

880 ULONG v1;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

881 USHORT j, k, len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

882 len = n_descs - 1;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

883 i = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

884 while (i < len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

885 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

886 v1 = sort_array[1][i];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

887 j = i + 1;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

888 if (v1 EQ sort_array[1][j])

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

889 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

890 k = j;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

891 n_descs--;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

892 while (k <= len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

893 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

894 sort_array[0][k] = sort_array[0][k + 1];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

895 sort_array[1][k] = sort_array[1][k + 1];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

896 k++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

897 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

898 len--;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

899 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

900 if (sort_array[1][i] NEQ sort_array[1][i + 1])

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

901 i++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

902 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

903 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

904

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

905 /* Put the descs together and correct the desc_list->list_len */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

906

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

907 desc_list->first = sort_array[0][0];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

908 desc = (T_desc *) sort_array[0][0];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

909 desc_list->list_len = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

910 desc_list->list_len = desc->len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

911

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

912 for (i = 1; i < n_descs; i++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

913 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

914 desc->next = sort_array[0][i];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

915 desc = (T_desc *) desc->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

916 desc_list->list_len = desc_list->list_len + desc->len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

917 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

918

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

919 desc->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

920 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

921 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

922 code = NO_SPACE_SEGMENTING;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

923

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

924 desc = (T_desc *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

925 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

926 return code;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

927 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

928 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

929

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

930 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

931 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

932 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

933 | STATE : code ROUTINE : build_ip_header |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

934 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

935 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

936 * Build IP header

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

937 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

938 void build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

939 UBYTE * ip_header_new,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

940 USHORT identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

941 UBYTE header_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

942 UBYTE type_of_service,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

943 UBYTE ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

944 ULONG src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

945 ULONG dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

946 USHORT total_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

947 USHORT fragm_offset,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

948 UBYTE df_flag,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

949 UBYTE mf_flag,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

950 UBYTE prot

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

951 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

952 USHORT chk_sum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

953

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

954 TRACE_FUNCTION ("build_ip_header()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

955

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

956 SET_IP_VERSION (ip_header_new, IP_VERSION);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

957 /*lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

958 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

959 SET_IP_HEADER_LEN (ip_header_new, header_len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

960 SET_IP_TYPE_OF_SERVICE (ip_header_new, type_of_service);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

961 SET_IP_TOTAL_LEN (ip_header_new, total_len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

962 SET_IP_IDENT (ip_header_new, identity);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

963 SET_IP_OFF_FLAG (ip_header_new, FLAG_NOT_SET);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

964 SET_IP_DF_FLAG (ip_header_new, df_flag);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

965 SET_IP_MF_FLAG (ip_header_new, mf_flag);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

966 SET_IP_FRAG_OFFSET (ip_header_new, fragm_offset);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

967 SET_IP_PROT (ip_header_new, prot);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

968 SET_IP_TTL (ip_header_new, ttl);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

969 SET_IP_SOURCE_ADDR (ip_header_new, src_addr);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

970 SET_IP_DEST_ADDR (ip_header_new, dest_addr);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

971 RESET_IP_CHECKSUM (ip_header_new);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

972 chk_sum = inet_checksum (ip_header_new, (USHORT) (header_len * 4));

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

973 SET_IP_CHECKSUM (ip_header_new, chk_sum);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

974 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

975 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

976

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

977 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

978 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

979 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

980 | STATE : code ROUTINE : build_icmp_packet |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

981 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

982 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

983 * Build IP icmp packet without payload

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

984 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

985 void build_icmp_packet (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

986 USHORT header_len_b,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

987 UBYTE typ,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

988 UBYTE code,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

989 UBYTE ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

990 UBYTE * ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

991 USHORT identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

992 ULONG dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

993 ULONG src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

994 T_desc_list2 * desc_list

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

995 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

996 USHORT chk_sum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

997 UBYTE header_len_b_bak;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

998

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

999 TRACE_FUNCTION ("build_icmp_packet()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1000

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1001 header_len_b_bak = (UBYTE) (header_len_b >> 2);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1002

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1003 /* Build ICMP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1004

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1005 SET_ICMP_TYPE (ip_header, typ, header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1006 SET_ICMP_CODE (ip_header, code, header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1007 RESET_ICMP_CHK_SUM (ip_header, header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1008 chk_sum = desc_checksum (desc_list, header_len_b, 0);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1009 SET_ICMP_CHK_SUM (ip_header, chk_sum, header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1010

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1011 /* Build IP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1012

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1013 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1014 ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1015 identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1016 header_len_b_bak,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1017 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1018 ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1019 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1020 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1021 desc_list->list_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1022 NO_OFFSET_FRAG,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1023 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1024 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1025 ICMP_PROT

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1026 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1027 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1028

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1029 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1030 +-------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1031 | PROJECT : WAP MODULE : IP |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1032 | STATE : code ROUTINE : build_icmp_with_payload |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1033 +-------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1034 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1035 * Build a ICMP packet with payload of 64 bits

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1036 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1037 void build_icmp_with_payload (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1038 T_DTI2_DATA_REQ * data_req,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1039 USHORT identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1040 UBYTE ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1041 ULONG src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1042 UBYTE icmp_type,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1043 UBYTE icmp_code

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1044 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1045 T_desc2 * desc_new, * desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1046 T_desc_list2 * desc_list;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1047 USHORT malloc_len, header_len_b, chk_sum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1048 UBYTE * ip_header;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1049 ULONG dest_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1050

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1051 #define LEN_ICMP_HEADER_PAYLOAD 8

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1052 #define LEN_PAYLOAD 8

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1053

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1054 TRACE_FUNCTION ("build_icmp_with_payload()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1055

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1056 desc_list = & data_req->desc_list2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1057 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1058 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1059 dest_addr = GET_IP_SOURCE_ADDR (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1060 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1061

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1062 /* Up to 8 bytes payload of the old datagram */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1063

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1064 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1065 USHORT help = (USHORT) (LEN_PAYLOAD + header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1066 if (help < desc->len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1067 set_desc_len (desc_list, desc, help);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1068 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1069

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1070 /* Throw away the rest descs if there are any */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1071

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1072 del_rest_descs (desc_list, desc);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1073

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1074 /* Make a new desc for the ICMP packet header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1075

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1076 malloc_len = LEN_ICMP_HEADER_PAYLOAD + LEN_IP_HEADER_B;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1077 make_new_desc (& desc_new, malloc_len, TRUE);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1078

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1079 /* Put the desc at the first place of the descs */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1080

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1081 put_desc_first_pos (desc_list, desc_new);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1082

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1083 /* Build the ICMP packet and the IP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1084

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1085 ip_header = desc_new->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1086 header_len_b = LEN_IP_HEADER_B;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1087

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1088 SET_ICMP_TYPE (ip_header, icmp_type, header_len_b);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1089 SET_ICMP_CODE (ip_header, icmp_code, header_len_b);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1090 RESET_ICMP_CHK_SUM (ip_header, header_len_b);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1091 chk_sum = desc_checksum (desc_list, header_len_b, 0);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1092 SET_ICMP_CHK_SUM (ip_header, chk_sum, header_len_b);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1093

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1094 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1095 ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1096 identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1097 MIN_HEADER_LEN,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1098 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1099 ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1100 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1101 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1102 desc_list->list_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1103 NO_OFFSET_FRAG,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1104 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1105 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1106 ICMP_PROT

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1107 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1108 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1109

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1110 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1111 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1112 | PROJECT : WAP MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1113 | STATE : code ROUTINE : init_ip |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1114 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1115 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1116 * Init the global parameter

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1117 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1118 void init_ip (void)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1119 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1120 T_HILA * p_ul = & ip_data->hila;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1121 T_LOLA * p_dl = & ip_data->lola;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1122 T_KER * p_ker = & ip_data->ker;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1123 USHORT j;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1124

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1125 INIT_STATE (HILA, DOWN);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1126 INIT_STATE (LOLA, DOWN);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1127 INIT_STATE (KER, DEACTIVATED);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1128

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1129 p_ul->dti_data_req = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1130 p_ul->drop_packet = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1131 p_ul->ttl = STANDARD_TTL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1132 p_ul->header_len = MIN_HEADER_LEN;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1133 p_ul->state_segment = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1134 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1135 p_ul->segment_prot = NO_PROT_ID;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1136 p_ul->first_desc_segment = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1137 p_ul->identity = IDENTITY_0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1138

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1139 p_dl->drop_packet = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1140 p_dl->dti_data_ind= NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1141 p_dl->pos_server = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1142

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1143 for (j = 0; j < MAX_SEGM_SERVER; j++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1144 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1145 p_dl->state_reassembly[j] = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1146 p_dl->got_first_segment[j] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1147 p_dl->got_last_segment[j] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1148 p_dl->ip_source_addr_segment[j] = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1149 p_dl->data_ind_reassembly[j] = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1150 p_dl->id_reassemble[j] = NO_ID_REASSBL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1151 p_dl->prot_reassemble[j] = NO_PROT_REASSBL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1152 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1153

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1154 p_ker->peer_addr = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1155 p_ker->netmask = INIT_NETMASK;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1156 p_ker->source_addr = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1157 p_ker->dst_addr = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1158

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1159 #ifdef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1160 p_ker->source_addr = TEST_SRC_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1161 p_ker->dst_addr = TEST_DEST_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1162 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1163

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1164 p_ker->entity_name_hl[0] = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1165 p_ker->entity_name_ll[0] = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1166

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1167 p_ker->link_id_ll = IPA_LINK_ID_DEFAULT;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1168 p_ker->link_id_hl = IPA_LINK_ID_DEFAULT;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1169

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1170 p_ker->mtu = NO_MTU;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1171 p_ker->icmp_dti_data_req = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1172 p_ker->send_icmp = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1173 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1174

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1175 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1176 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1177 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1178 | STATE : code ROUTINE : config_down_ll |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1179 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1180 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1181 * Config down a lower layer entity

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1182 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1183 void config_down_ll (void)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1184 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1185 T_HILA * p_ul = & ip_data->hila;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1186 T_LOLA * p_dl = & ip_data->lola;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1187 T_KER * p_ker = & ip_data->ker;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1188

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1189 USHORT j;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1190

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1191 TRACE_FUNCTION ("config_down_ll()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1192

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1193 free_primitive_data_ind (& p_dl->dti_data_ind);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1194 free_primitive_data_req (& p_ker->icmp_dti_data_req);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1195

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1196 for (j = 0; j < MAX_SEGM_SERVER; j++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1197 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1198 /* free_primitive_data_ind (p_dl->data_ind_reassembly + j); */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1199 /* Has already been freed five lines above, */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1200 /* because p_dl->dti_data_ind == p_dl->data_ind_reassembly. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1201 /* Please think anew when MAX_SEGM_SERVER becomes != 1. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1202

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1203 csf_stop_timer (j);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1204 p_dl->timer_reass_running[j] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1205

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1206 p_dl->state_reassembly[j] = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1207 p_dl->got_first_segment[j] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1208 p_dl->got_last_segment[j] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1209 p_dl->ip_source_addr_segment[j] = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1210 p_dl->data_ind_reassembly[j] = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1211 p_dl->id_reassemble[j] = NO_ID_REASSBL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1212 p_dl->prot_reassemble[j] = NO_PROT_REASSBL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1213 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1214

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1215 /* Keep STATE_WAIT are stored even if config down

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1216 * send READY_IND and set HILA STATE to IDLE if */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1217

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1218 switch (GET_STATE (HILA)) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1219 case WAIT: /* Keep state */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1220 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1221 case SEND: /* Send ready indication */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1222 dti_start (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1223 ip_hDTI,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1224 IP_DTI_DEF_INSTANCE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1225 IP_DTI_HL_INTERFACE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1226 IP_DTI_DEF_CHANNEL

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1227 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1228 default:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1229 SET_STATE (HILA, IDLE);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1230 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1231 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1232 SET_STATE (HILA, IDLE)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1233

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1234 p_ul->drop_packet = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1235 p_ul->state_segment = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1236 p_ul->header_len = MIN_HEADER_LEN;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1237 p_ul->ttl = STANDARD_TTL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1238 p_ul->segment_prot = NO_PROT_ID;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1239 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1240 p_ul->first_desc_segment = NULL;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1241

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1242 /* Be sure that STATE_WAIT are stored even if config down */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1243

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1244 if (GET_STATE (LOLA) NEQ WAIT)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1245 SET_STATE (LOLA, IDLE)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1246 p_dl->drop_packet = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1247

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1248 p_dl->pos_server = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1249

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1250 p_ker->peer_addr = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1251 p_ker->netmask = INIT_NETMASK;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1252 p_ker->source_addr = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1253 p_ker->dst_addr = NO_ADDR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1254 p_ker->entity_name_ll[0] = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1255 p_ker->mtu = NO_MTU;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1256 p_ker->send_icmp = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1257 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1258

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1259 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1260 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1261 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1262 | Sp_TATE : code ROUTINE : terminate_ip |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1263 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1264 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1265 * Handle global parameter by terminate

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1266 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1267 void terminate_ip (void)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1268 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1269 TRACE_FUNCTION ("terminate_ip()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1270

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1271 /* Shutdown lower entity interface */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1272 config_down_ll ();

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1273

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1274 /* Parameter for higher layer entity */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1275 ip_data->ker.entity_name_hl[0] = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1276 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1277

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1278 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1279 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1280 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1281 | STATE : code ROUTINE : ip_addr_int_to_byte |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1282 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1283 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1284 * Build the IP address in ULONG to 4 bytes

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1285 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1286 void ip_addr_int_to_byte (UBYTE * b_values, ULONG ul_value)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1287 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1288 TRACE_FUNCTION ("int_to_byte()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1289

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1290 b_values[3] = (UBYTE) (ul_value);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1291 b_values[2] = (UBYTE) (ul_value>>8);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1292 b_values[1] = (UBYTE) (ul_value>>16);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1293 b_values[0] = (UBYTE) (ul_value>>24);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1294 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1295

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1296 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1297 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1298 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1299 | STATE : code ROUTINE : chk_packet_len |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1300 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1301 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1302 * Check the IP packet length

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1303 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1304 UBYTE chk_packet_len (UBYTE * ip_header, T_desc_list2 * desc_list)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1305 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1306 USHORT total_len, chk_len, mtu_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1307

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1308 TRACE_FUNCTION ("chk_packet_len()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1309

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1310 /* This is the calculated length */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1311 total_len = desc_list->list_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1312

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1313 /* This is the length indicated in the IP header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1314 chk_len = (USHORT) GET_IP_TOTAL_LEN (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1315

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1316 /* This is the max defined packet length */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1317 mtu_len = ip_data->ker.mtu;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1318

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1319 if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1320 (chk_len < MIN_HEADER_LEN) OR (chk_len > total_len) OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1321 (total_len < MIN_HEADER_LEN) OR (chk_len > mtu_len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1322 )

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1323 return ERR_PACKET_LEN;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1324 else if (chk_len < total_len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1325 return CHANGE_PACKET_LEN;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1326 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1327 return NO_ERROR;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1328 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1329

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1330 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1331 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1332 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1333 | STATE : code ROUTINE : build_ip_packet |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1334 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1335 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1336 * Build the datagram or packets before sending

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1337 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1338 void build_ip_packet (BOOL uplink, UBYTE select)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1339 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1340 UBYTE * ip_header;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1341 USHORT total_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1342 ULONG dest_addr, src_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1343 T_desc_list2 * desc_list;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1344 T_desc2 * desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1345 T_HILA * p_ul = & ip_data->hila;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1346 T_LOLA * p_dl = & ip_data->lola;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1347 T_KER * p_ker = & ip_data->ker;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1348

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1349 T_DTI2_DATA_REQ * data_req;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1350 T_DTI2_DATA_IND * data_ind;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1351

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1352 TRACE_FUNCTION ("build_ip_packet()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1353

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1354 src_addr = p_ker->source_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1355

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1356 /* Build uplink packets */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1357

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1358 if (uplink)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1359 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1360 data_req = p_ul->dti_data_req;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1361

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1362 switch (select) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1363 /* Build "standard" IP packet */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1364 case B_NORMAL_PACKET:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1365

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1366 desc_list = & p_ul->dti_data_req->desc_list2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1367 total_len = desc_list->list_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1368 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1369 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1370 dest_addr = GET_IP_DEST_ADDR (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1371

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1372 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1373 ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1374 p_ul->identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1375 (UBYTE) p_ul->header_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1376 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1377 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1378 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1379 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1380 total_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1381 NO_OFFSET_FRAG,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1382 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1383 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1384 UDP_PROT

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1385 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1386 #ifndef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1387 p_ul->identity++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1388 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1389 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1390

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1391 /* Build IP header for ICMP messages. Note only ICMP from higher layer. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1392 case B_ICMP_PACKET:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1393

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1394 desc_list = & p_ul->dti_data_req->desc_list2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1395 total_len = desc_list->list_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1396 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1397 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1398 dest_addr = GET_IP_DEST_ADDR (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1399

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1400 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1401 ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1402 p_ul->identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1403 (UBYTE) p_ul->header_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1404 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1405 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1406 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1407 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1408 total_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1409 NO_OFFSET_FRAG,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1410 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1411 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1412 ICMP_PROT

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1413 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1414 #ifndef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1415 p_ul->identity++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1416 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1417 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1418

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1419 /* Build fragments. The first fragment use the original header from HL. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1420 case B_SEGMENT:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1421 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1422 /* Check if it is the first fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1423

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1424 if (p_ul->state_segment EQ NO_SEGMENTS)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1425 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1426 T_desc2 * desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1427 USHORT pos_copy, total_len_copy, malloc_len, header_len_b;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1428

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1429 desc_list = & p_ul->dti_data_req->desc_list2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1430 total_len = desc_list->list_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1431 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1432 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1433 dest_addr = GET_IP_DEST_ADDR (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1434 src_addr = p_ker->source_addr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1435 p_ul->header_len = (USHORT) GET_IP_HEADER_LEN (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1436 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1437

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1438 p_ul->state_segment = SEND_SEGMENT;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1439 p_ul->sended_segment_len = p_ker->mtu;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1440 p_ul->list_len_segment = total_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1441 p_ul->segment_prot = GET_IP_PROT (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1442 p_ul->first_desc_segment = desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1443 dest_addr = GET_IP_DEST_ADDR (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1444

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1445 /* Make a new desc for the fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1446

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1447 malloc_len = p_ker->mtu;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1448 make_new_desc (& desc_new, malloc_len, FALSE);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1449

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1450 data_req->desc_list2.first = (ULONG) desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1451 data_req->desc_list2.list_len = malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1452 desc_new->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1453

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1454 /* Build the first fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1455 copy_from_descs_to_desc (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1456 & desc, desc_new, malloc_len, 0, 0, & pos_copy, & total_len_copy

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1457 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1458 if (total_len_copy NEQ malloc_len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1459 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1460 /* Corrupted packet -> drop it */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1461 p_ul->drop_packet = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1462

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1463 /* Clean up and free the descs */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1464 del_descs (p_ul->first_desc_segment);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1465 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1466 p_ul->next_segment_desc = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1467 p_ul->last_segment_pos = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1468 p_ul->sended_segment_len = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1469 p_ul->state_segment = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1470 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1471 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1472 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1473 p_ul->segment_id = p_ul->identity;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1474 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1475

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1476 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1477 desc_new->buffer,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1478 p_ul->segment_id,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1479 (UBYTE) p_ul->header_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1480 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1481 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1482 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1483 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1484 malloc_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1485 (USHORT) (p_ul->segment_offset >> 3),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1486 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1487 FLAG_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1488 p_ul->segment_prot

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1489 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1490 #ifndef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1491 p_ul->identity++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1492 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1493

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1494 /* For the next fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1495 p_ul->segment_offset = (USHORT) (malloc_len - header_len_b);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1496 p_ul->next_segment_desc = (ULONG) desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1497 p_ul->last_segment_pos = pos_copy;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1498 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1499 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1500

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1501 /* Middle fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1502

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1503 else if (p_ul->sended_segment_len + p_ker->mtu <

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1504 p_ul->list_len_segment + LEN_IP_HEADER_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1505 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1506 T_desc2 * desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1507

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1508 USHORT pos_copy, total_len_copy, malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1509

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1510 /* Make a new primitive for the fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1511

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1512 PALLOC (dti_data_req, DTI2_DATA_REQ);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1513 p_ul->dti_data_req = dti_data_req;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1514

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1515 /* Malloc the fragment desc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1516

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1517 malloc_len = p_ker->mtu;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1518 make_new_desc (& desc_new, malloc_len, FALSE);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1519

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1520 dti_data_req->desc_list2.first = (ULONG) desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1521 dti_data_req->desc_list2.list_len = malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1522 desc_new->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1523

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1524 /* Copy the data into the fragment desc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1525

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1526 desc = (T_desc2 *) p_ul->next_segment_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1527 copy_from_descs_to_desc (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1528 & desc,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1529 desc_new,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1530 (USHORT) (malloc_len - LEN_IP_HEADER_B),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1531 p_ul->last_segment_pos,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1532 LEN_IP_HEADER_B,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1533 & pos_copy,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1534 & total_len_copy

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1535 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1536

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1537 if (total_len_copy NEQ malloc_len - LEN_IP_HEADER_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1538 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1539 /* Corrupted packet -> drop it */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1540 p_ul->drop_packet = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1541

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1542 /* Clean up and free the descs */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1543 del_descs (p_ul->first_desc_segment);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1544 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1545 p_ul->next_segment_desc = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1546 p_ul->last_segment_pos = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1547 p_ul->sended_segment_len = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1548 p_ul->state_segment = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1549 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1550 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1551 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1552 /* Build the IP fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1553

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1554 UBYTE * ip_header_first = p_ul->first_desc_segment->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1555 dest_addr = GET_IP_DEST_ADDR (ip_header_first);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1556

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1557 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1558 desc_new->buffer,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1559 p_ul->segment_id,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1560 MIN_HEADER_LEN,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1561 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1562 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1563 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1564 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1565 malloc_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1566 (USHORT) (p_ul->segment_offset >> 3),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1567 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1568 FLAG_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1569 p_ul->segment_prot

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1570 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1571

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1572 /* For the next fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1573 p_ul->segment_offset = (USHORT)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1574 (p_ul->segment_offset + malloc_len - LEN_IP_HEADER_B);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1575 p_ul->next_segment_desc = (ULONG) desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1576 p_ul->last_segment_pos = pos_copy;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1577 p_ul->sended_segment_len = (USHORT)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1578 (p_ul->sended_segment_len + malloc_len - LEN_IP_HEADER_B);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1579 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1580 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1581 else /* Last fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1582 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1583 T_desc2 * desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1584

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1585 USHORT pos_copy, total_len_copy, malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1586

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1587 /* Make a new primitive for the fragment */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1588

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1589 PALLOC (dti_data_req, DTI2_DATA_REQ);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1590 p_ul->dti_data_req = dti_data_req;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1591

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1592 /* Calculate the correct len for fragment desc and malloc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1593

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1594 malloc_len = (USHORT) (LEN_IP_HEADER_B +

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1595 p_ul->list_len_segment - p_ul->sended_segment_len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1596 make_new_desc (& desc_new, malloc_len, FALSE);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1597

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1598 dti_data_req->desc_list2.first = (ULONG) desc_new;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1599 dti_data_req->desc_list2.list_len = malloc_len;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1600 desc_new->next = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1601

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1602 /* Copy the data into the fragment desc */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1603

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1604 desc = (T_desc2 *) p_ul->next_segment_desc;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1605

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1606 copy_from_descs_to_desc (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1607 & desc,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1608 desc_new,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1609 (USHORT) (malloc_len - LEN_IP_HEADER_B),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1610 p_ul->last_segment_pos,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1611 LEN_IP_HEADER_B,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1612 & pos_copy,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1613 & total_len_copy

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1614 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1615

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1616 if (total_len_copy NEQ malloc_len - LEN_IP_HEADER_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1617 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1618 /* Corrupted packet -> drop it */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1619 p_ul->drop_packet = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1620

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1621 /* Clean up and free the descs */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1622 del_descs (p_ul->first_desc_segment);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1623 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1624 p_ul->next_segment_desc = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1625 p_ul->last_segment_pos = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1626 p_ul->sended_segment_len = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1627 p_ul->state_segment = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1628 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1629 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1630 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1631 /* Build the fragment header */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1632

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1633 UBYTE * ip_header_first = p_ul->first_desc_segment->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1634 dest_addr = GET_IP_DEST_ADDR (ip_header_first);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1635

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1636 build_ip_header (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1637 desc_new->buffer,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1638 p_ul->segment_id,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1639 MIN_HEADER_LEN,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1640 NORMAL_SERVICE,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1641 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1642 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1643 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1644 malloc_len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1645 (USHORT) (p_ul->segment_offset >> 3),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1646 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1647 FLAG_NOT_SET,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1648 p_ul->segment_prot

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1649 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1650

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1651 /* Clean up and free the descs */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1652

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1653 del_descs (p_ul->first_desc_segment);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1654

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1655 p_ul->segment_offset = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1656 p_ul->next_segment_desc = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1657 p_ul->last_segment_pos = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1658 p_ul->sended_segment_len = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1659 p_ul->state_segment = NO_SEGMENTS;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1660 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1661 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1662 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1663 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1664

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1665 default:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1666 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1667 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1668 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1669 else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1670 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1671 data_ind = p_dl->dti_data_ind;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1672

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1673 /* Compute DL packets */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1674

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1675 switch (select) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1676 /* Ping request */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1677 case B_ICMP_ECHO_REPLY:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1678 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1679 USHORT header_len_b;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1680

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1681 PPASS (data_ind, data_request, DTI2_DATA_REQ);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1682 desc_list = & data_request->desc_list2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1683 desc = (T_desc2 *) desc_list->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1684 ip_header = desc->buffer;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1685 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_header);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1686

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1687 dest_addr = GET_IP_SOURCE_ADDR (ip_header);/*lint !e415 !e416 (Warning -- access/creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1688

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1689 build_icmp_packet (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1690 (UBYTE) header_len_b,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1691 ICMP_TYP_ECHO_REPLY,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1692 ICMP_CODE_ECHO_REPLY,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1693 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1694 ip_header,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1695 p_ul->identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1696 dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1697 src_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1698 desc_list

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1699 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1700 #ifndef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1701 p_ul->identity++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1702 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1703 p_ker->icmp_dti_data_req = data_request;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1704 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1705 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1706

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1707 case B_ICMP_REASSEMBLE_TIMEOUT:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1708 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1709 /* Datagram for ICMP - reassembly - message */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1710

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1711 data_ind = p_dl->data_ind_reassembly[p_dl->pos_server];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1712

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1713 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1714 PPASS (data_ind, data_request, DTI2_DATA_REQ);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1715

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1716 build_icmp_with_payload (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1717 data_request,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1718 p_ul->identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1719 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1720 p_ker->source_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1721 ICMP_TYP_TIME_EXCEDED,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1722 ICMP_CODE_FRAGM_TIME_EXC

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1723 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1724 #ifndef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1725 p_ul->identity++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1726 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1727 p_ker->icmp_dti_data_req = data_request;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1728 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1729 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1730 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1731

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1732 case B_ICMP_NO_FORWARD:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1733 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1734 /* No destination address - build ICMP frame */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1735

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1736 PPASS (data_ind, data_request, DTI2_DATA_REQ);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1737

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1738 build_icmp_with_payload (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1739 data_request,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1740 p_ul->identity,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1741 p_ul->ttl,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1742 p_ker->source_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1743 ICMP_TYP_DEST_URECHBL,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1744 ICMP_CODE_NO_HOST

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1745 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1746 #ifndef _SIMULATION_

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1747 p_ul->identity++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1748 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1749 p_ker->icmp_dti_data_req = data_request;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1750 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1751 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1752

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1753 default:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1754 break;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1755 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1756 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1757 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1758

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1759 /*

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1760 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1761 | PROJECT : GSM-FaD (8444) MODULE : IP_KERF |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1762 | STATE : code ROUTINE : check_ip_address |

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1763 +--------------------------------------------------------------------+

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1764 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1765 * Check the IP address

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1766 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1767 void check_ip_address (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1768 BOOL * addr_type_dest,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1769 BOOL * addr_type_src,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1770 ULONG dest_addr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1771 ULONG src_addr

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1772 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1773 UBYTE i;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1774 UBYTE b_dest_addr[4], b_src_addr[4], first_nibbl_dest, first_nibbl_src;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1775

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1776 #define BCAST 0xFF

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1777 #define LOOP_BACK 0x7F

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1778 #define DEFAULT_ROUTE 0

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1779 #define CLASS_A 0x0

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1780 #define CLASS_B 0x2

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1781 #define CLASS_C 0x6

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1782 #define MULTICAST 0xE

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1783 #define CLASS_E 0xF

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1784 #define M_CAST_FF 0xFFFFFFFF

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1785

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1786 TRACE_FUNCTION ("check_ip_address()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1787

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1788 ip_addr_int_to_byte (b_dest_addr, dest_addr);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1789 ip_addr_int_to_byte (b_src_addr, src_addr);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1790

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1791 first_nibbl_dest = (UBYTE) (b_dest_addr[0] >> 4);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1792 first_nibbl_src = (UBYTE) (b_src_addr[0] >> 4);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1793

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1794 for (i=0; i < MAX_ADDR_TYPES; i++)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1795 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1796 addr_type_dest[i] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1797 addr_type_src[i] = FALSE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1798 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1799

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1800 /* Check if broadcast address */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1801

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1802 if (dest_addr EQ M_CAST_FF)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1803 addr_type_dest[BCAST_ADDR_255] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1804

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1805 if (src_addr EQ M_CAST_FF)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1806 addr_type_src[BCAST_ADDR_255] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1807

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1808 /* Correct destination address? */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1809

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1810 if (dest_addr NEQ src_addr)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1811 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1812 addr_type_dest[NO_DEST_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1813 addr_type_src[NO_DEST_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1814 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1815

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1816 /* Loop-back address? */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1817

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1818 if (b_dest_addr[0] EQ LOOP_BACK)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1819 addr_type_dest[LOOP_BACK_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1820

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1821 if (b_src_addr[0] EQ LOOP_BACK)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1822 addr_type_src[LOOP_BACK_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1823

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1824 /* Check kind of class */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1825

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1826 if ((first_nibbl_src >> 3) EQ CLASS_A)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1827 addr_type_src[CLASS_A_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1828

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1829 if ((first_nibbl_dest >> 3) EQ CLASS_A)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1830 addr_type_dest[CLASS_A_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1831

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1832 if ((first_nibbl_src >> 2) EQ CLASS_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1833 addr_type_src[CLASS_B_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1834

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1835 if ((first_nibbl_dest >> 2) EQ CLASS_B)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1836 addr_type_dest[CLASS_B_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1837

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1838 if ((first_nibbl_src >> 1) EQ CLASS_C)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1839 addr_type_src[CLASS_C_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1840

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1841 if ((first_nibbl_dest >> 1) EQ CLASS_C)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1842 addr_type_dest[CLASS_C_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1843

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1844 if (first_nibbl_src EQ CLASS_E AND dest_addr NEQ M_CAST_FF)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1845 addr_type_src[CLASS_E_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1846

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1847 if (first_nibbl_dest EQ CLASS_E AND src_addr NEQ M_CAST_FF)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1848 addr_type_dest[CLASS_E_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1849

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1850 /* Multicast or class D */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1851

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1852 if (first_nibbl_dest EQ MULTICAST)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1853 addr_type_dest[MCAST_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1854

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1855 if (first_nibbl_src EQ MULTICAST)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1856 addr_type_src[MCAST_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1857

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1858 /* Default route */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1859

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1860 if (dest_addr EQ DEFAULT_ROUTE)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1861 addr_type_dest[DEFAULT_R_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1862

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1863 if (src_addr EQ DEFAULT_ROUTE)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1864 addr_type_src[DEFAULT_R_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1865

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1866 /* Bad address? */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1867

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1868 if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1869 addr_type_src[BCAST_ADDR_255] OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1870 addr_type_src[LOOP_BACK_ADDR] OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1871 addr_type_src[DEFAULT_R_ADDR]

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1872 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1873 addr_type_src[BAD_UL_SRC_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1874 addr_type_src[BAD_DL_SRC_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1875 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1876

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1877 if (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1878 addr_type_dest[BCAST_ADDR_255] OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1879 addr_type_dest[LOOP_BACK_ADDR] OR

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1880 addr_type_dest[DEFAULT_R_ADDR]

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1881 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1882 addr_type_dest[BAD_UL_DEST_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1883 addr_type_dest[BAD_DL_DEST_ADDR] = TRUE;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1884 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1885 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1886

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1887 /* Internet checksum calculations as needed in IP and UDP.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1888 * See RFC 1071 for details.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1889 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1890 * USHORT inet_checksum (UBYTE * block, USHORT len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1891 * Computes the Internet checksum over a simple data block.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1892 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1893 * USHORT desc_checksum (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1894 * T_desc_list2 * dlist,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1895 * USHORT start_offset,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1896 * ULONG start_value

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1897 * )

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1898 * Computes the Internet checksum over a DTI descriptor list,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1899 * beginning at start_offset and with start_value. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1900

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1901 #define LITTLE_ENDIAN /* Change this for big-endian mode. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1902

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1903 /** Computes the Internet checksum [RFC 1071] over a simple data block.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1904 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1905 * @param block pointer to data block

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1906 * @param len length of the block in octets

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1907 * @return the checksum

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1908 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1909 USHORT inet_checksum (UBYTE * block, USHORT len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1910 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1911 BOOL have_leftover = len % 2; /* If non-zero, there is a leftover

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1912 * octet at the end of the (odd-sized)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1913 * data block. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1914 ULONG value; /* Value to add. (Since we know

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1915 * nothing about the alignment of the

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1916 * block, we can't read the USHORTs

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1917 * directly from the block.) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1918 ULONG checksum = 0; /* Checksum accumulator. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1919

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1920 len >>= 1; /* Count words now, not octets. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1921

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1922 while (len--)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1923 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1924 /* Because we must read the data bytewise, we cannot profit from

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1925 * the independency of endianness of the original algorithm.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1926 * That means that we have to make two different cases for big

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1927 * endian and little endian. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1928

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1929 #if defined LITTLE_ENDIAN

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1930 /*lint -e{661} (Warning -- access of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1931 value = block[1]<<8 | block[0];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1932 #elif defined BIG_ENDIAN

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1933 /*lint -e{662} (Warning -- creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1934 value = block[0]<<8 | block[1];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1935 #else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1936 #error "LITTLE_ENDIAN or BIG_ENDIAN must be defined."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1937 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1938

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1939 checksum += value;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1940 /*lint -e{662} (Warning -- creation of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1941 block +=2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1942 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1943

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1944 if (have_leftover)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1945 /*lint -e{661} (Warning -- access of out-of-bounds pointer) */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1946 checksum += *block;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1947

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1948 /* Fold into 16 bits. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1949 while (checksum >> 16)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1950 checksum = (checksum & 0xffff) + (checksum >> 16);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1951

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1952 return (USHORT) ~checksum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1953 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1954

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1955 /** Computes a part of an Internet checksum over a data block. A

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1956 * leftover octet from a previous partial calculation is taken into

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1957 * account. If an octet is left over, it is returned as well as the

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1958 * fact that there is a leftover octet. This function is intended to

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1959 * be called only by desc_checksum() and partial_checksum().

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1960 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1961 * @param block pointer to data block

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1962 * @param len length of the block in octets

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1963 * @param sum checksum value to begin with

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1964 * @param have_leftover_ptr if non-zero, a leftover octet is in *leftover_ptr

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1965 * @param leftover_ptr pointer to leftover octet; valid on input and

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1966 * output iff *have_leftover_ptr

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1967 * @return the part of the sum calculated

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1968 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1969 static ULONG checksum_block_part (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1970 UBYTE * block,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1971 USHORT len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1972 ULONG sum,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1973 BOOL * have_leftover_ptr,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1974 UBYTE * leftover_ptr

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1975 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1976 /* This function is as complicated as it is for two reasons:

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1977 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1978 * (a) Each block may have an even or odd number of octets. Because

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1979 * this checksum is 16-bit based, an octet may be left over from the

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1980 * previous calculation and must be taken into account. Also in this

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1981 * calculation an octet may be left over. This fact and the value of

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1982 * the octet must be made known to the caller.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1983 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1984 * (b) We must not make any assumptions about the alignment of the

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1985 * block. Therefore, in order not to cause alignment problems, all

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1986 * 16-bit values must be read bytewise. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1987

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1988 ULONG value; /* 16-bit value to be summed up */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1989

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1990 TRACE_FUNCTION ("checksum_block_part()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1991

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1992 /* Previous calculation may have left over an octet. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1993 if (*have_leftover_ptr)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1994 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1995 if (len == 0)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1996 return sum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1997

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1998 /* See comment in inet_checksum() above for an explanation. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

1999

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2000 #if defined LITTLE_ENDIAN

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2001 value = (*block++ << 8) | *leftover_ptr;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2002 #elif defined BIG_ENDIAN

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2003 value = (*leftover_ptr << 8) | *block++;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2004 #else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2005 #error "LITTLE_ENDIAN or BIG_ENDIAN must be defined."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2006 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2007

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2008 len--;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2009 sum += value;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2010 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2011

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2012 /* Main loop over word values. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2013 *have_leftover_ptr = len % 2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2014 len >>= 1;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2015 while (len--)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2016 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2017 /* See comment in inet_checksum() above for an explanation. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2018

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2019 #if defined LITTLE_ENDIAN

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2020 value = block[1]<<8 | block[0];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2021 #elif defined BIG_ENDIAN

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2022 value = block[0]<<8 | block[1];

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2023 #else

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2024 #error "LITTLE_ENDIAN or BIG_ENDIAN must be defined."

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2025 #endif

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2026

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2027 sum += value;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2028 block +=2;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2029 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2030

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2031 /* Check for leftover octet. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2032 if (*have_leftover_ptr)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2033 *leftover_ptr = *block;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2034

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2035 return sum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2036 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2037

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2038 /** Compute a partial Internet checksum to be used as a astart_value

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2039 * for desc_checksum. The block must have even length.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2040 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2041 * @param block data block to compute the checksum over

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2042 * @param len length of the block

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2043 * @return the partial sum calculated

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2044 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2045 ULONG partial_checksum (UBYTE * block, USHORT len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2046 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2047 BOOL dummy1 = 0; /* Needed to call checksum_block_part(). */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2048 UBYTE dummy2 = 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2049

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2050 return checksum_block_part (block, len, 0, & dummy1, & dummy2);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2051 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2052

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2053 /** Computes the Internet checksum over a DTI descriptor list. There

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2054 * may be a value from a previous partial calculation that is added to

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2055 * the sum as a start value. The function relies on the data length

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2056 * being at least start_offset.

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2057 *

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2058 * @param dlist descriptor list containing the data

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2059 * @param start_offset beginning position of interesting data

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2060 * @param start_value value from previous partial checksum calculation

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2061 * @return the checksum value

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2062 */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2063 USHORT desc_checksum (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2064 T_desc_list2 * dlist,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2065 USHORT start_offset,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2066 ULONG start_value

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2067 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2068 ULONG checksum = start_value; /* The checksum to be calculated. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2069 T_desc2 * desc_p; /* Pointer to current descriptor. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2070 BOOL have_leftover = 0; /* True iff we have a leftover octet

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2071 * from the previous partial sum. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2072 UBYTE leftover_octet = 0; /* An octet left over from the

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2073 * previous partial sum. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2074

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2075 TRACE_FUNCTION ("desc_checksum()");

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2076

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2077 /* Calculating the sum of the first buffer, we have to take the

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2078 * start offset into account. This includes finding the descriptor

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2079 * the offset lies in. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2080

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2081 desc_p = (T_desc2 *) dlist->first;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2082 while (start_offset > desc_p->len)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2083 {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2084 start_offset = (USHORT) (start_offset - desc_p->len);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2085 desc_p = (T_desc2 *) desc_p->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2086 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2087 checksum = checksum_block_part (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2088 desc_p->buffer + start_offset,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2089 (USHORT) (desc_p->len - start_offset),

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2090 checksum,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2091 & have_leftover,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2092 & leftover_octet

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2093 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2094

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2095 /* Now loop over the other descriptors. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2096 for (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2097 desc_p = (T_desc2 *) desc_p->next;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2098 desc_p != 0;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2099 desc_p = (T_desc2 *) desc_p->next

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2100 ) {

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2101 checksum = checksum_block_part (

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2102 desc_p->buffer,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2103 desc_p->len,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2104 checksum,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2105 & have_leftover,

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2106 & leftover_octet

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2107 );

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2108 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2109

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2110 if (have_leftover)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2111 checksum += leftover_octet;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2112

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2113 /* Fold into 16 bits. */

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2114 while (checksum >> 16)

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2115 checksum = (checksum & 0xffff) + (checksum >> 16);

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2116

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2117 return (USHORT) ~checksum;

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2118 }

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2119

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2120 /*-------------------------------------------------------------------------*/

90eb61ecd093 src/g23m-fad: initial import from TCS3.2/LoCosto

Mychaela Falconia <falcon@freecalypso.org>

parents:

diff changeset

2121

FreeCalypso > hg > fc-magnetite

annotate src/g23m-fad/ip/ip_kerf.c @ 174:90eb61ecd093