fc-selenite: src/gpf/ccd/bitfun.c annotate

annotate src/gpf/ccd/bitfun.c @ 134:7d50d8d13711

FFS code sync with Magnetite + gcc version fix This change brings the new flash autodetection for FC and Pirelli targets from Magnetite, and should also fix the gcc version for C1xx and gtamodem targets, which were previously broken because they used TI's original flash autodetect code (which operates at address 0) while the boot ROM is mapped there.

author	Mychaela Falconia <falcon@freecalypso.org>
date	Tue, 11 Dec 2018 08:43:25 +0000
parents	1ea54a97e831
children

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

FreeCalypso > hg > fc-selenite

annotate src/gpf/ccd/bitfun.c @ 134:7d50d8d13711