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

annotate src/gpf3/ccd/bitfun.c @ 365:f8ad9dcadde0

RV timing: better RVF_MS_TO_TICKS() formula

author	Mychaela Falconia <falcon@freecalypso.org>
date	Sun, 31 Dec 2017 06:32:33 +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 @ 365:f8ad9dcadde0