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

annotate src/g23m-fad/ip/ip_kerf.c @ 61:935692f51b38

src/g23m-gsm/alr2/alr.h: removed bogus extern to pass gcc compilation

author	Mychaela Falconia <falcon@freecalypso.org>
date	Thu, 19 Jul 2018 23:30:08 +0000
parents	d393cd9bb723
children

rev	line source
1 d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2 +----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	3 \| Project :
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	4 \| Modul :
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	5 +----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	7 \| All rights reserved.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	8 \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	10 \| Instruments Berlin, AG
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	11 \| The receipt of or possession of this file does not convey
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	14 \| whole, or in part, without the specific written consent of
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	15 \| Texas Instruments Berlin, AG.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	16 +----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	17 \| Purpose : This Modul defines the functions for processing
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	18 \| of incomming primitives for the component
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	19 \| Internet Protocol of the mobile station
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	20 +----------------------------------------------------------------------------
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	21 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	22
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	23 #define ENTITY_IP
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	24
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	25 /==== INCLUDES ===================================================/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	26
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	27 #include <string.h>
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	28 #include "typedefs.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	29 #include "pconst.cdg"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	30 #include "vsi.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	31 #include "macdef.h" /* Get PFREE_DESC2 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	32 #include "pconst.cdg"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	33 #include "custom.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	34 #include "gsm.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	35 #include "cnf_ip.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	36 #include "mon_ip.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	37 #include "prim.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	38 #include "pei.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	39 #include "tok.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	40 #include "ccdapi.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	41 #include "dti.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	42 #include "ip.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	43 #include "ip_udp.h"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	44
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	45 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	46 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	47 \| PROJECT : WAP MODULE : ip_kerf.c \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	48 \| STATE : code ROUTINE : ip_packet_validator \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	49 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	50
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	51 PURPOSE : Checks for IP packet validity
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	52 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	53 BOOL ip_packet_validator (T_desc_list2 * desc_list)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	54 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	55 TRACE_FUNCTION ("ip_packet_validator()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	56
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	57 if (desc_list == NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	58 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	59 TRACE_ERROR ("desc_list == NULL in IP validator.");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	60 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	61 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	62
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	63 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	64 /* Loop once through all the list */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	65 register T_desc2 * desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	66 register unsigned length = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	67 while (desc != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	68 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	69 /* Check consistency of descs */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	70 if (desc->size < desc->offset + desc->len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	71 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	72 TRACE_ERROR (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	73 "Packet dropped: "
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	74 "desc->size < desc->offset + desc->len in IP validator."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	75 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	76 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	77 /* This is a mistake. Must be DTI1. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	78 /* desc->offset = 0; */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	79 /* desc->size = desc->len; */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	80 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	81 /* Make sure that all offsets are 0 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	82 if (desc->offset != 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	83 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	84 memmove (desc->buffer, desc->buffer + desc->offset, desc->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	85 desc->offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	86 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	87 /* Calculate the sum of lengths */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	88 length += desc->len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	89 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	90 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	91 /* Check desc_list->list_len */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	92 if (desc_list->list_len != length)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	93 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	94 TRACE_ERROR (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	95 "Packet dropped: "
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	96 "desc_list->list_len != length in IP validator."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	97 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	98 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	99 /* This is a mistake. But we could live with it. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	100 /* desc_list->list_len = (USHORT) length; */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	101 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	102
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	103 /* Need at least LEN_IP_HEADER_B bytes for one header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	104 if (length < LEN_IP_HEADER_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	105 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	106 TRACE_ERROR (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	107 "Packet dropped: "
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	108 "length < LEN_IP_HEADER_B in IP validator."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	109 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	110 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	111 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	112
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	113 /* Have enough bytes, but they may be distributed */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	114 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	115 if (desc->len < LEN_IP_HEADER_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	116 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	117 /* Collect all bytes in one desc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	118 T_desc2 * bigdesc = M_ALLOC (offsetof (T_desc2, buffer) + length);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	119 if (bigdesc == NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	120 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	121 TRACE_ERROR ("Not enough memory in IP validator.");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	122 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	123 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	124
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	125 bigdesc->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	126 bigdesc->offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	127 bigdesc->len = (USHORT) length;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	128 bigdesc->size = (USHORT) length;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	129
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	130 /* Loop again through all the list */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	131 length = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	132 while (desc != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	133 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	134 T_desc2 * removable = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	135 memcpy (bigdesc->buffer + length, desc->buffer, desc->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	136 length += desc->len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	137 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	138 MFREE (removable);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	139 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	140 desc_list->first = (ULONG) bigdesc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	141 desc = bigdesc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	142 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	143
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	144 /* Need at least GET_IP_HEADER_LEN_B() bytes for the IP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	145 if (length < (unsigned) GET_IP_HEADER_LEN_B (desc->buffer))
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	146 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	147 TRACE_ERROR (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	148 "Packet dropped: "
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	149 "length < GET_IP_HEADER_LEN_B() in IP validator."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	150 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	151 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	152 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	153
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	154 /* Survived */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	155 return TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	156 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	157 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	158
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	159 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	160 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	161 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	162 \| STATE : code ROUTINE : free_primitive_data_ind \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	163 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	164 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	165 * Set a DTI_DATA_IND primitive free and the pointer to NULL
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	166 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	167 void free_primitive_data_ind (T_DTI2_DATA_IND ** dti_data_ind)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	168 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	169 TRACE_FUNCTION ("free_primitive_data_ind()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	170
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	171 if (dti_data_ind != NULL && *dti_data_ind != NULL) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	172 PFREE_DESC2 (* dti_data_ind);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	173 *dti_data_ind = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	174 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	175 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	176
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	177 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	178 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	179 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	180 \| STATE : code ROUTINE : free_primitive_data_req \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	181 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	182 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	183 * Set a DTI_DATA_REQ primitive free and the pointer to NULL
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	184 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	185 void free_primitive_data_req (T_DTI2_DATA_REQ ** dti_data_req)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	186 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	187 TRACE_FUNCTION ("free_primitive_data_req()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	188
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	189 if (dti_data_req != NULL && *dti_data_req != NULL) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	190 PFREE_DESC2 (* dti_data_req);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	191 *dti_data_req = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	192 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	193 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	194
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	195 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	196 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	197 \| PROJECT : WAP MODULE : IP \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	198 \| STATE : code ROUTINE : set_desc_len \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	199 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	200 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	201 * Set the new desc length and fix desc_list length
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	202 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	203 void set_desc_len (T_desc_list2 * desc_list, T_desc2 * desc, USHORT len_desc)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	204 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	205 TRACE_FUNCTION ("set_desc_len()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	206
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	207 desc_list->list_len = (USHORT) (desc_list->list_len + len_desc - desc->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	208 desc->len = len_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	209 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	210
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	211 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	212 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	213 \| PROJECT : WAP MODULE : IP \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	214 \| STATE : code ROUTINE : del_rest_descs \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	215 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	216 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	217 * Free the next desc(s) from desc. Fix the list_len in desc_list
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	218 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	219 void del_rest_descs (T_desc_list2 * desc_list, T_desc2 * desc)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	220 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	221 BOOL go = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	222 T_desc2 * p_desc_last, * p_desc_start;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	223
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	224 TRACE_FUNCTION ("del_rest_descs()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	225
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	226 if (desc->next > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	227 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	228 p_desc_start = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	229 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	230
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	231 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	232 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	233 p_desc_last = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	234
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	235 if (desc->next > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	236 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	237 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	238 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	239
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	240 desc_list->list_len = (USHORT)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	241 (desc_list->list_len - p_desc_last->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	242 MFREE (p_desc_last);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	243 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	244 while (go);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	245
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	246 desc = p_desc_start;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	247 desc->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	248 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	249 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	250
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	251 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	252 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	253 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	254 \| STATE : code ROUTINE : del_descs \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	255 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	256 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	257 * Free the desc(s)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	258 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	259 void del_descs (T_desc2 * desc)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	260 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	261 BOOL go = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	262 T_desc2 * p_desc_last;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	263
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	264 TRACE_FUNCTION ("del_descs()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	265
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	266 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	267 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	268 p_desc_last = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	269
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	270 if (desc->next > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	271 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	272 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	273 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	274
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	275 MFREE (p_desc_last);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	276 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	277 while (go);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	278 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	279
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	280 /** filter_out_in_desc
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	281 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	282 * cuts length bytes out of a T_desc2::buffer, starting at 'start'.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	283 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	284 * @param desc Pointer to a T_desc2
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	285 * @param start Start of the block to be cut out
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	286 * @param length Length of the block to be cut out
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	287 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	288 * @return TRUE if parameters are valid, FALSE if parameters are invalid
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	289 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	290 static BOOL filter_out_in_desc (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	291 T_desc2 * desc,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	292 USHORT start,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	293 USHORT length
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	294 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	295 TRACE_FUNCTION ("filter_out_in_desc()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	296
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	297 if (desc != NULL && start + length <= desc->len) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	298 memmove (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	299 desc->buffer + start,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	300 desc->buffer + start + length,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	301 desc->len - start - length
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	302 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	303 desc->len = (USHORT) (desc->len - length);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	304 return TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	305 } else {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	306 TRACE_ERROR ("Parameters are invalid in filter_out_in_desc().");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	307 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	308 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	309 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	310
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	311 /** truncate_descs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	312 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	313 * truncates a T_desc_list2 to no more than new_length bytes.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	314 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	315 * @param desc_list Pointer to a T_desc_list2
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	316 * @param new_length Maximal new length of that T_desc_list2
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	317 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	318 void truncate_descs (T_desc_list2 * desc_list, USHORT new_length)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	319 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	320 TRACE_FUNCTION ("truncate_descs()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	321
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	322 if (desc_list != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	323 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	324 T_desc2 pp_desc = (T_desc2 ) & desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	325 desc_list->list_len = 0; /* Will be recalculated, anyway */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	326
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	327 /* First a loop over all T_descs which will remain. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	328 while (*pp_desc != NULL && new_length != 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	329 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	330 if (new_length < (*pp_desc)->len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	331 (*pp_desc)->len = new_length;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	332 new_length = (USHORT) (new_length - (*pp_desc)->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	333 desc_list->list_len = /* Recalculation */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	334 (USHORT) (desc_list->list_len + (*pp_desc)->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	335 pp_desc = (T_desc2 *) & (pp_desc)->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	336 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	337
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	338 /* Second a loop over all T_descs which have to be deleted, if any. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	339 while (*pp_desc != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	340 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	341 T_desc2 * p_desc_removable = *pp_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	342 pp_desc = (T_desc2 ) p_desc_removable->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	343 MFREE (p_desc_removable);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	344 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	345
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	346 /* This way, new_length==0 at function call results in
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	347 * desc_list->first==NULL at function return. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	348
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	349 /* Third a loop over all T_descs which have to be created, if any.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	350 * (If it were Prokrustes, not truncation,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	351 * we would have to allocate new T_descs here.)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	352 * while (new_length != 0) { ... } */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	353 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	354 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	355 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	356 TRACE_ERROR ("truncate_descs() called without T_desc_list2.");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	357 TRACE_ASSERT (0);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	358 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	359 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	360
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	361 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	362 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	363 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	364 \| STATE : code ROUTINE : insert_sort_descs \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	365 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	366 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	367 * Insert a new descriptor sorted by fragment offset.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	368 * The less value at first. Filter out descs with same offset.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	369 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	370 static void insert_sort_desc (T_desc_list2 * desc_list, T_desc2 * p_new_desc)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	371 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	372 if (desc_list != NULL && p_new_desc != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	373 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	374 T_desc2 * desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	375 T_desc2 * p_desc_last;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	376 UBYTE * ip_header;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	377 USHORT offset, new_offset;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	378
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	379 offset = 0xffff;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	380 ip_header = p_new_desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	382 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	383 p_desc_last = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	384
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	385 while (desc NEQ NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	386 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	387 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	389 if (new_offset <= offset)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	390 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	391 p_desc_last = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	392 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	393 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	394
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	395 if (new_offset EQ offset)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	396 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	397 /* Two descriptors with the same offset
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	398 * Throw away the new one */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	399 MFREE (p_new_desc);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	400 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	401 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	402 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	403 /* Insert descriptor after p_desc_last */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	404 if (p_desc_last EQ NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	405 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	406 p_new_desc->next = desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	407 desc_list->first = (ULONG) p_new_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	408 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	409 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	410 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	411 p_new_desc->next = p_desc_last->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	412 p_desc_last->next = (ULONG) p_new_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	413 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	414
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	415 /* Add the length of the new descriptor */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	416 desc_list->list_len = (USHORT) (desc_list->list_len + p_new_desc->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	417 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	418 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	419 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	420
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	421 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	422 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	423 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	424 \| STATE : code ROUTINE : reassemble_fragments \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	425 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	426 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	427 * Reassemble fragments coming in downlink
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	428 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	429 void reassemble_fragments (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	430 T_DTI2_DATA_IND ** dti_data_ind,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	431 T_LOLA * p_dl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	432 UBYTE * ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	433 BOOL first_segment,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	434 /* BOOL middle_segment, */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	435 BOOL last_segment /,/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	436 /* USHORT fragm_offset */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	437 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	438 USHORT fragm_id, header_len_b, offset;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	439 UBYTE fragm_prot;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	440 ULONG server_source_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	441 BOOL found_source_addr = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	442
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	443 TRACE_FUNCTION ("reassemble_fragments()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	444
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	445 fragm_id = (USHORT) GET_IP_IDENT (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	446 fragm_prot = GET_IP_PROT (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	447 server_source_addr = GET_IP_SOURCE_ADDR (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	448
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	449 /* Check source address from server */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	450 p_dl->pos_server = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	451 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	452 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	453 if (p_dl->ip_source_addr_segment[p_dl->pos_server] NEQ server_source_addr)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	454 p_dl->pos_server++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	455 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	456 found_source_addr = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	457
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	458 } while (! found_source_addr && p_dl->pos_server < MAX_SEGM_SERVER);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	459
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	460 /* Select the server - by only one server p_dl->pos_server = 0 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	461 if (p_dl->pos_server EQ MAX_SEGM_SERVER)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	462 p_dl->pos_server = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	463
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	464 p_dl->ip_source_addr_segment[p_dl->pos_server] = server_source_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	465
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	466 /* Check if it is the first or the last segment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	467 if (first_segment)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	468 p_dl->got_first_segment[p_dl->pos_server] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	469
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	470 if (last_segment)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	471 p_dl->got_last_segment[p_dl->pos_server] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	472
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	473 /* Is it the first of any segment type? */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	474 if (p_dl->state_reassembly[p_dl->pos_server] EQ NO_SEGMENTS)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	475 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	476 p_dl->data_ind_reassembly[p_dl->pos_server] = *dti_data_ind;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	477 p_dl->state_reassembly[p_dl->pos_server] = READ_SEGMENT;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	478 p_dl->id_reassemble[p_dl->pos_server] = fragm_id;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	479 p_dl->prot_reassemble[p_dl->pos_server] = fragm_prot;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	480
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	481 /* Start reassembly timer */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	482
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	483 /* Implementation problem: the timer index must be
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	484 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	485 * layer variable is not forwarded to the function.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	486 * It works, because layer is ever set to 0 in the moment. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	487
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	488 vsi_t_start (VSI_CALLER p_dl->pos_server, TIME_REASSEMBLY);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	489 p_dl->timer_reass_running[p_dl->pos_server] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	490 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	491 /* Check the fragment ID and protocol. If not the same - free resources */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	492 else if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	493 (p_dl->id_reassemble[p_dl->pos_server] NEQ fragm_id) OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	494 (p_dl->prot_reassemble[p_dl->pos_server] NEQ fragm_prot)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	495 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	496 if (p_dl->timer_reass_running[p_dl->pos_server])
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	497 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	498 /* Implementation problem: the timer index must be
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	499 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	500 * layer variable is not forwarded to the function.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	501 * It works, because layer is ever set to 0 in the moment. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	502
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	503 csf_stop_timer (p_dl->pos_server);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	504 p_dl->timer_reass_running[p_dl->pos_server] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	505 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	506
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	507 p_dl->drop_packet = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	508 p_dl->state_reassembly[p_dl->pos_server] = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	509
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	510 free_primitive_data_ind (p_dl->data_ind_reassembly + p_dl->pos_server);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	511
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	512 /* Note: We could generate an ICMP packet */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	513 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	514 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	515 else /* Got correct segments before */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	516 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	517 /* Note: The whole datagram must be in the same descriptor */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	518 /* Note: The timeout value should be changed to MAX (TTL, TIME_REASSEMBLY) */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	519
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	520 BOOL all_fragments_received = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	521
d393cd9bb723 src/g23m-: initial import from Magnetite 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;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	523 T_desc2 * desc = (T_desc2 *) p_dl->dti_data_ind->desc_list2.first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	524
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	525 if (desc == NULL \|\| (T_desc2 *) desc_list->first == NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	526 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	527 TRACE_ERROR ("Pointer is NULL.");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	528 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	529 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	530
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	531 /* Insert the descriptor in the right position, according to the offset */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	532 insert_sort_desc (desc_list, desc);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	533
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	534 /* Check if got all fragments */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	535
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	536 if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	537 p_dl->got_first_segment[p_dl->pos_server] AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	538 p_dl->got_last_segment[p_dl->pos_server]
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	539 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	540 BOOL go = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	541 USHORT data_len, next_offset;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	542 UBYTE * ip_packet;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	543 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	544 ip_packet = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	545 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	546 data_len = (USHORT) (desc->len - header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	547 next_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	548 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	549 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	550 if ((T_desc2 *) desc->next != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	551 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	552 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	553 ip_packet = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	555 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	556
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	557 if ((T_desc2 *) desc->next != NULL)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	558 data_len = (USHORT) (data_len + desc->len - header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	559 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	560 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	561 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	562 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	563 while (go);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	564
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	565 if (data_len >= next_offset)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	566 all_fragments_received = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	567 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	568
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	569 /* Reassemble the fragments */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	570
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	571 if (all_fragments_received)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	572 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	573 BOOL go = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	574 USHORT len_fragments, header_len_b_first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	575 T_desc2 * p_desc_first, * p_desc_last;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	576 UBYTE * ip_packet;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	577
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	578 p_dl->state_reassembly[p_dl->pos_server] = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	579
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	580 if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	581 desc_list == NULL \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	582 (T_desc2 *) desc_list->first == NULL \|\|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	583 (T_desc2 ) ((T_desc2)desc_list->first)->next == NULL
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	584 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	585 TRACE_ERROR ("Pointer is NULL.");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	586 return;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	587 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	588
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	589 /* Fix the first desc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	590 p_desc_first = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	591 ip_packet = p_desc_first->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	592 header_len_b_first = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	593
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	594 /* Start from next desc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	595 desc = (T_desc2 *) p_desc_first->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	596 ip_packet = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	598 p_desc_first->len = (USHORT) (offset + header_len_b_first);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	599 len_fragments = offset;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	600
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	601 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	602 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	603 if (desc->next NEQ 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	604 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	605 p_desc_last = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	606 desc = (T_desc2 *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	607
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	608 /* Get the fragment offset */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	609 ip_packet = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	610 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	612
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	613 /* Filter out IP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	614 ip_packet = p_desc_last->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	615 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	616 filter_out_in_desc (p_desc_last, 0, header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	617
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	618 len_fragments = (USHORT) (len_fragments + p_desc_last->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	619 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	620 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	621 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	622 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	623
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	624 /* Filter out last IP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	625 ip_packet = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	626 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_packet);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	627 filter_out_in_desc (desc, 0, header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	628
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	629 len_fragments = (USHORT) (len_fragments + desc->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	630 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	631 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	632 while (go);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	633
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	634 /* Build the IP datagram */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	635
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	636 /* Implementation problem: the timer index must be
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	637 * layer * MAX_SEGM_SERVER + p_dl->pos_server. The
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	638 * layer variable is not forwarded to the function.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	639 * It works, because layer is ever set to 0 in the moment. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	640
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	641 csf_stop_timer (p_dl->pos_server);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	642 p_dl->timer_reass_running[p_dl->pos_server] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	643 /* PFREE (dti_data_ind); */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	644 /* Is being freed elsewhere. Would anyway have false level of indirection. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	645 p_dl->data_ind_reassembly[p_dl->pos_server]->desc_list2.list_len =
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	646 (USHORT) (len_fragments + header_len_b_first);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	647
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	648 *dti_data_ind = p_dl->data_ind_reassembly[p_dl->pos_server];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	649 p_desc_first = (T_desc2 ) (dti_data_ind)->desc_list2.first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	650 ip_packet = p_desc_first->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	651
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	652 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	653 ULONG dest_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	654 UBYTE ttl;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	657
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	658 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	659 ip_packet,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	660 fragm_id,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	661 (UBYTE) (header_len_b_first >> 2),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	662 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	663 ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	664 p_dl->ip_source_addr_segment[p_dl->pos_server],
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	665 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	666 (UBYTE) (len_fragments + header_len_b_first),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	667 NO_OFFSET_FRAG,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	668 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	669 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	670 fragm_prot
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	671 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	672 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	673 p_dl->data_ind_reassembly[p_dl->pos_server] = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	674 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	675 /* else */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	676 /* PFREE (dti_data_ind); */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	677 /* Is being freed elsewhere. Would anyway have false level of indirection. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	678 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	679
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	680 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	681
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	682 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	683 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	684 \| PROJECT : WAP MODULE : IP \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	685 \| STATE : code ROUTINE : put_desc_first_pos \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	686 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	687 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	688 * Put desc on the first position of a desc_list.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	689 * Set the new list_len in desc_list.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	690 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	691 void put_desc_first_pos (T_desc_list2 * desc_list, T_desc2 * p_desc_new)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	692 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	693 ULONG help;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	694 T_desc2 * p_desc_help;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	695
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	696 TRACE_FUNCTION ("put_desc_first_pos()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	697
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	698 p_desc_help = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	699
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	700 if (p_desc_help NEQ p_desc_new)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	701 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	702 help = desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	703 desc_list->first = (ULONG) p_desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	704 p_desc_new->next = help;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	705 desc_list->list_len = (USHORT) (desc_list->list_len + p_desc_new->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	706 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	707 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	708
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	709 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	710 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	711 \| PROJECT : GSM-FaD (8444) MODULE : IP_KER \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	712 \| STATE : code ROUTINE : copy_from_descs_to_desc \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	713 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	714 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	715 * Copy data from one or more descs into desc_new. Possible to use offset.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	716 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	717 void copy_from_descs_to_desc (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	718 T_desc2 ** desc,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	719 T_desc2 * desc_new,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	720 USHORT copy_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	721 USHORT offset_desc,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	722 USHORT offset_desc_new,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	723 USHORT * pos_copy,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	724 USHORT * total_len_copy
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	725 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	726 BOOL go = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	727 *pos_copy = offset_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	728 *total_len_copy = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	729
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	730 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	731 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	732 while (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	733 (pos_copy < (desc)->len) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	734 (offset_desc_new < desc_new->len) AND
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	735 (*total_len_copy < copy_len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	736 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	737 desc_new->buffer[offset_desc_new] = (desc)->buffer[pos_copy];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	738 offset_desc_new ++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	739 (*pos_copy)++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	740 (*total_len_copy)++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	741 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	742
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	743 if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	744 (*total_len_copy >= copy_len) OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	745 (offset_desc_new >= desc_new->len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	746 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	747 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	748 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	749 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	750 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	751 if (pos_copy >= (desc)->len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	752 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	753 if ((*desc)->next > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	754 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	755 desc = (T_desc2 ) (*desc)->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	756 *pos_copy = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	757 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	758 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	759 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	760 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	761 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	762 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	763 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	764 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	765 while (go);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	766 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	767
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	768 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	769 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	770 \| PROJECT : WAP MODULE : IP \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	771 \| STATE : code ROUTINE : make_new_desc \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	772 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	773 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	774 * Malloc a new desc. Init buffer 0 if buff_init_0 = TRUE
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	775 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	776 BOOL make_new_desc (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	777 T_desc2 ** p_desc_new,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	778 USHORT malloc_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	779 BOOL buff_init_0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	780 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	781 TRACE_FUNCTION ("make_new_desc()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	782
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	783 MALLOC (*p_desc_new, offsetof (T_desc2, buffer) + malloc_len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	784 /* The target compiler issues a warning
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	785 * "pointer type conversion may violate alignment constraints"
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	786 * here and everywhere where MALLOC is being used. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	787
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	788 if (*p_desc_new EQ 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	789 return FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	790
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	791 if (buff_init_0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	792 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	793 USHORT i;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	794 for (i = 0; i < malloc_len; i++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	795 (*p_desc_new)->buffer[i] = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	796 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	797 (*p_desc_new)->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	798 (*p_desc_new)->offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	799 (*p_desc_new)->len = malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	800 (*p_desc_new)->size = malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	801 return TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	802 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	803
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	804 #if 0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	805 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	806 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	807 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	808 \| STATE : code ROUTINE : sort_descs_id_up \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	809 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	810 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	811 * Sort the descs with fragment offset. The less value at
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	812 * first. Filter out descs with same offset.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	813 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	814 USHORT sort_descs_id_up (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	815 T_desc_list * desc_list,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	816 ULONG sort_array[2][MAX_SEGMENTS]
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	817 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	818 T_desc * desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	819 USHORT i, n_descs, code;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	820 BOOL go = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	821 ULONG addr, wert;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	822 UBYTE * ip_header;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	823
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	824 TRACE_FUNCTION ("sort_descs_id_up()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	825
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	826 desc = (T_desc *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	827 n_descs = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	828 code = GO_ON_SEGMENTING;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	829
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	830 if (desc->next > 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	831 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	832 /* Write desc address and search-value into sort_array */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	833
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	834 desc = (T_desc *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	835
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	836 i = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	837 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	838 sort_array[1][i] = GET_IP_FRAG_OFFSET (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	839 sort_array[0][i++] = desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	840
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	841 do
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	842 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	843 if (desc->next > 0 AND i < MAX_SEGMENTS)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	844 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	845 desc = (T_desc *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	846 sort_array[0][i] = (ULONG) desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	847 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	848 sort_array[1][i++] = GET_IP_FRAG_OFFSET (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	849 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	850 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	851 go = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	852 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	853 while (go);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	854
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	855 /* Sort the array if not overflow */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	856
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	857 if (i < MAX_SEGMENTS)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	858 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	859 n_descs = i;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	860
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	861 for (i = 0; i < n_descs - 1; i++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	862 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	863 USHORT min, j;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	864 min = i;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	865
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	866 for (j = i + 1; j < n_descs; j++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	867 if (sort_array[1][j] < sort_array[1][min])
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	868 min = j;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	869
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	870 addr = sort_array[0][i];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	871 wert = sort_array[1][i];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	872 sort_array[0][i] = sort_array[0][min];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	873 sort_array[1][i] = sort_array[1][min];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	874 sort_array[0][min] = addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	875 sort_array[1][min] = wert;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	876 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	877
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	878 /* Filter out descs with same fragment offset */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	879 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	880 ULONG v1;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	881 USHORT j, k, len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	882 len = n_descs - 1;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	883 i = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	884 while (i < len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	885 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	886 v1 = sort_array[1][i];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	887 j = i + 1;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	888 if (v1 EQ sort_array[1][j])
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	889 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	890 k = j;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	891 n_descs--;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	892 while (k <= len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	893 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	894 sort_array[0][k] = sort_array[0][k + 1];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	895 sort_array[1][k] = sort_array[1][k + 1];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	896 k++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	897 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	898 len--;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	899 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	900 if (sort_array[1][i] NEQ sort_array[1][i + 1])
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	901 i++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	902 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	903 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	904
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	905 /* Put the descs together and correct the desc_list->list_len */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	906
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	907 desc_list->first = sort_array[0][0];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	908 desc = (T_desc *) sort_array[0][0];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	909 desc_list->list_len = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	910 desc_list->list_len = desc->len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	911
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	912 for (i = 1; i < n_descs; i++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	913 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	914 desc->next = sort_array[0][i];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	915 desc = (T_desc *) desc->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	916 desc_list->list_len = desc_list->list_len + desc->len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	917 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	918
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	919 desc->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	920 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	921 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	922 code = NO_SPACE_SEGMENTING;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	923
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	924 desc = (T_desc *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	925 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	926 return code;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	927 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	928 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	929
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	930 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	931 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	932 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	933 \| STATE : code ROUTINE : build_ip_header \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	934 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	935 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	936 * Build IP header
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	937 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	938 void build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	939 UBYTE * ip_header_new,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	940 USHORT identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	941 UBYTE header_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	942 UBYTE type_of_service,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	943 UBYTE ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	944 ULONG src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	945 ULONG dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	946 USHORT total_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	947 USHORT fragm_offset,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	948 UBYTE df_flag,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	949 UBYTE mf_flag,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	950 UBYTE prot
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	951 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	952 USHORT chk_sum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	953
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	954 TRACE_FUNCTION ("build_ip_header()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	955
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	956 SET_IP_VERSION (ip_header_new, IP_VERSION);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	957 /lint -e{415, 416} (Warning -- access/creation of out-of-bounds pointer) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	958 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	959 SET_IP_HEADER_LEN (ip_header_new, header_len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	960 SET_IP_TYPE_OF_SERVICE (ip_header_new, type_of_service);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	961 SET_IP_TOTAL_LEN (ip_header_new, total_len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	962 SET_IP_IDENT (ip_header_new, identity);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	963 SET_IP_OFF_FLAG (ip_header_new, FLAG_NOT_SET);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	964 SET_IP_DF_FLAG (ip_header_new, df_flag);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	965 SET_IP_MF_FLAG (ip_header_new, mf_flag);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	966 SET_IP_FRAG_OFFSET (ip_header_new, fragm_offset);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	967 SET_IP_PROT (ip_header_new, prot);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	968 SET_IP_TTL (ip_header_new, ttl);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	969 SET_IP_SOURCE_ADDR (ip_header_new, src_addr);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	970 SET_IP_DEST_ADDR (ip_header_new, dest_addr);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	971 RESET_IP_CHECKSUM (ip_header_new);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	972 chk_sum = inet_checksum (ip_header_new, (USHORT) (header_len * 4));
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	973 SET_IP_CHECKSUM (ip_header_new, chk_sum);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	974 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	975 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	976
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	977 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	978 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	979 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	980 \| STATE : code ROUTINE : build_icmp_packet \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	981 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	982 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	983 * Build IP icmp packet without payload
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	984 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	985 void build_icmp_packet (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	986 USHORT header_len_b,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	987 UBYTE typ,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	988 UBYTE code,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	989 UBYTE ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	990 UBYTE * ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	991 USHORT identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	992 ULONG dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	993 ULONG src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	994 T_desc_list2 * desc_list
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	995 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	996 USHORT chk_sum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	997 UBYTE header_len_b_bak;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	998
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	999 TRACE_FUNCTION ("build_icmp_packet()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1000
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1001 header_len_b_bak = (UBYTE) (header_len_b >> 2);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1002
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1003 /* Build ICMP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1004
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1005 SET_ICMP_TYPE (ip_header, typ, header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1006 SET_ICMP_CODE (ip_header, code, header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1007 RESET_ICMP_CHK_SUM (ip_header, header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1008 chk_sum = desc_checksum (desc_list, header_len_b, 0);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1009 SET_ICMP_CHK_SUM (ip_header, chk_sum, header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1010
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1011 /* Build IP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1012
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1013 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1014 ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1015 identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1016 header_len_b_bak,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1017 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1018 ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1019 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1020 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1021 desc_list->list_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1022 NO_OFFSET_FRAG,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1023 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1024 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1025 ICMP_PROT
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1026 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1027 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1028
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1029 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1030 +-------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1031 \| PROJECT : WAP MODULE : IP \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1032 \| STATE : code ROUTINE : build_icmp_with_payload \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1033 +-------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1034 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1035 * Build a ICMP packet with payload of 64 bits
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1036 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1037 void build_icmp_with_payload (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1038 T_DTI2_DATA_REQ * data_req,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1039 USHORT identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1040 UBYTE ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1041 ULONG src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1042 UBYTE icmp_type,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1043 UBYTE icmp_code
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1044 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1045 T_desc2 * desc_new, * desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1046 T_desc_list2 * desc_list;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1047 USHORT malloc_len, header_len_b, chk_sum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1048 UBYTE * ip_header;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1049 ULONG dest_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1050
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1051 #define LEN_ICMP_HEADER_PAYLOAD 8
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1052 #define LEN_PAYLOAD 8
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1053
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1054 TRACE_FUNCTION ("build_icmp_with_payload()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1055
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1056 desc_list = & data_req->desc_list2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1057 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1058 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1060 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1061
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1062 /* Up to 8 bytes payload of the old datagram */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1063
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1064 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1065 USHORT help = (USHORT) (LEN_PAYLOAD + header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1066 if (help < desc->len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1067 set_desc_len (desc_list, desc, help);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1068 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1069
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1070 /* Throw away the rest descs if there are any */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1071
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1072 del_rest_descs (desc_list, desc);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1073
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1074 /* Make a new desc for the ICMP packet header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1075
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1076 malloc_len = LEN_ICMP_HEADER_PAYLOAD + LEN_IP_HEADER_B;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1077 make_new_desc (& desc_new, malloc_len, TRUE);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1078
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1079 /* Put the desc at the first place of the descs */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1080
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1081 put_desc_first_pos (desc_list, desc_new);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1082
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1083 /* Build the ICMP packet and the IP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1084
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1085 ip_header = desc_new->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1086 header_len_b = LEN_IP_HEADER_B;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1087
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1091 chk_sum = desc_checksum (desc_list, header_len_b, 0);
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1093
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1094 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1095 ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1096 identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1097 MIN_HEADER_LEN,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1098 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1099 ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1100 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1101 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1102 desc_list->list_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1103 NO_OFFSET_FRAG,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1104 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1105 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1106 ICMP_PROT
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1107 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1108 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1109
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1110 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1111 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1112 \| PROJECT : WAP MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1113 \| STATE : code ROUTINE : init_ip \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1114 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1115 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1116 * Init the global parameter
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1117 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1118 void init_ip (void)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1119 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1120 T_HILA * p_ul = & ip_data->hila;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1121 T_LOLA * p_dl = & ip_data->lola;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1122 T_KER * p_ker = & ip_data->ker;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1123 USHORT j;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1124
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1125 INIT_STATE (HILA, DOWN);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1126 INIT_STATE (LOLA, DOWN);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1127 INIT_STATE (KER, DEACTIVATED);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1128
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1129 p_ul->dti_data_req = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1130 p_ul->drop_packet = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1131 p_ul->ttl = STANDARD_TTL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1132 p_ul->header_len = MIN_HEADER_LEN;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1133 p_ul->state_segment = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1134 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1135 p_ul->segment_prot = NO_PROT_ID;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1136 p_ul->first_desc_segment = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1137 p_ul->identity = IDENTITY_0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1138
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1139 p_dl->drop_packet = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1140 p_dl->dti_data_ind= NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1141 p_dl->pos_server = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1142
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1143 for (j = 0; j < MAX_SEGM_SERVER; j++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1144 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1145 p_dl->state_reassembly[j] = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1146 p_dl->got_first_segment[j] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1147 p_dl->got_last_segment[j] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1148 p_dl->ip_source_addr_segment[j] = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1149 p_dl->data_ind_reassembly[j] = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1150 p_dl->id_reassemble[j] = NO_ID_REASSBL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1151 p_dl->prot_reassemble[j] = NO_PROT_REASSBL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1152 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1153
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1154 p_ker->peer_addr = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1155 p_ker->netmask = INIT_NETMASK;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1156 p_ker->source_addr = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1157 p_ker->dst_addr = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1158
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1159 #ifdef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1160 p_ker->source_addr = TEST_SRC_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1161 p_ker->dst_addr = TEST_DEST_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1162 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1163
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1164 p_ker->entity_name_hl[0] = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1165 p_ker->entity_name_ll[0] = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1166
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1167 p_ker->link_id_ll = IPA_LINK_ID_DEFAULT;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1168 p_ker->link_id_hl = IPA_LINK_ID_DEFAULT;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1169
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1170 p_ker->mtu = NO_MTU;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1171 p_ker->icmp_dti_data_req = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1172 p_ker->send_icmp = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1173 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1174
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1175 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1176 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1177 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1178 \| STATE : code ROUTINE : config_down_ll \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1179 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1180 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1181 * Config down a lower layer entity
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1182 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1183 void config_down_ll (void)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1184 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1185 T_HILA * p_ul = & ip_data->hila;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1186 T_LOLA * p_dl = & ip_data->lola;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1187 T_KER * p_ker = & ip_data->ker;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1188
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1189 USHORT j;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1190
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1191 TRACE_FUNCTION ("config_down_ll()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1192
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1193 free_primitive_data_ind (& p_dl->dti_data_ind);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1194 free_primitive_data_req (& p_ker->icmp_dti_data_req);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1195
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1196 for (j = 0; j < MAX_SEGM_SERVER; j++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1197 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1198 /* free_primitive_data_ind (p_dl->data_ind_reassembly + j); */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1199 /* Has already been freed five lines above, */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1200 /* because p_dl->dti_data_ind == p_dl->data_ind_reassembly. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1201 /* Please think anew when MAX_SEGM_SERVER becomes != 1. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1202
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1203 csf_stop_timer (j);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1204 p_dl->timer_reass_running[j] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1205
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1206 p_dl->state_reassembly[j] = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1207 p_dl->got_first_segment[j] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1208 p_dl->got_last_segment[j] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1209 p_dl->ip_source_addr_segment[j] = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1210 p_dl->data_ind_reassembly[j] = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1211 p_dl->id_reassemble[j] = NO_ID_REASSBL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1212 p_dl->prot_reassemble[j] = NO_PROT_REASSBL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1213 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1214
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1215 /* Keep STATE_WAIT are stored even if config down
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1216 * send READY_IND and set HILA STATE to IDLE if */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1217
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1218 switch (GET_STATE (HILA)) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1219 case WAIT: /* Keep state */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1220 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1221 case SEND: /* Send ready indication */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1222 dti_start (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1223 ip_hDTI,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1224 IP_DTI_DEF_INSTANCE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1225 IP_DTI_HL_INTERFACE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1226 IP_DTI_DEF_CHANNEL
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1227 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1228 default:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1229 SET_STATE (HILA, IDLE);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1230 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1231 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1232 SET_STATE (HILA, IDLE)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1233
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1234 p_ul->drop_packet = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1235 p_ul->state_segment = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1236 p_ul->header_len = MIN_HEADER_LEN;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1237 p_ul->ttl = STANDARD_TTL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1238 p_ul->segment_prot = NO_PROT_ID;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1239 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1240 p_ul->first_desc_segment = NULL;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1241
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1242 /* Be sure that STATE_WAIT are stored even if config down */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1243
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1244 if (GET_STATE (LOLA) NEQ WAIT)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1245 SET_STATE (LOLA, IDLE)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1246 p_dl->drop_packet = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1247
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1248 p_dl->pos_server = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1249
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1250 p_ker->peer_addr = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1251 p_ker->netmask = INIT_NETMASK;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1252 p_ker->source_addr = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1253 p_ker->dst_addr = NO_ADDR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1254 p_ker->entity_name_ll[0] = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1255 p_ker->mtu = NO_MTU;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1256 p_ker->send_icmp = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1257 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1258
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1259 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1260 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1261 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1262 \| Sp_TATE : code ROUTINE : terminate_ip \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1263 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1264 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1265 * Handle global parameter by terminate
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1266 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1267 void terminate_ip (void)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1268 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1269 TRACE_FUNCTION ("terminate_ip()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1270
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1271 /* Shutdown lower entity interface */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1272 config_down_ll ();
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1273
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1274 /* Parameter for higher layer entity */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1275 ip_data->ker.entity_name_hl[0] = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1276 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1277
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1278 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1279 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1280 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1281 \| STATE : code ROUTINE : ip_addr_int_to_byte \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1282 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1283 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1284 * Build the IP address in ULONG to 4 bytes
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1285 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1286 void ip_addr_int_to_byte (UBYTE * b_values, ULONG ul_value)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1287 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1288 TRACE_FUNCTION ("int_to_byte()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1289
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1290 b_values[3] = (UBYTE) (ul_value);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1291 b_values[2] = (UBYTE) (ul_value>>8);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1292 b_values[1] = (UBYTE) (ul_value>>16);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1293 b_values[0] = (UBYTE) (ul_value>>24);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1294 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1295
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1296 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1297 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1298 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1299 \| STATE : code ROUTINE : chk_packet_len \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1300 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1301 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1302 * Check the IP packet length
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1303 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1304 UBYTE chk_packet_len (UBYTE * ip_header, T_desc_list2 * desc_list)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1305 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1306 USHORT total_len, chk_len, mtu_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1307
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1308 TRACE_FUNCTION ("chk_packet_len()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1309
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1310 /* This is the calculated length */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1311 total_len = desc_list->list_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1312
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1313 /* This is the length indicated in the IP header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1314 chk_len = (USHORT) GET_IP_TOTAL_LEN (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1315
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1316 /* This is the max defined packet length */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1317 mtu_len = ip_data->ker.mtu;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1318
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1319 if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1320 (chk_len < MIN_HEADER_LEN) OR (chk_len > total_len) OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1321 (total_len < MIN_HEADER_LEN) OR (chk_len > mtu_len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1322 )
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1323 return ERR_PACKET_LEN;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1324 else if (chk_len < total_len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1325 return CHANGE_PACKET_LEN;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1326 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1327 return NO_ERROR;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1328 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1329
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1330 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1331 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1332 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1333 \| STATE : code ROUTINE : build_ip_packet \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1334 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1335 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1336 * Build the datagram or packets before sending
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1337 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1338 void build_ip_packet (BOOL uplink, UBYTE select)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1339 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1340 UBYTE * ip_header;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1341 USHORT total_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1342 ULONG dest_addr, src_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1343 T_desc_list2 * desc_list;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1344 T_desc2 * desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1345 T_HILA * p_ul = & ip_data->hila;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1346 T_LOLA * p_dl = & ip_data->lola;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1347 T_KER * p_ker = & ip_data->ker;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1348
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1349 T_DTI2_DATA_REQ * data_req;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1350 T_DTI2_DATA_IND * data_ind;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1351
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1352 TRACE_FUNCTION ("build_ip_packet()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1353
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1354 src_addr = p_ker->source_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1355
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1356 /* Build uplink packets */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1357
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1358 if (uplink)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1359 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1360 data_req = p_ul->dti_data_req;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1361
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1362 switch (select) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1363 /* Build "standard" IP packet */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1364 case B_NORMAL_PACKET:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1365
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1366 desc_list = & p_ul->dti_data_req->desc_list2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1367 total_len = desc_list->list_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1368 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1369 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1371
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1372 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1373 ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1374 p_ul->identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1375 (UBYTE) p_ul->header_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1376 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1377 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1378 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1379 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1380 total_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1381 NO_OFFSET_FRAG,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1382 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1383 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1384 UDP_PROT
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1385 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1386 #ifndef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1387 p_ul->identity++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1388 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1389 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1390
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1391 /* Build IP header for ICMP messages. Note only ICMP from higher layer. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1392 case B_ICMP_PACKET:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1393
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1394 desc_list = & p_ul->dti_data_req->desc_list2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1395 total_len = desc_list->list_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1396 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1397 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1399
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1400 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1401 ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1402 p_ul->identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1403 (UBYTE) p_ul->header_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1404 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1405 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1406 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1407 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1408 total_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1409 NO_OFFSET_FRAG,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1410 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1411 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1412 ICMP_PROT
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1413 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1414 #ifndef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1415 p_ul->identity++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1416 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1417 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1418
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1419 /* Build fragments. The first fragment use the original header from HL. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1420 case B_SEGMENT:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1421 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1422 /* Check if it is the first fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1423
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1424 if (p_ul->state_segment EQ NO_SEGMENTS)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1425 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1426 T_desc2 * desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1427 USHORT pos_copy, total_len_copy, malloc_len, header_len_b;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1428
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1429 desc_list = & p_ul->dti_data_req->desc_list2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1430 total_len = desc_list->list_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1431 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1432 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1434 src_addr = p_ker->source_addr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1435 p_ul->header_len = (USHORT) GET_IP_HEADER_LEN (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1436 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1437
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1438 p_ul->state_segment = SEND_SEGMENT;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1439 p_ul->sended_segment_len = p_ker->mtu;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1440 p_ul->list_len_segment = total_len;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1442 p_ul->first_desc_segment = desc;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1444
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1445 /* Make a new desc for the fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1446
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1447 malloc_len = p_ker->mtu;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1448 make_new_desc (& desc_new, malloc_len, FALSE);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1449
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1450 data_req->desc_list2.first = (ULONG) desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1451 data_req->desc_list2.list_len = malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1452 desc_new->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1453
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1454 /* Build the first fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1455 copy_from_descs_to_desc (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1456 & desc, desc_new, malloc_len, 0, 0, & pos_copy, & total_len_copy
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1457 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1458 if (total_len_copy NEQ malloc_len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1459 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1460 /* Corrupted packet -> drop it */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1461 p_ul->drop_packet = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1462
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1463 /* Clean up and free the descs */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1464 del_descs (p_ul->first_desc_segment);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1465 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1466 p_ul->next_segment_desc = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1467 p_ul->last_segment_pos = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1468 p_ul->sended_segment_len = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1469 p_ul->state_segment = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1470 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1471 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1472 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1473 p_ul->segment_id = p_ul->identity;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1474 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1475
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1476 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1477 desc_new->buffer,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1478 p_ul->segment_id,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1479 (UBYTE) p_ul->header_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1480 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1481 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1482 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1483 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1484 malloc_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1485 (USHORT) (p_ul->segment_offset >> 3),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1486 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1487 FLAG_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1488 p_ul->segment_prot
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1489 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1490 #ifndef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1491 p_ul->identity++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1492 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1493
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1494 /* For the next fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1495 p_ul->segment_offset = (USHORT) (malloc_len - header_len_b);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1496 p_ul->next_segment_desc = (ULONG) desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1497 p_ul->last_segment_pos = pos_copy;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1498 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1499 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1500
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1501 /* Middle fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1502
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1503 else if (p_ul->sended_segment_len + p_ker->mtu <
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1504 p_ul->list_len_segment + LEN_IP_HEADER_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1505 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1506 T_desc2 * desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1507
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1508 USHORT pos_copy, total_len_copy, malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1509
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1510 /* Make a new primitive for the fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1511
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1512 PALLOC (dti_data_req, DTI2_DATA_REQ);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1513 p_ul->dti_data_req = dti_data_req;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1514
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1515 /* Malloc the fragment desc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1516
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1517 malloc_len = p_ker->mtu;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1518 make_new_desc (& desc_new, malloc_len, FALSE);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1519
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1520 dti_data_req->desc_list2.first = (ULONG) desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1521 dti_data_req->desc_list2.list_len = malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1522 desc_new->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1523
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1524 /* Copy the data into the fragment desc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1525
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1526 desc = (T_desc2 *) p_ul->next_segment_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1527 copy_from_descs_to_desc (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1528 & desc,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1529 desc_new,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1530 (USHORT) (malloc_len - LEN_IP_HEADER_B),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1531 p_ul->last_segment_pos,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1532 LEN_IP_HEADER_B,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1533 & pos_copy,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1534 & total_len_copy
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1535 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1536
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1537 if (total_len_copy NEQ malloc_len - LEN_IP_HEADER_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1538 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1539 /* Corrupted packet -> drop it */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1540 p_ul->drop_packet = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1541
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1542 /* Clean up and free the descs */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1543 del_descs (p_ul->first_desc_segment);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1544 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1545 p_ul->next_segment_desc = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1546 p_ul->last_segment_pos = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1547 p_ul->sended_segment_len = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1548 p_ul->state_segment = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1549 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1550 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1551 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1552 /* Build the IP fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1553
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1554 UBYTE * ip_header_first = p_ul->first_desc_segment->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1556
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1557 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1558 desc_new->buffer,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1559 p_ul->segment_id,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1560 MIN_HEADER_LEN,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1561 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1562 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1563 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1564 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1565 malloc_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1566 (USHORT) (p_ul->segment_offset >> 3),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1567 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1568 FLAG_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1569 p_ul->segment_prot
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1570 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1571
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1572 /* For the next fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1573 p_ul->segment_offset = (USHORT)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1574 (p_ul->segment_offset + malloc_len - LEN_IP_HEADER_B);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1575 p_ul->next_segment_desc = (ULONG) desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1576 p_ul->last_segment_pos = pos_copy;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1577 p_ul->sended_segment_len = (USHORT)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1578 (p_ul->sended_segment_len + malloc_len - LEN_IP_HEADER_B);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1579 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1580 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1581 else /* Last fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1582 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1583 T_desc2 * desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1584
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1585 USHORT pos_copy, total_len_copy, malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1586
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1587 /* Make a new primitive for the fragment */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1588
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1589 PALLOC (dti_data_req, DTI2_DATA_REQ);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1590 p_ul->dti_data_req = dti_data_req;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1591
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1592 /* Calculate the correct len for fragment desc and malloc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1593
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1594 malloc_len = (USHORT) (LEN_IP_HEADER_B +
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1595 p_ul->list_len_segment - p_ul->sended_segment_len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1596 make_new_desc (& desc_new, malloc_len, FALSE);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1597
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1598 dti_data_req->desc_list2.first = (ULONG) desc_new;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1599 dti_data_req->desc_list2.list_len = malloc_len;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1600 desc_new->next = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1601
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1602 /* Copy the data into the fragment desc */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1603
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1604 desc = (T_desc2 *) p_ul->next_segment_desc;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1605
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1606 copy_from_descs_to_desc (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1607 & desc,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1608 desc_new,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1609 (USHORT) (malloc_len - LEN_IP_HEADER_B),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1610 p_ul->last_segment_pos,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1611 LEN_IP_HEADER_B,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1612 & pos_copy,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1613 & total_len_copy
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1614 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1615
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1616 if (total_len_copy NEQ malloc_len - LEN_IP_HEADER_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1617 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1618 /* Corrupted packet -> drop it */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1619 p_ul->drop_packet = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1620
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1621 /* Clean up and free the descs */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1622 del_descs (p_ul->first_desc_segment);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1623 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1624 p_ul->next_segment_desc = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1625 p_ul->last_segment_pos = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1626 p_ul->sended_segment_len = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1627 p_ul->state_segment = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1628 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1629 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1630 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1631 /* Build the fragment header */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1632
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1633 UBYTE * ip_header_first = p_ul->first_desc_segment->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1635
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1636 build_ip_header (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1637 desc_new->buffer,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1638 p_ul->segment_id,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1639 MIN_HEADER_LEN,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1640 NORMAL_SERVICE,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1641 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1642 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1643 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1644 malloc_len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1645 (USHORT) (p_ul->segment_offset >> 3),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1646 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1647 FLAG_NOT_SET,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1648 p_ul->segment_prot
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1649 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1650
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1651 /* Clean up and free the descs */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1652
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1653 del_descs (p_ul->first_desc_segment);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1654
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1655 p_ul->segment_offset = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1656 p_ul->next_segment_desc = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1657 p_ul->last_segment_pos = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1658 p_ul->sended_segment_len = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1659 p_ul->state_segment = NO_SEGMENTS;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1660 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1661 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1662 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1663 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1664
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1665 default:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1666 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1667 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1668 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1669 else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1670 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1671 data_ind = p_dl->dti_data_ind;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1672
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1673 /* Compute DL packets */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1674
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1675 switch (select) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1676 /* Ping request */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1677 case B_ICMP_ECHO_REPLY:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1678 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1679 USHORT header_len_b;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1680
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1681 PPASS (data_ind, data_request, DTI2_DATA_REQ);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1682 desc_list = & data_request->desc_list2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1683 desc = (T_desc2 *) desc_list->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1684 ip_header = desc->buffer;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1685 header_len_b = (USHORT) GET_IP_HEADER_LEN_B (ip_header);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1686
d393cd9bb723 src/g23m-: initial import from Magnetite 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) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1688
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1689 build_icmp_packet (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1690 (UBYTE) header_len_b,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1691 ICMP_TYP_ECHO_REPLY,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1692 ICMP_CODE_ECHO_REPLY,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1693 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1694 ip_header,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1695 p_ul->identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1696 dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1697 src_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1698 desc_list
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1699 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1700 #ifndef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1701 p_ul->identity++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1702 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1703 p_ker->icmp_dti_data_req = data_request;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1704 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1705 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1706
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1707 case B_ICMP_REASSEMBLE_TIMEOUT:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1708 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1709 /* Datagram for ICMP - reassembly - message */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1710
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1711 data_ind = p_dl->data_ind_reassembly[p_dl->pos_server];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1712
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1713 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1714 PPASS (data_ind, data_request, DTI2_DATA_REQ);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1715
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1716 build_icmp_with_payload (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1717 data_request,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1718 p_ul->identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1719 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1720 p_ker->source_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1721 ICMP_TYP_TIME_EXCEDED,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1722 ICMP_CODE_FRAGM_TIME_EXC
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1723 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1724 #ifndef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1725 p_ul->identity++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1726 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1727 p_ker->icmp_dti_data_req = data_request;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1728 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1729 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1730 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1731
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1732 case B_ICMP_NO_FORWARD:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1733 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1734 /* No destination address - build ICMP frame */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1735
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1736 PPASS (data_ind, data_request, DTI2_DATA_REQ);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1737
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1738 build_icmp_with_payload (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1739 data_request,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1740 p_ul->identity,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1741 p_ul->ttl,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1742 p_ker->source_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1743 ICMP_TYP_DEST_URECHBL,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1744 ICMP_CODE_NO_HOST
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1745 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1746 #ifndef _SIMULATION_
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1747 p_ul->identity++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1748 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1749 p_ker->icmp_dti_data_req = data_request;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1750 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1751 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1752
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1753 default:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1754 break;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1755 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1756 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1757 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1758
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1759 /*
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1760 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1761 \| PROJECT : GSM-FaD (8444) MODULE : IP_KERF \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1762 \| STATE : code ROUTINE : check_ip_address \|
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1763 +--------------------------------------------------------------------+
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1764 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1765 * Check the IP address
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1766 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1767 void check_ip_address (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1768 BOOL * addr_type_dest,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1769 BOOL * addr_type_src,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1770 ULONG dest_addr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1771 ULONG src_addr
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1772 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1773 UBYTE i;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1774 UBYTE b_dest_addr[4], b_src_addr[4], first_nibbl_dest, first_nibbl_src;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1775
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1776 #define BCAST 0xFF
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1777 #define LOOP_BACK 0x7F
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1778 #define DEFAULT_ROUTE 0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1779 #define CLASS_A 0x0
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1780 #define CLASS_B 0x2
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1781 #define CLASS_C 0x6
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1782 #define MULTICAST 0xE
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1783 #define CLASS_E 0xF
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1784 #define M_CAST_FF 0xFFFFFFFF
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1785
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1786 TRACE_FUNCTION ("check_ip_address()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1787
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1788 ip_addr_int_to_byte (b_dest_addr, dest_addr);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1789 ip_addr_int_to_byte (b_src_addr, src_addr);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1790
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1791 first_nibbl_dest = (UBYTE) (b_dest_addr[0] >> 4);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1792 first_nibbl_src = (UBYTE) (b_src_addr[0] >> 4);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1793
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1794 for (i=0; i < MAX_ADDR_TYPES; i++)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1795 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1796 addr_type_dest[i] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1797 addr_type_src[i] = FALSE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1798 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1799
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1800 /* Check if broadcast address */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1801
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1802 if (dest_addr EQ M_CAST_FF)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1803 addr_type_dest[BCAST_ADDR_255] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1804
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1805 if (src_addr EQ M_CAST_FF)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1806 addr_type_src[BCAST_ADDR_255] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1807
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1808 /* Correct destination address? */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1809
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1810 if (dest_addr NEQ src_addr)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1811 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1812 addr_type_dest[NO_DEST_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1813 addr_type_src[NO_DEST_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1814 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1815
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1816 /* Loop-back address? */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1817
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1818 if (b_dest_addr[0] EQ LOOP_BACK)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1819 addr_type_dest[LOOP_BACK_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1820
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1821 if (b_src_addr[0] EQ LOOP_BACK)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1822 addr_type_src[LOOP_BACK_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1823
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1824 /* Check kind of class */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1825
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1826 if ((first_nibbl_src >> 3) EQ CLASS_A)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1827 addr_type_src[CLASS_A_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1828
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1829 if ((first_nibbl_dest >> 3) EQ CLASS_A)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1830 addr_type_dest[CLASS_A_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1831
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1832 if ((first_nibbl_src >> 2) EQ CLASS_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1833 addr_type_src[CLASS_B_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1834
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1835 if ((first_nibbl_dest >> 2) EQ CLASS_B)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1836 addr_type_dest[CLASS_B_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1837
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1838 if ((first_nibbl_src >> 1) EQ CLASS_C)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1839 addr_type_src[CLASS_C_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1840
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1841 if ((first_nibbl_dest >> 1) EQ CLASS_C)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1842 addr_type_dest[CLASS_C_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1843
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1844 if (first_nibbl_src EQ CLASS_E AND dest_addr NEQ M_CAST_FF)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1845 addr_type_src[CLASS_E_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1846
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1847 if (first_nibbl_dest EQ CLASS_E AND src_addr NEQ M_CAST_FF)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1848 addr_type_dest[CLASS_E_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1849
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1850 /* Multicast or class D */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1851
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1852 if (first_nibbl_dest EQ MULTICAST)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1853 addr_type_dest[MCAST_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1854
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1855 if (first_nibbl_src EQ MULTICAST)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1856 addr_type_src[MCAST_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1857
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1858 /* Default route */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1859
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1860 if (dest_addr EQ DEFAULT_ROUTE)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1861 addr_type_dest[DEFAULT_R_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1862
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1863 if (src_addr EQ DEFAULT_ROUTE)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1864 addr_type_src[DEFAULT_R_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1865
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1866 /* Bad address? */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1867
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1868 if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1869 addr_type_src[BCAST_ADDR_255] OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1870 addr_type_src[LOOP_BACK_ADDR] OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1871 addr_type_src[DEFAULT_R_ADDR]
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1872 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1873 addr_type_src[BAD_UL_SRC_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1874 addr_type_src[BAD_DL_SRC_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1875 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1876
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1877 if (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1878 addr_type_dest[BCAST_ADDR_255] OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1879 addr_type_dest[LOOP_BACK_ADDR] OR
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1880 addr_type_dest[DEFAULT_R_ADDR]
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1881 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1882 addr_type_dest[BAD_UL_DEST_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1883 addr_type_dest[BAD_DL_DEST_ADDR] = TRUE;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1884 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1885 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1886
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1887 /* Internet checksum calculations as needed in IP and UDP.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1888 * See RFC 1071 for details.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1889 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1890 * USHORT inet_checksum (UBYTE * block, USHORT len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1891 * Computes the Internet checksum over a simple data block.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1892 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1893 * USHORT desc_checksum (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1894 * T_desc_list2 * dlist,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1895 * USHORT start_offset,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1896 * ULONG start_value
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1897 * )
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1898 * Computes the Internet checksum over a DTI descriptor list,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1899 * beginning at start_offset and with start_value. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1900
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1901 #define LITTLE_ENDIAN /* Change this for big-endian mode. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1902
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1903 /** Computes the Internet checksum [RFC 1071] over a simple data block.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1904 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1905 * @param block pointer to data block
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1906 * @param len length of the block in octets
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1907 * @return the checksum
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1908 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1909 USHORT inet_checksum (UBYTE * block, USHORT len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1910 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1911 BOOL have_leftover = len % 2; /* If non-zero, there is a leftover
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1912 * octet at the end of the (odd-sized)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1913 * data block. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1914 ULONG value; /* Value to add. (Since we know
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1915 * nothing about the alignment of the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1916 * block, we can't read the USHORTs
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1917 * directly from the block.) */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1918 ULONG checksum = 0; /* Checksum accumulator. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1919
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1920 len >>= 1; /* Count words now, not octets. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1921
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1922 while (len--)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1923 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1924 /* Because we must read the data bytewise, we cannot profit from
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1925 * the independency of endianness of the original algorithm.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1926 * That means that we have to make two different cases for big
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1927 * endian and little endian. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1928
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1929 #if defined LITTLE_ENDIAN
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1930 /lint -e{661} (Warning -- access of out-of-bounds pointer) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1931 value = block[1]<<8 \| block[0];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1932 #elif defined BIG_ENDIAN
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1933 /lint -e{662} (Warning -- creation of out-of-bounds pointer) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1934 value = block[0]<<8 \| block[1];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1935 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1936 #error "LITTLE_ENDIAN or BIG_ENDIAN must be defined."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1937 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1938
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1939 checksum += value;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1940 /lint -e{662} (Warning -- creation of out-of-bounds pointer) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1941 block +=2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1942 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1943
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1944 if (have_leftover)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1945 /lint -e{661} (Warning -- access of out-of-bounds pointer) /
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1946 checksum += *block;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1947
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1948 /* Fold into 16 bits. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1949 while (checksum >> 16)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1950 checksum = (checksum & 0xffff) + (checksum >> 16);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1951
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1952 return (USHORT) ~checksum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1953 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1954
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1955 /** Computes a part of an Internet checksum over a data block. A
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1956 * leftover octet from a previous partial calculation is taken into
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1957 * account. If an octet is left over, it is returned as well as the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1958 * fact that there is a leftover octet. This function is intended to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1959 * be called only by desc_checksum() and partial_checksum().
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1960 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1961 * @param block pointer to data block
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1962 * @param len length of the block in octets
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1963 * @param sum checksum value to begin with
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1964 * @param have_leftover_ptr if non-zero, a leftover octet is in *leftover_ptr
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1965 * @param leftover_ptr pointer to leftover octet; valid on input and
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1966 * output iff *have_leftover_ptr
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1967 * @return the part of the sum calculated
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1968 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1969 static ULONG checksum_block_part (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1970 UBYTE * block,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1971 USHORT len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1972 ULONG sum,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1973 BOOL * have_leftover_ptr,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1974 UBYTE * leftover_ptr
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1975 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1976 /* This function is as complicated as it is for two reasons:
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1977 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1978 * (a) Each block may have an even or odd number of octets. Because
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1979 * this checksum is 16-bit based, an octet may be left over from the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1980 * previous calculation and must be taken into account. Also in this
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1981 * calculation an octet may be left over. This fact and the value of
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1982 * the octet must be made known to the caller.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1983 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1984 * (b) We must not make any assumptions about the alignment of the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1985 * block. Therefore, in order not to cause alignment problems, all
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1986 * 16-bit values must be read bytewise. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1987
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1988 ULONG value; /* 16-bit value to be summed up */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1989
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1990 TRACE_FUNCTION ("checksum_block_part()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1991
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1992 /* Previous calculation may have left over an octet. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1993 if (*have_leftover_ptr)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1994 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1995 if (len == 0)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1996 return sum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1997
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1998 /* See comment in inet_checksum() above for an explanation. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	1999
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2000 #if defined LITTLE_ENDIAN
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2001 value = (block++ << 8) \| leftover_ptr;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2002 #elif defined BIG_ENDIAN
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2003 value = (leftover_ptr << 8) \| block++;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2004 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2005 #error "LITTLE_ENDIAN or BIG_ENDIAN must be defined."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2006 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2007
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2008 len--;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2009 sum += value;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2010 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2011
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2012 /* Main loop over word values. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2013 *have_leftover_ptr = len % 2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2014 len >>= 1;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2015 while (len--)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2016 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2017 /* See comment in inet_checksum() above for an explanation. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2018
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2019 #if defined LITTLE_ENDIAN
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2020 value = block[1]<<8 \| block[0];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2021 #elif defined BIG_ENDIAN
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2022 value = block[0]<<8 \| block[1];
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2023 #else
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2024 #error "LITTLE_ENDIAN or BIG_ENDIAN must be defined."
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2025 #endif
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2026
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2027 sum += value;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2028 block +=2;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2029 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2030
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2031 /* Check for leftover octet. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2032 if (*have_leftover_ptr)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2033 leftover_ptr = block;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2034
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2035 return sum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2036 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2037
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2038 /** Compute a partial Internet checksum to be used as a astart_value
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2039 * for desc_checksum. The block must have even length.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2040 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2041 * @param block data block to compute the checksum over
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2042 * @param len length of the block
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2043 * @return the partial sum calculated
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2044 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2045 ULONG partial_checksum (UBYTE * block, USHORT len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2046 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2047 BOOL dummy1 = 0; /* Needed to call checksum_block_part(). */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2048 UBYTE dummy2 = 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2049
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2050 return checksum_block_part (block, len, 0, & dummy1, & dummy2);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2051 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2052
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2053 /** Computes the Internet checksum over a DTI descriptor list. There
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2054 * may be a value from a previous partial calculation that is added to
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2055 * the sum as a start value. The function relies on the data length
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2056 * being at least start_offset.
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2057 *
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2058 * @param dlist descriptor list containing the data
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2059 * @param start_offset beginning position of interesting data
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2060 * @param start_value value from previous partial checksum calculation
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2061 * @return the checksum value
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2062 */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2063 USHORT desc_checksum (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2064 T_desc_list2 * dlist,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2065 USHORT start_offset,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2066 ULONG start_value
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2067 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2068 ULONG checksum = start_value; /* The checksum to be calculated. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2069 T_desc2 * desc_p; /* Pointer to current descriptor. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2070 BOOL have_leftover = 0; /* True iff we have a leftover octet
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2071 * from the previous partial sum. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2072 UBYTE leftover_octet = 0; /* An octet left over from the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2073 * previous partial sum. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2074
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2075 TRACE_FUNCTION ("desc_checksum()");
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2076
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2077 /* Calculating the sum of the first buffer, we have to take the
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2078 * start offset into account. This includes finding the descriptor
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2079 * the offset lies in. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2080
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2081 desc_p = (T_desc2 *) dlist->first;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2082 while (start_offset > desc_p->len)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2083 {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2084 start_offset = (USHORT) (start_offset - desc_p->len);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2085 desc_p = (T_desc2 *) desc_p->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2086 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2087 checksum = checksum_block_part (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2088 desc_p->buffer + start_offset,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2089 (USHORT) (desc_p->len - start_offset),
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2090 checksum,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2091 & have_leftover,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2092 & leftover_octet
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2093 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2094
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2095 /* Now loop over the other descriptors. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2096 for (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2097 desc_p = (T_desc2 *) desc_p->next;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2098 desc_p != 0;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2099 desc_p = (T_desc2 *) desc_p->next
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2100 ) {
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2101 checksum = checksum_block_part (
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2102 desc_p->buffer,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2103 desc_p->len,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2104 checksum,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2105 & have_leftover,
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2106 & leftover_octet
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2107 );
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2108 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2109
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2110 if (have_leftover)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2111 checksum += leftover_octet;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2112
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2113 /* Fold into 16 bits. */
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2114 while (checksum >> 16)
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2115 checksum = (checksum & 0xffff) + (checksum >> 16);
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2116
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2117 return (USHORT) ~checksum;
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2118 }
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2119
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2120 /-------------------------------------------------------------------------/
d393cd9bb723 src/g23m-: initial import from Magnetite Mychaela Falconia <falcon@freecalypso.org>* parents: diff changeset	2121

FreeCalypso > hg > fc-selenite

annotate src/g23m-fad/ip/ip_kerf.c @ 61:935692f51b38