FreeCalypso > hg > fc-magnetite
view src/g23m-fad/udp/udp_kerf.c @ 638:cab2f315827e
FFS dev.c: added Spansion PL032J to the "generic" table
With the discovery of first GTM900 and then Tango, it now appears that
Openmoko was not the only manuf after all who kept TI's TCS211 firmware
largely intact (as opposed to changing it beyond all recognition like
Compal, Chi-Mei and BenQ did), thus we are now getting new "alien" targets
on which we reuse the original manuf's FFS with IMEI and RF calibration
tables as if it were native. On these targets we use the original
device table for FFS, even though we previously thought that it would
never apply to any target other than dsample, leonardo and gtamodem.
We have previously added Samsung K5L33xxCAM (a new kind of multi-ID device)
to the generic table to support its use in Huawei GTM900-B modules; now
we got news that some slightly older GTM900-B specimen used S71PL032J
instead, so we are now adding PL032J as well.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 30 Jan 2020 17:45:48 +0000 |
parents | 90eb61ecd093 |
children |
line wrap: on
line source
/* +---------------------------------------------------------------------------- | Project : | Modul : +---------------------------------------------------------------------------- | Copyright 2002 Texas Instruments Berlin, AG | All rights reserved. | | This file is confidential and a trade secret of Texas | Instruments Berlin, AG | The receipt of or possession of this file does not convey | any rights to reproduce or disclose its contents or to | manufacture, use, or sell anything it may describe, in | whole, or in part, without the specific written consent of | Texas Instruments Berlin, AG. +---------------------------------------------------------------------------- | Purpose : This Modul defines the functions for processing | of incomming primitives for the component | Internet Protocol of the mobile station +---------------------------------------------------------------------------- */ #define ENTITY_UDP #include <string.h> #include "typedefs.h" #include "pcm.h" #include "pconst.cdg" #include "mconst.cdg" #include "message.h" #include "ccdapi.h" #include "vsi.h" #include "macdef.h" /* to get PFREE_DESC2 */ #include "custom.h" #include "gsm.h" #include "prim.h" #include "cus_udp.h" #include "cnf_udp.h" #include "mon_udp.h" #include "pei.h" #include "tok.h" #include "dti.h" /* to get dti lib */ #include "udp.h" #include "ip_udp.h" /* +--------------------------------------------------------------------+ | PROJECT : WAP MODULE : udp_kerf.c | | STATE : code ROUTINE : init_udp | +--------------------------------------------------------------------+ PURPOSE : Init the global variables of UDP */ void init_udp (void) { T_HILA * p_ul; T_LOLA * p_dl; T_KER * p_ker = & udp_data->ker; /* Set global variables for every entity */ INIT_STATE (HILA, DOWN); INIT_STATE (LOLA, DOWN); p_ul = & udp_data->hila; *p_ul->entity_name = 0; p_ul->dti_state = DTI_CLOSED; p_ul->dti_data_req = NULL; p_dl = & udp_data->lola; *p_dl->entity_name = 0; p_dl->dti_state = DTI_CLOSED; p_dl->dti_data_ind = NULL; p_dl->drop_packet = FALSE; p_dl->state_err = STATE_DL_NO_ERROR; p_dl->src_addr = NO_ADDR; p_dl->dst_addr = NO_ADDR; p_dl->dst_port = NO_PORT; p_dl->src_port = NO_PORT; /* Downlink and uplink for one entity */ p_ker->send_icmp = FALSE; p_ker->port_state = PORT_DOWN; p_ker->dti_data_req_icmp = NULL; p_ker->dst_addr = NO_ADDR; p_ker->src_addr = NO_ADDR; p_ker->src_port = NO_PORT; p_ker->dst_port = NO_PORT; } /* +--------------------------------------------------------------------+ | PROJECT : WAP MODULE : udp_kerf.c | | STATE : code ROUTINE : udp_build_packet | +--------------------------------------------------------------------+ PURPOSE : Build UDP and ICMP packets to send */ void udp_build_packet (BOOL hila, UBYTE to_do) { T_KER * p_ker = & udp_data->ker; if (hila) /* Build the packets for higher layer */ { switch (to_do) { case B_NORMAL_PACKET: { T_desc_list2 * desc_list = & udp_data->hila.dti_data_req->desc_list2; T_desc2 * desc = (T_desc2 *) desc_list->first; USHORT udp_payload_len = desc_list->list_len; if (desc == NULL) { TRACE_ERROR ("Hila's desc == NULL in udp_build_packet()."); return; } else { /* Make a new desc for the IP and UDP packet header */ USHORT headroom = LEN_IP_HEADER_B + LEN_UDP_HEADER_B; UBYTE * ip_header; T_desc2 * desc_new = M_ALLOC (offsetof (T_desc2, buffer) + headroom); if (desc_new == NULL) { TRACE_ERROR ("Not enough memory in udp_build_packet()."); return; } desc_new->next = (ULONG) desc; desc_new->offset = 0; desc_new->len = headroom; desc_new->size = headroom; ip_header = desc_new->buffer; { register unsigned i; for (i=0; i < headroom; i++) ip_header[i] = '\0';/*lint !e661 !e662 (Warning -- access/creation of out-of-bounds pointer) */ } /* Put the desc at the first place of the descs and * build the UDP header */ desc_list->first = (ULONG) desc_new; desc_list->list_len = (USHORT) (desc_new->len + desc_list->list_len); /* Fill in IP header information */ SET_IP_VERSION (ip_header, IP_VERSION); SET_IP_HEADER_LEN (ip_header, MIN_HEADER_LEN); /*lint -e{661, 662} (Warning -- access/creation of out-of-bounds pointer) */ { SET_IP_TOTAL_LEN (ip_header, desc_list->list_len); SET_IP_PROT (ip_header, UDP_PROT); SET_IP_SOURCE_ADDR (ip_header, p_ker->src_addr); SET_IP_DEST_ADDR (ip_header, p_ker->dst_addr); SET_UDP_SRC_PORT (ip_header, p_ker->src_port); SET_UDP_DST_PORT (ip_header, p_ker->dst_port); SET_UDP_LEN (ip_header, udp_payload_len + LEN_UDP_HEADER_B); } { UBYTE pseudo_header [LEN_PSEUDO_HEADER_B]; ULONG overlay; USHORT chksum; /* Build the pseudoheader for to calculate the chksum */ SET_UDP_PSEUDO_H_SRC_ADDR (pseudo_header, p_ker->src_addr); SET_UDP_PSEUDO_H_DEST_ADDR (pseudo_header, p_ker->dst_addr); SET_UDP_PSEUDO_H_ZERO (pseudo_header, 0); SET_UDP_PSEUDO_H_PROT (pseudo_header, UDP_PROT); SET_UDP_PSEUDO_H_LEN (pseudo_header, udp_payload_len + LEN_UDP_HEADER_B); /* Calculate the checksum for the pseudoheader */ overlay = partial_checksum (pseudo_header, LEN_PSEUDO_HEADER_B); /* Calculate for the UDP header and the data */ RESET_UDP_CHKSUM (ip_header, LEN_IP_HEADER_B);/*lint !e661 !e662 (Warning -- access/creation of out-of-bounds pointer) */ chksum = desc_checksum (desc_list, LEN_IP_HEADER_B, overlay); SET_UDP_CHKSUM (ip_header, LEN_IP_HEADER_B, chksum);/*lint !e661 !e662 (Warning -- access/creation of out-of-bounds pointer) */ } } } break; default: break; } } else /* Build the packets for lower layer */ { T_LOLA * p_dl = & udp_data->lola; T_desc_list2 * desc_list = & p_dl->dti_data_ind->desc_list2; T_desc2 * desc = (T_desc2 *) desc_list->first; if (desc == NULL) { TRACE_ERROR ("Lola's desc == NULL in udp_build_packet()."); return; } if (desc->len < LEN_IP_HEADER_B) { TRACE_ERROR ( "Lola's desc->len < LEN_IP_HEADER_B " "in udp_build_packet()." ); return; } if (GET_IP_HEADER_LEN_B (desc->buffer + desc->offset) < LEN_IP_HEADER_B) { TRACE_ERROR ( "Lola's GET_IP_HEADER_LEN_B() < LEN_IP_HEADER_B " "in udp_build_packet()." ); return; } switch (to_do) { case B_NORMAL_PACKET: { /* Build a new desc for IP addresses and port numbers */ T_desc2 * addr = M_ALLOC ( offsetof (T_desc2, buffer) + sizeof (T_SRC_DES) ); if (addr == NULL) { TRACE_ERROR ("Not enough memory in udp_build_packet()."); return; } addr->next = (ULONG) desc; addr->offset = 0; addr->len = sizeof (T_SRC_DES); addr->size = sizeof (T_SRC_DES); memcpy (((T_SRC_DES *) addr->buffer)->src_ip, & p_dl->src_addr, 4); memcpy (((T_SRC_DES *) addr->buffer)->des_ip, & p_dl->dst_addr, 4); memcpy (((T_SRC_DES *) addr->buffer)->src_port, & p_dl->src_port, 2); memcpy (((T_SRC_DES *) addr->buffer)->des_port, & p_dl->dst_port, 2); desc_list->first = (ULONG) addr; desc_list->list_len = (USHORT) (addr->len + desc_list->list_len); /* Filter out the given IP and UDP header */ { register unsigned headroom = GET_IP_HEADER_LEN_B (desc->buffer + desc->offset) + LEN_UDP_HEADER_B; if (desc->len < headroom) { TRACE_ERROR ("Lola's IP packet is short in udp_build_packet()."); return; } memmove ( desc->buffer + desc->offset, desc->buffer + desc->offset + headroom, desc->len - headroom ); desc->len = (USHORT) (desc->len - headroom); desc_list->list_len = (USHORT) (desc_list->list_len - headroom); } } break; case B_NO_DEST_PORT: { /* We build the whole ICMP packet */ PPASS (p_dl->dti_data_ind, data_req, DTI2_DATA_REQ); desc_list = & data_req->desc_list2; desc = (T_desc2 *) desc_list->first; build_icmp_with_payload ( data_req, IDENTITY_0, STANDARD_TTL, GET_IP_DEST_ADDR (desc->buffer + desc->offset), ICMP_TYP_DEST_URECHBL, ICMP_CODE_NO_PORT ); p_ker->dti_data_req_icmp = data_req; } break; default: break; } } } /*-------------------------------------------------------------------------*/