fc-magnetite: src/gpf3/ccd/bitfun.c annotate

annotate src/gpf3/ccd/bitfun.c @ 662:8cd8fd15a095

SIM speed enhancement re-enabled and made configurable TI's original code supported SIM speed enhancement, but Openmoko had it disabled, and OM's disabling of speed enhancement somehow caused certain SIM cards to start working which didn't work before (OM's bug #666). Because our FC community is much smaller in year 2020 than OM's community was in their day, we are not able to find one of those #666-affected SIMs, thus the real issue they had encountered remains elusive. Thus our solution is to re-enable SIM speed enhancement and simply wait for if and when someone runs into a #666-affected SIM once again. We provide a SIM_allow_speed_enhancement global variable that allows SIM speed enhancement to be enabled or disabled per session, and an /etc/SIM_spenh file in FFS that allows it to enabled or disabled on a non-volatile basis. SIM speed enhancement is now enabled by default.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sun, 24 May 2020 05:02:28 +0000
parents	c41a534f33c6
children

rev	line source
2 c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 +-----------------------------------------------------------------------------
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 \| Project :
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 \| Modul : bitfun.c
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 +-----------------------------------------------------------------------------
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 \| Copyright 2002 Texas Instruments Berlin, AG
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 \| All rights reserved.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 \| This file is confidential and a trade secret of Texas
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 \| Instruments Berlin, AG
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 \| The receipt of or possession of this file does not convey
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 \| any rights to reproduce or disclose its contents or to
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 \| manufacture, use, or sell anything it may describe, in
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 \| whole, or in part, without the specific written consent of
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 \| Texas Instruments Berlin, AG.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 +-----------------------------------------------------------------------------
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 \| Purpose : Definition of constants, types and global variables and bit
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 \| stream manipulation functions for CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 +-----------------------------------------------------------------------------
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #define __BITFUN_C__
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include <stdio.h>
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 #include "typedefs.h"
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 #include "header.h"
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 #include "string.h"
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 #include "ccd_globs.h"
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 #include "bitfun.h"
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 #include "ccd.h"
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 EXTERN int abs(int);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 * For each bitlength between 0 and 32 this table contains the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 * valid masks for right-justificated values
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 const ULONG ccd_bitfun_mask[] =
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 0x00000000,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 0x00000001, 0x00000003, 0x00000007, 0x0000000f,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 0x0000001f, 0x0000003f, 0x0000007f, 0x000000ff,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 0x000001ff, 0x000003ff, 0x000007ff, 0x00000fff,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 0x00001fff, 0x00003fff, 0x00007fff, 0x0000ffff,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 0x0001ffff, 0x0003ffff, 0x0007ffff, 0x000fffff,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 0x001fffff, 0x003fffff, 0x007fffff, 0x00ffffff,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 0x01ffffff, 0x03ffffff, 0x07ffffff, 0x0fffffff,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 0x1fffffff, 0x3fffffff, 0x7fffffff, 0xffffffff
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 };
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 * Table of one-bit values (2^X)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 const UBYTE ccd_bitfun_shift[] =
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 128, 64, 32, 16, 8, 4, 2, 1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 };
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 extern const ULONG ccd_bitfun_mask[];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 extern const UBYTE ccd_bitfun_shift[];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 * maschine-dependent implementation
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 * define M_INTEL or M_MOTOROLA dependend on the target system
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 #ifdef M_INTEL
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 #define MSB_POS 1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 #define LSB_POS 0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 #define MSW_POS 2
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 #define LSW_POS 0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 #else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 #ifdef M_MOTOROLA
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 #define MSB_POS 0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 #define LSB_POS 1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 #define MSW_POS 0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 #define LSW_POS 2
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 typedef union
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 { /* Conversion structure */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 UBYTE c[2]; /* 2 bytes <-> USHORT */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 USHORT s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 t_conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 typedef union
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 { /* Conversion structure */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 UBYTE c[4]; /* 4 Byte <-> ULONG */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 ULONG l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 t_conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 \| STATE : code ROUTINE : ccd_BITIMAGE \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 PURPOSE : convert a ULONG value to a ascii-bitstring with the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 length len.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 char ccd_BITIMAGE (ULONG val, ULONG len, T_CCD_Globs globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 int i;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 for (i=31; i >= 0; i--)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 globs->buf [i] = (char)(val & 1)+'0';
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 val >>= 1;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 globs->buf [32] = '\0';
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 return globs->buf+(32-len);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 \| STATE : code ROUTINE : fmemcpy \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 PURPOSE : copies len bytes from source to dest
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 for FAR addresses.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 void fmemcpy (UBYTE * d, UBYTE *s, USHORT len)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 while (len--)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 d++ = s++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 \| STATE : code ROUTINE : bf_writeBitChunk \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 PURPOSE : The global pointer globs->pstruct+globs->pstructOffs references
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 a buffer struct containing the len, offset and content
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 of a bitbuffer. This funtions copies the bits to the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 bitstream buffer at the actual position.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 void bf_writeBitChunk (ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 ULONG offs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 ULONG bytesToCopy=0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 signed char theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 U8 MsgStruct = (U8)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 * Read the length of the buffer (the l_buf component) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 * compare it with the parameter given.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 len = MINIMUM (len, ((USHORT )MsgStruct));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 if (!len)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 return;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 bytesToCopy = (ULONG) ((len + ByteOffs + 7)>> 3);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 offs = (ULONG)((USHORT )(MsgStruct + 2));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 theShift = (signed char) (offs - ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 TRACE_CCD (globs, "reading 2+2+%ld bytes from struct %08X, writing %d bits at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 bytesToCopy, MsgStruct + 4, len, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 if ((abs(theShift) & 7) EQ 0)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 MsgStruct += (4+(offs>>3));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 * the bits in the Buffer are in the right position
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 * -> quick memcopy.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 * write the first byte, clean the leading bits
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 MsgBuf \|= (MsgStruct & (UBYTE) ccd_bitfun_mask[8 - (offs&7)]);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 * copy the remaining bytes
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 if (bytesToCopy)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 memcpy ((UBYTE *) &MsgBuf[1],
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 MsgStruct + 1,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 (size_t)bytesToCopy-1);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 if ((ByteOffs+len)&7)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 MsgBuf[bytesToCopy-1] &= ~ccd_bitfun_mask[8-((ByteOffs+len)&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 t_conv16 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 * shift every single byte
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 MsgStruct += (4+(offs>>3));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 if (bytesToCopy > 1)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 --bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 if (theShift > 0)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 * shift all bytes leftwise
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 * the first byte must be masked
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 theShift &= 7;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 conv.c[MSB_POS] = *MsgStruct++ & (UBYTE) ccd_bitfun_mask[8-(offs&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 conv.s <<= theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 *MsgBuf++ \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 *MsgBuf = conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 --bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 while (bytesToCopy)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 conv.c[MSB_POS] = *MsgStruct++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 conv.s <<= theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 *MsgBuf++ \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 *MsgBuf = conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 --bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 conv.c[MSB_POS] = *MsgStruct++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 conv.s <<= theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 *MsgBuf \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 if ((ByteOffs+len)&7)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 *MsgBuf &= ~ccd_bitfun_mask[8-((ByteOffs+len)&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 * shift all bytes rightwise
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 * the first byte must be masked, we dont want to store the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 * leading garbage before the valid bits
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 theShift = (-theShift & 7);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 conv.c[MSB_POS] = *MsgStruct++ & (UBYTE) ccd_bitfun_mask[8-(offs&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 conv.s >>= theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 *MsgBuf++ \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 *MsgBuf = conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 --bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 while (bytesToCopy)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 conv.c[MSB_POS] = *MsgStruct++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 conv.s >>= theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 *MsgBuf++ \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 *MsgBuf = conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 --bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 conv.c[MSB_POS] = *MsgStruct++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 conv.s >>= theShift;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 *MsgBuf \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 if ((ByteOffs+len)&7)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 *MsgBuf &= ~ccd_bitfun_mask[8-((ByteOffs+len)&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 globs->pstructOffs = MsgStruct - globs->pstruct - 1;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 \| STATE : code ROUTINE : bf_writeBits \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 PURPOSE : The pointer globs->pstruct + globs->pstructOffs refers to
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 a var in the message C-structure. This function writes the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 numeric content of the var into the bit stream referenced
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 by globs->bitbuf. According to the required lenght
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 (len) the type of the var is interpreted as BYTE/SHORT
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 or LONG.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 void bf_writeBits (ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 * Bit field is given by its lenght, offset bit and buffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 if (len > 32)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 bf_writeBitChunk (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 return;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 UBYTE MsgStruct = (UBYTE)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 UBYTE MsgBuf = (UBYTE)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 U32 wBits;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 wBits = len + ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 if (len > 24)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 UBYTE FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 conv32.l = ((ULONG ) MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 conv32.l &= (ULONG) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 conv32.l <<= (32-len);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 FirstByte = conv32.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 FirstByte >>= ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 FirstByte &= (UBYTE) ccd_bitfun_mask[8-ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 *MsgBuf++ \|= FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 conv32.l <<= (8-ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 *MsgBuf++ = conv32.c[MSW_POS + MSB_POS] ;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 *MsgBuf++ = conv32.c[MSW_POS + LSB_POS] ;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 *MsgBuf++ = conv32.c[LSW_POS + MSB_POS] ;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 if (wBits > 32)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 *MsgBuf = conv32.c[LSW_POS + LSB_POS] ;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 * Bit field given in a C variable is shorter than a USHORT.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 TRACE_CCD (globs, "write %d bits at byte %d.%d", len, globs->bytepos, ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 if (len > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 t_conv32 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 conv.l = (len > 16) ? (ULONG ) MsgStruct
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 : (ULONG) * (USHORT *) MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 conv.l &= ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE (conv.l, len, globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 conv.l <<= (32 - wBits);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 *MsgBuf \|= conv.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 MsgBuf[1] \|= conv.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 if (wBits > 16)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 MsgBuf[2] \|= conv.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 if (wBits > 24)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 MsgBuf[3] \|= conv.c[LSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 t_conv16 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 conv.s = (USHORT) (*MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 conv.s &= (USHORT) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE ((ULONG) conv.s, len, globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 conv.s <<= (16 - wBits);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 *MsgBuf \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 if (wBits > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 MsgBuf[1] \|= conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 #ifndef RUN_INT_RAM
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 \| STATE : code ROUTINE : bf_writeBitStr_PER \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 PURPOSE : The pointer globs->pstruct + globs->pstructOffs refers to
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 a var in the message C-structure. This function writes the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 numeric content of the var into the bit stream referenced
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 by globs->bitbuf.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 void bf_writeBitStr_PER (USHORT len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 USHORT bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 t_conv16 Last2Bytes;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 U8 MsgStruct = (U8)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 U8 *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 MsgBuf = (U8*)(globs->bitbuf + globs->bytepos + ((ByteOffs + len) >> 3));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 * Store the data for a later compensation of buffer overwritting.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 * bytepos is always greater than 1, since the first byte with bytepos=0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 * is dedicated to message identifier.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 Last2Bytes.c[MSB_POS] = MsgBuf[0];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 Last2Bytes.c[LSB_POS] = MsgBuf[1];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 MsgBuf -= (ByteOffs + len) >> 3;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 bytesToCopy = (len+7) >> 3;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 TRACE_CCD (globs, "copying %d byte(s) from struct 0x%08X, writing %d bits at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 bytesToCopy, MsgStruct, len, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 int i=0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 int j=0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 char s[64], c[4];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 int leftBytes = bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 TRACE_CCD (globs, " Bit string to be encoded:");
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 s[0] = '\0';
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 for (i = 0; leftBytes > 0 ; i++)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 for (j = 0; (j < 16 && (leftBytes-- > 0)) ; j++)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 sprintf(c, " %02x", (MsgStruct+(16i)+j));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 strcat (s, c);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 TRACE_CCD (globs, "%s", s);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 s[0] = '\0';
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 * The bits will be appended to the bit buffer at byte boundary.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 if (ByteOffs EQ 0)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 * CCD assumes that the bits to be copied are left adjusted
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 * int their place in the C-structure.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 memcpy ((UBYTE *) MsgBuf,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 MsgStruct,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 (size_t)bytesToCopy);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 MsgBuf += bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 t_conv16 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 * Write byte for byte while compensating non-zero value of globs->byteoffs.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 while (bytesToCopy--)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 conv.c[MSB_POS] = *MsgStruct++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 conv.c[LSB_POS] = *MsgStruct;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 conv.s >>= ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 conv.s &= (USHORT) ccd_bitfun_mask[16-ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 *MsgBuf++ \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 *MsgBuf \|= conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 * Undo overwriting of bits which do not belong to the bit string.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 MsgBuf = (U8*)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 MsgBuf[0] &= ~ccd_bitfun_mask[8-globs->byteoffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 Last2Bytes.c[MSB_POS] &= (UBYTE) ccd_bitfun_mask[8-globs->byteoffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 MsgBuf[0] \|= Last2Bytes.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 MsgBuf[1] = Last2Bytes.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516 #endif /* !RUN_INT_RAM */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 \| STATE : code ROUTINE : bf_writePadBits \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 PURPOSE : The global pointer globs->bitbuf points to the bit stream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526 buffer. This function adds 0-7 zero bits to the bit stream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 from the point globs->byteoffs refer to.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 void bf_writePadBits (T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 if (globs->byteoffs NEQ 0)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 globs->bitbuf[globs->bytepos] &=
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 (UBYTE) ~ccd_bitfun_mask[8-globs->byteoffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 TRACE_CCD (globs, "writing %d pad bit(s) at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 8-globs->byteoffs, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 bf_incBitpos (8-globs->byteoffs, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550 \| STATE : code ROUTINE : bf_readBit \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 PURPOSE : The global pointer globs->bitbuf points to the bit stream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 buffer. This function reads the bit to which the global
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 positioning pointers are pointing to.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 BOOL bf_readBit (T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 UBYTE ret;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 ret = globs->bitbuf[globs->bytepos] & ccd_bitfun_shift[globs->byteoffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 bf_incBitpos (1, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 TRACE_CCD (globs, "reading 1 bit (%d) at byte %d.%d", (ret>0)?1:0, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 return (ret > 0);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 \| STATE : code ROUTINE : bf_writeBit \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 PURPOSE : The global pointer globs->bitbuf points to the bit stream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 buffer. This function writes a given value into the bit
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 to which the global positioning pointers are pointing to.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 void bf_writeBit (BOOL Bit, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 globs->bitbuf[globs->bytepos] = Bit ? (globs->bitbuf[globs->bytepos] \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 ccd_bitfun_shift[globs->byteoffs])
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 : (globs->bitbuf[globs->bytepos] & ~ccd_bitfun_shift[globs->byteoffs]);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 TRACE_CCD (globs, "writing 1 bit (%d) at byte %d.%d", Bit, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 bf_incBitpos (1, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 \| STATE : code ROUTINE : bf_rShift8Bit \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 PURPOSE : shifts a bitfield in the bitstream by 8 bits rightwise.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 The function is used only for octet aligned types.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 Hence offset is not involved in calculation.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 void bf_rShift8Bit
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 (
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 USHORT srcBitPos,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 USHORT bitLen,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 T_CCD_Globs *globs
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 )
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 register UBYTE bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 USHORT bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 * destination > source -> start with last byte
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 bytepos = srcBitPos >> 3;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 bytesToCopy = bitLen >> 3;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 TRACE_CCD (globs, "shifting %d bits rightwise for 8 bits", bitLen);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 while (bytesToCopy)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 globs->bitbuf[bytepos+bytesToCopy] = globs->bitbuf[bytepos+bytesToCopy-1];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632 bytesToCopy--;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 globs->bitbuf[bytepos] = 0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 \| STATE : code ROUTINE : bf_readBitChunk \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 PURPOSE : reads (len) Bits from the Bitsream (globs->bitbuf) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 stores them to the T_MSGBUF struct, containig the len
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 the offset and a bitbuffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 void bf_readBitChunk (ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 ULONG bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 U8 MsgStruct = (U8)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 (U16) (MsgStruct) = (U16) len;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 MsgStruct += 2;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659 (U16) (MsgStruct) = (U16)ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 MsgStruct += 2;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 bytesToCopy = (ULONG) ((len >> 3)+(len&7?1:0)+(ByteOffs?1:0));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 TRACE_CCD (globs, "reading %ld bits from byte %d.%d, writing 2+2+%ld bytes to struct %08X",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 len, globs->bytepos, globs->byteoffs, bytesToCopy, MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 memcpy ((UBYTE *) MsgStruct,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 MsgBuf,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 (size_t)bytesToCopy);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 #if 0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 int i;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675 for (i=0; i<bytesToCopy; i++)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677 TRACE_CCD (globs, "buf[%d] = 0x%02x", i, MsgStruct[i]);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 * cutoff the leading and trailing bits wich are obsolete
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685 *MsgStruct &= ccd_bitfun_mask [8-ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 if ((len+ByteOffs)&7)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 MsgStruct += (bytesToCopy-1);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 *MsgStruct &= ~ccd_bitfun_mask [8-((len+ByteOffs)&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692 #if 0
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 int i;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 for (i=0; i<bytesToCopy; i++)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 TRACE_CCD (globs, "buf[%d] = 0x%02x", i, MsgStruct[i]);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 #ifndef RUN_INT_RAM
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 \| STATE : code ROUTINE : bf_readBitStr_PER \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714 PURPOSE : The pointer globs->pstruct + globs->pstructOffs refers to
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 a var in the message C-structure. This function reads len
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 bits from the bit stream (globs->bitbuf) and stores them
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 left adjusted to the bytes in the message C-structure.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 void bf_readBitStr_PER (USHORT len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 USHORT bytesToCopy;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 t_conv16 Last2Bytes;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 U8 MsgStruct = (U8)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725 U8 MsgStructEnd = (U8)(globs->pstruct + globs->pstructOffs + (len >> 3));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 bytesToCopy = (len+7) >> 3;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 * Store the data for a later compensation of buffer overwritting.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 Last2Bytes.c[MSB_POS] = MsgStructEnd[0];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 Last2Bytes.c[LSB_POS] = MsgStructEnd[1];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 * The bits will be read from the bit buffer at byte boundary.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 if (ByteOffs EQ 0)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 TRACE_CCD (globs, "reading %d bits from byte %d.%d, copying %d bytes to struct at 0x%08X",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 len, globs->bytepos, globs->byteoffs, bytesToCopy, MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 * CCD assumes that the caller function needs the bit string to be
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 * left adjusted in the C-structure.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 memcpy ((UBYTE *) MsgStruct,//(globs->pstruct + globs->pstructOffs),
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 MsgBuf,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754 (size_t)bytesToCopy);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 t_conv16 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 * Read byte for byte while compensating the non-zero globs->byteoffs.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 while (bytesToCopy--)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765 conv.c[MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 conv.c[LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 conv.s <<= ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768 conv.s &= (USHORT) ~ccd_bitfun_mask[8-(len&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 *MsgStruct++ = conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 *MsgStruct = conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775 * Undo overwriting in C-Structure. This is specially necessary
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 * for later reading of valid flags for optional elments.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 MsgStructEnd[0] &= (UBYTE) ~ccd_bitfun_mask[8-(len&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 Last2Bytes.c[MSB_POS] &= (UBYTE) ccd_bitfun_mask[8-(len&7)];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 MsgStructEnd[0] \|= Last2Bytes.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 MsgStructEnd[1] = Last2Bytes.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 int i=0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 int j=0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787 char s[64], c[4];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 int leftBytes = (len+7) >> 3;;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 MsgStruct = (U8*)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 TRACE_CCD (globs, " Decoded bit string:");
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 s[0] = '\0';
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 for (i = 0; leftBytes > 0 ; i++)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796 for (j = 0; (j < 16 && (leftBytes-- > 0)) ; j++)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 sprintf(c, " %02x", (MsgStruct+(16i)+j));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 strcat (s, c);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 TRACE_CCD (globs, "%s", s);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802 s[0] = '\0';
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 globs->pstructOffs += ((len+7) >> 3);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 #endif /* !RUN_INT_RAM */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 \| STATE : code ROUTINE : bf_readBits \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 PURPOSE : reads (len) Bits from the Bitsream (globs->bitbuf) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 stores them typed (dependent on the length) to vars in
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821 the C-struct referenced by the global var
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822 globs->pstruct+globs->pstructOff.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825 void bf_readBits (ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 * Bit field is given by its lenght, offset bit and buffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 if (len > 32)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 bf_readBitChunk (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 return;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 t_conv16 conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 U8 MsgStruct = (U8)(globs->pstruct + globs->pstructOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 TRACE_CCD (globs, "reading %d bits form byte %d.%d,", len, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	846
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	847 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	848 * Bit field is given in a C variable shorter than a USHORT.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	849 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	850 if (len <= 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	851 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 if (globs->lastbytepos16 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 conv16.c[MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 conv16.c[LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 globs->lastbytepos16 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	857 globs->last16Bit = conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 conv16.s = globs->last16Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861 conv16.s >>= (16 - (ByteOffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862 conv16.s &= (USHORT) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863 *MsgStruct = (UBYTE) conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 TRACE_CCD (globs, "writing 1 bytes (%0X) to struct %08X", *MsgStruct, MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 else if (len + ByteOffs <= 32)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 if (globs->lastbytepos32 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	871 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	872 conv32.c[MSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	873 conv32.c[MSW_POS + LSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	874 conv32.c[LSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	875 conv32.c[LSW_POS + LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	876 globs->lastbytepos32 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	877 globs->last32Bit = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	878 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	879 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	880 conv32.l = globs->last32Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	881 conv32.l >>= (32 - (ByteOffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	882 conv32.l &= ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	883 if (len > 16)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	884 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	885 ((ULONG ) MsgStruct) = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	886 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	887 TRACE_CCD (globs, "writing 4 bytes (%08X) to struct %08X",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	888 conv32.l,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	889 MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	891 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	892 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	893 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	894 ((USHORT ) MsgStruct) = (USHORT) conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	895 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	896 TRACE_CCD (globs, "writing 2 bytes (%04X) to struct %08X",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	897 (USHORT) conv32.l,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	898 MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	899 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	900 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	901 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	902 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	903 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	904 UBYTE FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	905
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	906 FirstByte = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	907 FirstByte <<= ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	908 FirstByte &= (UBYTE) ~ccd_bitfun_mask[ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	909
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	910 if (globs->lastbytepos32 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	911 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	912 conv32.c[MSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	913 conv32.c[MSW_POS + LSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	914 conv32.c[LSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	915 conv32.c[LSW_POS + LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	916 globs->lastbytepos32 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	917 globs->last32Bit = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	918 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	919 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	920 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	921 conv32.l = globs->last32Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	922 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	923 if (!ByteOffs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	924 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	925 conv32.l >>= 8;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	926 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	927 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	928 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	929 conv32.l >>= (8-ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	930 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	931 conv32.c[MSW_POS + MSB_POS] &= (UBYTE) ccd_bitfun_mask[ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	932 conv32.c[MSW_POS + MSB_POS] \|= FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	933 conv32.l >>= (32-len);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	934 conv32.l &= (ULONG) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	935
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	936 ((ULONG ) MsgStruct) = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	937 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	938 TRACE_CCD ( globs, "writing 4 bytes (%08X) to struct %08X",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	939 conv32.l,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	940 MsgStruct);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	941 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	942 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	943 bf_incBitpos (len, globs); return;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	944 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	945 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	946 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	947
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	948 #ifndef RUN_INT_RAM
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	949 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	950 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	951 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	952 \| STATE : code ROUTINE : bf_writeVal \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	953 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	954
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	955 PURPOSE : writes value into the next (bSize) bits of the air message
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	956 buffer(globs->bitbuf). This function does not use the data
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	957 in the C-structure. This is done by the caller function
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	958 while calculating value.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	959 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	960 void bf_writeVal (ULONG value, ULONG bSize, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	961 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	962 ULONG BitSum;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	963 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	964 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	965
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	966 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	967 TRACE_CCD (globs, "writeVal %d bits at byte %d.%d", bSize, globs->bytepos, ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	968 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	969 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	970 * value will be written into a temporary buffer. This buffer will
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	971 * then be prepared for an ORing with the bit buffer of air message.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	972 * BitSum is helpful to find out the right size for temporary buffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	973 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	974 BitSum = bSize + (ULONG)ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	975
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	976 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	977 * Write in 1 to 8 bits (bSize is 1-8).
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	978 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	979 if (BitSum <= 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	980 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	981 UBYTE TmpBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	982
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	983 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	984 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE ((ULONG)(value & ccd_bitfun_mask[bSize]), bSize, globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	985 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	986 TmpBuf = (UBYTE) value;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	987 TmpBuf &= (UBYTE) ccd_bitfun_mask[bSize];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	988 TmpBuf <<= (8 - BitSum);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	989 *MsgBuf \|= TmpBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	990 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	991 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	992 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	993 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	994 * Write in 9 to 16 bits (bSize is 9-16).
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	995 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	996 if (BitSum <= 16)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	997 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	998 t_conv16 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	999
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1000 conv.s = (USHORT) value;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1001 conv.s &= (USHORT) ccd_bitfun_mask[bSize];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1002 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1003 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE ((ULONG) conv.s, bSize, globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1004 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1005 conv.s <<= (16 - BitSum);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1006 MsgBuf[0] \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1007 MsgBuf[1] \|= conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1008 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1009
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1010 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1011 * Write in 17 to 25 bits (bSize is 17-25).
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1012 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1013 else if (BitSum <= 32)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1014 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1015 t_conv32 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1016
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1017 conv.l = value;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1018 conv.l &= ccd_bitfun_mask[bSize];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1019 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1020 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE ((ULONG)conv.l, bSize, globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1021 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1022 conv.l <<= (32 - BitSum);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1023 MsgBuf[0] \|= conv.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1024 MsgBuf[1] \|= conv.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1025 MsgBuf[2] \|= conv.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1026 if (BitSum > 24)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1027 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1028 MsgBuf[3] \|= conv.c[LSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1029 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1030 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1031 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1032 * Write in 25 to 32 bits (bSize is 25-32).
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1033 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1034 else if ( BitSum < 40)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1035 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1036 UBYTE FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1037 t_conv32 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1038
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1039 conv.l = value;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1040 conv.l <<= (32 - bSize);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1041 FirstByte = conv.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1042 FirstByte >>= ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1043 FirstByte &= (UBYTE) ccd_bitfun_mask[8-ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1044 MsgBuf[0] \|= FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1045
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1046 conv.l <<= (8 - ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1047 MsgBuf[1] \|= conv.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1048 MsgBuf[2] \|= conv.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1049 MsgBuf[3] \|= conv.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1050 MsgBuf[4] \|= conv.c[LSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1051 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1052 conv.l &= (ULONG) ~ccd_bitfun_mask[24-ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1053 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE ((ULONG) FirstByte, (ULONG)(8-ByteOffs), globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1054 TRACE_CCD (globs, " (.%s)", ccd_BITIMAGE (conv.l, (ULONG)(24-ByteOffs), globs));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1055 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1056 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1057 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1058 * This case is currently not supported.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1059 * Integer values are written to and read from up to 32 bits.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1060 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1061 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1062 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1063 return;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1064 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1065 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1066
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1067 bf_incBitpos (bSize, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1068 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1069 #endif /* !RUN_INT_RAM */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1070
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1071 #ifndef RUN_INT_RAM
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1072 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1073 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1074 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1075 \| STATE : code ROUTINE : bf_getBits \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1076 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1077
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1078 PURPOSE : reads len Bits from the Bitstream (globs->bitbuf) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1079 stores them in a variable. The caller function can now
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1080 interpret or process the content of the returned variable.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1081 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1082
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1083 ULONG bf_getBits (ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1084 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1085 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1086 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1087
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1088 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1089 TRACE_CCD (globs, "reading %ld bits form byte %d.%d,", len, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1090 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1091
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1092 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1093 * Read up to 8 bits from the air message buffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1094 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1095 if (len <= 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1096 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1097 t_conv16 conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1098
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1099 if (globs->lastbytepos16 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1100 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1101 conv16.c[MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1102 conv16.c[LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1103 globs->lastbytepos16 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1104 globs->last16Bit = conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1105 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1106 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1107 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1108 conv16.s = globs->last16Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1109 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1110 conv16.s >>= (16 - (ByteOffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1111 conv16.s &= (USHORT) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1112 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1113 TRACE_CCD (globs, "read value: %d", conv16.s);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1114 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1115 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1116 return (ULONG) conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1117 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1118
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1119 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1120 * Read between 8 and 24 bits from the air message buffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1121 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1122 else if (len <= 24)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1123 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1124 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1125
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1126 if (globs->lastbytepos32 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1127 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1128 conv32.c[MSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1129 conv32.c[MSW_POS + LSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1130 conv32.c[LSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1131 conv32.c[LSW_POS + LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1132 globs->lastbytepos32 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1133 globs->last32Bit = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1134 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1135 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1136 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1137 conv32.l = globs->last32Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1138 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1139 conv32.l >>= (32 - (ByteOffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1140 conv32.l &= ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1141 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1142 TRACE_CCD (globs, "read value: %ld", conv32.l);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1143 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1144 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1145 return conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1146 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1147
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1148 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1149 * Read between 24 and 32 bits from the air message buffer.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1150 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1151 else if ( len <= 32)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1152 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1153 UBYTE FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1154 t_conv32 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1155
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1156 FirstByte = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1157 FirstByte <<= ByteOffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1158 FirstByte &= (UBYTE) ~ccd_bitfun_mask[ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1159
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1160 if (globs->lastbytepos32 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1161 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1162 conv.c[MSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1163 conv.c[MSW_POS + LSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1164 conv.c[LSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1165 conv.c[LSW_POS + LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1166 globs->lastbytepos32 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1167 globs->last32Bit = conv.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1168 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1169 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1170 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1171 conv.l = globs->last32Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1172 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1173 if (!ByteOffs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1174 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1175 conv.l >>= 8;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1176 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1177 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1178 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1179 conv.l >>= (8-ByteOffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1180 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1181 conv.c[MSW_POS + MSB_POS] &= (UBYTE) ccd_bitfun_mask[ByteOffs];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1182 conv.c[MSW_POS + MSB_POS] \|= FirstByte;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1183 conv.l >>= (32-len);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1184 conv.l &= (ULONG) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1185
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1186 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1187 TRACE_CCD (globs, "read value: %ld", conv.l);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1188 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1189 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1190 return conv.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1191 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1192
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1193 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1194 * This case is currently not supported.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1195 * Integer values are written to and read from up to 32 bits.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1196 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1197 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1198 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1199 return 0;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1200 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1201 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1202 #endif /* !RUN_INT_RAM */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1203
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1204 #ifndef RUN_INT_RAM
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1205 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1206 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1207 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1208 \| STATE : code ROUTINE : bf_decodeLongNumber \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1209 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1210
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1211 PURPOSE : reads (len) Bits from the Bitsream (globs->bitbuf) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1212 return this number as a 32 Bit number. The Position
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1213 of the readpointer of the bitstream is incremented by
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1214 the len.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1215 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1216
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1217 ULONG bf_decodeLongNumber (UBYTE len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1218 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1219 U32 number;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1220 t_conv16 conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1221 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1222 U8 ByteOffs = globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1223 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1224
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1225 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1226 TRACE_CCD (globs, "reading %d bits form byte %d.%d,", len, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1227 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1228
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1229 if (len <= 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1230 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1231 if (globs->lastbytepos16 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1232 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1233 conv16.c[MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1234 conv16.c[LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1235 globs->lastbytepos16 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1236 globs->last16Bit = conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1237 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1238 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1239 conv16.s = globs->last16Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1240 conv16.s >>= (16 - (ByteOffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1241 conv16.s &= (USHORT) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1242 number = (ULONG) conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1243 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1244 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1245 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1246 if (globs->lastbytepos32 != globs->bytepos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1247 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1248 conv32.c[MSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1249 conv32.c[MSW_POS + LSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1250 conv32.c[LSW_POS + MSB_POS] = *MsgBuf++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1251 conv32.c[LSW_POS + LSB_POS] = *MsgBuf;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1252 globs->lastbytepos32 = globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1253 globs->last32Bit = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1254 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1255 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1256 conv32.l = globs->last32Bit;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1257 conv32.l >>= (32 - (ByteOffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1258 conv32.l &= ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1259 number = conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1260 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1261
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1262 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1263
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1264 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1265 TRACE_CCD (globs, " (%08X)", number);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1266 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1267
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1268 return number;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1269 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1270 #endif /* !RUN_INT_RAM */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1271
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1272 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1273 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1274 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1275 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1276 \| STATE : code ROUTINE : bf_decodeShortNumber\|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1277 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1278
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1279 PURPOSE : reads (len) Bits from the Bitsream (globs->bitbuf) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1280 returns the resulting value as an ULONG.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1281 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1282
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1283 ULONG bf_decodeShortNumber (const ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1284 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1285 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1286 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1287
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1288 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1289
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1290 conv32.c[MSW_POS + MSB_POS] = *p++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1291 conv32.c[MSW_POS + LSB_POS] = *p++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1292 conv32.c[LSW_POS + MSB_POS] = *p++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1293 conv32.c[LSW_POS + LSB_POS] = *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1294 conv32.l >>= (32 - (globs->byteoffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1295 conv32.l &= ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1296 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1297 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1298 TRACE_CCD (globs, "reading %d bits as LONG (%d) at byte %d.%d", len, (ULONG) conv32.l, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1299 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1300 return (ULONG) conv32.l;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1301 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1302 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1303
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1304 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1305 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1306 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1307 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1308 \| STATE : code ROUTINE : bf_decodeByteNumber \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1309 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1310
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1311 PURPOSE : reads (len) Bits from the Bitsream (globs->bitbuf) and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1312 returns the resulting value as an UBYTE.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1313 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1314
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1315 UBYTE bf_decodeByteNumber (const ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1316 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1317 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1318 t_conv16 conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1319
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1320 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1321
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1322 conv16.c[MSB_POS] = *p++;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1323 conv16.c[LSB_POS] = *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1324 conv16.s >>= (16 - (globs->byteoffs + len));
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1325 conv16.s &= (USHORT) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1326 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1327 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1328 TRACE_CCD (globs, "reading %d bits as BYTE (%d) at byte %d.%d", len, (UBYTE) conv16.s, globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1329 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1330 return (UBYTE) conv16.s;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1331 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1332 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1333
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1334 #ifndef RUN_INT_RAM
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1335 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1336 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1337 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1338 \| STATE : code ROUTINE : bf_codeShortNumber \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1339 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1340
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1341 PURPOSE : Converts the value (val) into a MSB/LSB-Bitstring and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1342 writes it to the aktual position into the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1343 globs->bitbuf. The maximum value of (len) is 16.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1344 If the value of (val) is greater then (2^len)-1 it
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1345 will be truncated.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1346 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1347
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1348 void bf_codeShortNumber (UBYTE len, USHORT val, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1349 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1350 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1351 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1352
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1353 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1354 TRACE_CCD (globs, "codeShortNumber: writing %d bits (.%s) at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1355 len, ccd_BITIMAGE (val, (ULONG) len, globs), globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1356 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1357 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1358 conv32.l = (ULONG) val;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1359 conv32.l <<= (32 - len - globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1360 *p++ \|= conv32.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1361 *p = conv32.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1362 if ((globs->byteoffs + len) > 16)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1363 *++p = conv32.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1364 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1365 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1366 #endif /* !RUN_INT_RAM */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1367
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1368 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1369 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1370 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1371 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1372 \| STATE : code ROUTINE : bf_recodeShortNumber\|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1373 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1374
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1375 PURPOSE: Converts the value (val) into a MSB/LSB-Bitstring and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1376 writes it at the position (pos) into the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1377 globs->bitbuf. The rest of the bitstream and the actual
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1378 position will not changed. The maximum value of (len)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1379 is 16.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1380 If the value of (val) is greater then (2^len)-1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1381 it will be truncated.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1382 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1383
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1384 void bf_recodeShortNumber (USHORT pos, UBYTE len, USHORT val, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1385 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1386 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1387 USHORT oldbitpos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1388 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1389 USHORT wBits;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1390
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1391 oldbitpos = globs->bitpos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1392 bf_setBitpos (pos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1393 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1394 TRACE_CCD (globs, "bf_recodeShortNumber:rewriting %d bits (.%s) at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1395 len, ccd_BITIMAGE ((ULONG) val, len, globs), globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1396 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1397 wBits = len + globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1398 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1399 conv32.l = (ULONG) val;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1400 conv32.l <<= (32 - wBits);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1401
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1402 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1403 * Since the bits to write are cleared (memclr) in the bitstream,
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1404 * it is ok to perform an OR operation on them.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1405 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1406 *p++ \|= conv32.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1407 if (wBits > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1408 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1409 *p++ \|= conv32.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1410 if (wBits > 16)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1411 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1412 *p++ \|= conv32.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1413 if (wBits > 24)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1414 *p \|= conv32.c[LSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1415 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1416 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1417
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1418 bf_setBitpos (oldbitpos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1419 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1420 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1421
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1422 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1423 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1424 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1425 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1426 \| STATE : code ROUTINE : bf_recodeByteNumber \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1427 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1428
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1429 PURPOSE: Converts the value (val) into a MSB/LSB-Bitstring and
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1430 writes it at the position (pos) into the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1431 globs->bitbuf. The rest of the bitstream and the actual
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1432 position will not changed. The maximum value of (len)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1433 is 8.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1434 If the value of (val) is greater then (2^len)-1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1435 it will be truncated.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1436 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1437
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1438 void bf_recodeByteNumber (USHORT pos, UBYTE len, UBYTE val, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1439 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1440 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1441 USHORT oldbitpos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1442 t_conv16 conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1443
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1444 oldbitpos = globs->bitpos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1445 bf_setBitpos (pos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1446 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1447 TRACE_CCD (globs, "bf_recodeByteNumber:rewriting %d bits (.%s) at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1448 len, ccd_BITIMAGE ((ULONG) val, len, globs), globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1449 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1450 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1451 conv16.s = (USHORT) val;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1452 conv16.s <<= (16 - len - globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1453 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1454 * if the bits to write are cleared (memclr) in the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1455 * we can perform an OR operation on it
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1456 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1457 *p++ \|= conv16.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1458 if ((len + globs->byteoffs) > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1459 *p \|= conv16.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1460
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1461 bf_setBitpos (oldbitpos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1462 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1463 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1464
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1465 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1466 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1467 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1468 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1469 \| STATE : code ROUTINE : bf_recodeBit \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1470 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1471
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1472 PURPOSE: Writes the value of (Bit) at the position (pos)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1473 into the bitstream globs->bitbuf. The rest of the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1474 and the actual position will not changed.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1475 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1476
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1477 void bf_recodeBit (USHORT pos, UBYTE Bit, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1478 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1479 U16 oldbitpos = globs->bitpos;;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1480
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1481 bf_setBitpos (pos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1482 globs->bitbuf[globs->bytepos] = Bit ? (globs->bitbuf[globs->bytepos] \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1483 ccd_bitfun_shift[globs->byteoffs])
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1484 : (globs->bitbuf[globs->bytepos] &
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1485 ~ccd_bitfun_shift[globs->byteoffs]);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1486 bf_setBitpos (oldbitpos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1487 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1488 TRACE_CCD (globs, "recode 1 bit (.%d) at bitpos %d", Bit, pos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1489 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1490 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1491 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1492
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1493 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1494 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1495 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1496 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1497 \| STATE : code ROUTINE : bf_codeByteNumber \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1498 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1499
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1500 PURPOSE: Converts the value (val) into a Bitstring with the
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1501 length (len) and writes it at the actual position
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1502 into the bitstream globs->bitbuf. The maximum value of
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1503 (len) is 8.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1504 If the value is greater then (2^len)-1 it will be
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1505 truncated.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1506
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1507 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1508
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1509 void bf_codeByteNumber (UBYTE len, UBYTE val, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1510 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1511 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1512 t_conv16 conv16;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1513
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1514 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1515 TRACE_CCD (globs, "codeByteNumber:writing %d bits (.%s) at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1516 len, ccd_BITIMAGE (val, (ULONG) len, globs), globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1517 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1518 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1519
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1520 conv16.s = (USHORT) val;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1521 conv16.s <<= (16 - len - globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1522 *p++ \|= conv16.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1523 if ((globs->byteoffs + len) > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1524 *p \|= conv16.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1525 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1526 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1527 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1528
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1529 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1530 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1531 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1532 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1533 \| STATE : code ROUTINE : bf_codeLongNumber \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1534 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1535
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1536 PURPOSE : This funtion writes the numeric content of
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1537 the var to the aktual position into the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1538 referenced by globs->bitbuf.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1539 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1540
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1541 void bf_codeLongNumber (UBYTE len, ULONG val, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1542 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1543 UBYTE wBits = len + globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1544 U8 MsgBuf = (U8)(globs->bitbuf + globs->bytepos);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1545
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1546 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1547 TRACE_CCD (globs, "codeLongNumber: writing %d bits (.%s) at byte %d.%d",
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1548 len, ccd_BITIMAGE (val, (ULONG) len, globs), globs->bytepos, globs->byteoffs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1549 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1550
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1551 if (len > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1552 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1553 t_conv32 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1554
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1555 conv.l = val;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1556 conv.l &= ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1557 conv.l <<= (32 - wBits);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1558 MsgBuf[0] \|= conv.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1559 MsgBuf[1] = conv.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1560 if (wBits > 16)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1561 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1562 MsgBuf[2] = conv.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1563 if (wBits > 24)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1564 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1565 MsgBuf[3] = conv.c[LSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1566 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1567 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1568 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1569 else
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1570 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1571 t_conv16 conv;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1572
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1573 conv.s = (USHORT) val;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1574 conv.s &= (USHORT) ccd_bitfun_mask[len];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1575 conv.s <<= (16 - wBits);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1576 MsgBuf[0] \|= conv.c[MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1577 if (wBits > 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1578 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1579 MsgBuf[1] = conv.c[LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1580 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1581 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1582
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1583 bf_incBitpos (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1584 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1585 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1586
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1587 #if 0 /* not used - maybe for the future */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1588 #ifndef RUN_FLASH
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1589 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1590 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1591 \| PROJECT : CCD (6144) MODULE : BITFUN \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1592 \| STATE : code ROUTINE : bf_swapBits \|
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1593 +--------------------------------------------------------------------+
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1594
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1595 PURPOSE : reads (len) Bits from the Bitsream (1-8) and swap
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1596 this part with the next (len) bits in the bitstream.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1597 The read/write pointer of the bitstream left unchanged.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1598 This function is used for swapping the nibbles in some
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1599 ugly coded GSM messages.
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1600 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1601
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1602 void bf_swapBits (ULONG len, T_CCD_Globs *globs)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1603 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1604 UBYTE s1, s2;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1605 USHORT s21;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1606 USHORT startpos = globs->bitpos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1607 UBYTE *p;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1608 t_conv32 conv32;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1609
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1610 if (len > 0 AND len <= 8)
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1611 {
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1612 #ifdef DEBUG_CCD
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1613 TRACE_CCD (globs, "swapping %d bits", len);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1614 #endif
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1615
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1616 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1617 * read bitstring#1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1618 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1619 s1 = bf_decodeByteNumber (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1620 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1621 * read bitstring#2
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1622 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1623 s2 = bf_decodeByteNumber (len, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1624 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1625 * concat bitstring#2 and bitstring#1
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1626 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1627 s21 = (USHORT) s2 <<len;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1628 s21 \|= s1;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1629
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1630 /*
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1631 * recode it into the bitstream
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1632 */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1633 bf_setBitpos (startpos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1634 p = globs->bitbuf + globs->bytepos;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1635 conv32.l = (ULONG) s21;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1636 conv32.l <<= (32 - len) - globs->byteoffs;
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1637 *p++ \|= conv32.c[MSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1638 *p++ \|= conv32.c[MSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1639 *p++ \|= conv32.c[LSW_POS + MSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1640 *p \|= conv32.c[LSW_POS + LSB_POS];
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1641
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1642 bf_setBitpos (startpos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1643 bf_recodeShortNumber (startpos, (UBYTE) (len<<1), s21, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1644 bf_setBitpos (startpos, globs);
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1645 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1646 }
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1647
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1648 #endif /* !RUN_FLASH */
c41a534f33c6 src/gpf3: preened GPF goo from TCS3.2 Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1649 #endif

FreeCalypso > hg > fc-magnetite

annotate src/gpf3/ccd/bitfun.c @ 662:8cd8fd15a095