OpenCores
URL https://opencores.org/ocsvn/mb-jpeg/mb-jpeg/trunk

Subversion Repositories mb-jpeg

[/] [mb-jpeg/] [tags/] [STEP2_2b/] [bmp2jpg_mb/] [huffman.c] - Blame information for rev 68

Go to most recent revision | Details | Compare with Previous | View Log

Line No. Rev Author Line
1 37 quickwayne
#pragma argsused
2
/*
3
Only encoder
4
This version works correctly, it is tested with testcase.jpg
5
The translation into real huffman codes works.
6
Changed: If huffman wants to send 0xFFxx (FF in one byte) than there must be 0x00 inserted between FF and xx
7
possible fault in finish send:
8
-must it be filled up with zeros?          YES
9
-must it be filled up to one bye? or 2 byte? --> in this code there is filled up to 2 bytes, but I (joris) thinks this must be filled up to 1 byte.
10
 still dont know
11
- 24-11-05 code clean up
12
- 24-11-05 tables added for color
13
 
14
 
15
 
16
Block numbers:
17
Y = 0
18
cb =1
19
cr= 2
20
*/
21
//---------------------------------------------------------------------------
22
#include <stdio.h>
23
 
24
static unsigned int vlc_remaining;
25
static unsigned char vlc_amount_remaining;
26
static unsigned char dcvalue[4];   // 3 is enough
27
 
28
int vlc_init_start() {
29
 
30
       vlc_remaining=0x00;
31
       vlc_amount_remaining=0x00;
32
        memset(dcvalue, 0, 4);
33
        return 0;
34
 
35
}
36
 
37
#define vlc_output_byte(c)             put_char(c)
38
 
39
#ifdef __MULTI_TASK
40
 
41
void vlc_task() {
42
 
43
 
44
}
45
 
46
#endif
47
 
48
#ifdef __MULTI_PROCESSOR
49
 
50
int main() {
51
 
52
        for (;;) {
53
 
54
 
55
                }
56
 
57
}
58
 
59
#endif
60
 
61 39 quickwayne
static unsigned char convertDCMagnitudeCLengthTable[16] = {
62
  0x02, 0x02, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
63
  0x08, 0x09, 0x0a, 0x0b, 0x00, 0x00, 0x00, 0x00
64
};
65
 
66
static unsigned short convertDCMagnitudeCOutTable[16] = {
67
        0x0000, 0x0001, 0x0002, 0x0006, 0x000e, 0x001e, 0x003e, 0x007e,
68
        0x00fe, 0x01fe, 0x03fe, 0x07fe, 0x0000, 0x0000, 0x0000, 0x0000
69
};
70
 
71 37 quickwayne
void ConvertDCMagnitudeC(unsigned char magnitude,unsigned short int *out, unsigned short int *lenght)
72
{
73 39 quickwayne
        unsigned char len;
74
 
75
        if ((magnitude>16) || ((len=convertDCMagnitudeCLengthTable[magnitude])==0)) {
76
#ifndef __MICROBLAZE
77
                printf("WAARDE STAAT NIET IN TABEL!!!!!!!!!!!!!!!!!!!!\n");
78
#endif
79
                }
80
        *lenght = len;
81
        *out = convertDCMagnitudeCOutTable[magnitude];
82
 
83
#if 0   
84 37 quickwayne
        switch (magnitude) {
85
                case 0x00 : *out=0x0000; *lenght=2; break;
86
                case 0x01 : *out=0x0001; *lenght=2; break;
87
                case 0x02 : *out=0x0002; *lenght=2; break;
88
                case 0x03 : *out=0x0006; *lenght=3; break;
89
                case 0x04 : *out=0x000e; *lenght=4; break;
90
                case 0x05 : *out=0x001e; *lenght=5; break;
91
                case 0x06 : *out=0x003e; *lenght=6; break;
92
                case 0x07 : *out=0x007e; *lenght=7; break;
93
                case 0x08 : *out=0x00fe; *lenght=8; break;
94
                case 0x09 : *out=0x01fe; *lenght=9; break;
95
                case 0x0a : *out=0x03fe; *lenght=10; break;
96
                case 0x0b : *out=0x07fe; *lenght=11; break;
97
        }
98 39 quickwayne
#endif
99
 
100 37 quickwayne
}
101
 
102 39 quickwayne
static unsigned char convertACMagnitudeCLengthTable[256] = {
103
0x02, 0x02, 0x03, 0x04, 0x05, 0x05, 0x06, 0x07, 0x09, 0x0a, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00,    // 00 - 0f
104
0x00, 0x04, 0x06, 0x08, 0x09, 0x0b, 0x0c, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 10 - 1f
105
0x00, 0x05, 0x08, 0x0a, 0x0c, 0x0f, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 20 - 2f
106
0x00, 0x05, 0x08, 0x0a, 0x0c, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 30 - 3f
107
0x00, 0x06, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 40 - 4f
108
0x00, 0x06, 0x0a, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 50 - 5f
109
0x00, 0x07, 0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 60 - 6f
110
0x00, 0x07, 0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 70 - 7f
111
0x00, 0x08, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 80 - 8f
112
0x00, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 90 - 9f
113
0x00, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // a0 - af
114
0x00, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // b0 - bf
115
0x00, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // c0 - cf
116
0x00, 0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // d0 - df
117
0x00, 0x0e, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // e0 - ef
118
0x0a, 0x0f, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00
119
};
120
 
121
static unsigned short convertACMagnitudeCOutTable[256] = {
122
0x0000, 0x0001, 0x0004, 0x000a, 0x0018, 0x0019, 0x0038, 0x0078, 0x01f4, 0x03f6, 0x0ff4, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 00 - 0f
123
0x0000, 0x000b, 0x0039, 0x00f6, 0x01f5, 0x07f6, 0x0ff5, 0xff88, 0xff89, 0xff8a, 0xff8b, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 10 - 1f
124
0x0000, 0x001a, 0x00f7, 0x03f7, 0x0ff6, 0x7fc2, 0xff8c, 0xff8d, 0xff8e, 0xff8f, 0xff90, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 20 - 2f
125
0x0000, 0x001b, 0x00f8, 0x03f8, 0x0ff7, 0xff91, 0xff92, 0xff93, 0xff94, 0xff95, 0xff96, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 30 - 3f
126
0x0000, 0x003a, 0x01f6, 0xff97, 0xff98, 0xff99, 0xff9a, 0xff9b, 0xff9c, 0xff9d, 0xff9e, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 40 - 4f
127
0x0000, 0x003b, 0x03f9, 0xff9f, 0xffa0, 0xffa1, 0xFFA2, 0xFFA3, 0xFFA4, 0xFFA5, 0xFFA6, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 50 - 5f
128
0x0000, 0x0079, 0x07f7, 0xffa7, 0xffa8, 0xffa9, 0xffaa, 0xffab, 0xFFAc, 0xFFAf, 0xFFAe, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 60 - 6f
129
0x0000, 0x007a, 0x07f8, 0xffaf, 0xffb0, 0xFFB1, 0xFFB2, 0xFFB3, 0xFFB4, 0xFFB5, 0xFFB6, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 70 - 7f
130
0x0000, 0x00f9, 0xffb7, 0xFFB8, 0xFFB9, 0xFFBa, 0xFFBb, 0xFFBc, 0xFFBd, 0xFFBe, 0xFFBf, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 80 - 8f
131
0x0000, 0x01f7, 0xffc0, 0xffc1, 0xFFC2, 0xFFC3, 0xFFC4, 0xFFC5, 0xFFC6, 0xFFC7, 0xFFC8, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 90 - 9f
132
0x0000, 0x01f8, 0xffc9, 0xFFCa, 0xFFCb, 0xFFCc, 0xFFCd, 0xFFCe, 0xFFCf, 0xFFd0, 0xFFd1, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // a0 - af
133
0x0000, 0x01f9, 0xFFD2, 0xFFD3, 0xFFD4, 0xFFD5, 0xFFD6, 0xFFD7, 0xFFD8, 0xFFD9, 0xFFDa, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // b0 - bf
134
0x0000, 0x01fa, 0xFFDb, 0xFFDc, 0xFFDd, 0xFFDe, 0xFFDf, 0xFFe0, 0xFFe1, 0xFFe2, 0xFFe3, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // c0 - cf
135
0x0000, 0x07f9, 0xFFE4, 0xFFE5, 0xFFE6, 0xFFE7, 0xFFE8, 0xFFE9, 0xFFEa, 0xFFEb, 0xFFEc, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // d0 - df
136
0x0000, 0x3fe0, 0xffed, 0xFFEe, 0xFFEf, 0xFFf0, 0xFFF1, 0xFFF2, 0xFFF3, 0xFFF4, 0xFFF5, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // e0 - ef
137
0x03fa, 0x7fc3, 0xFFF6, 0xFFF7, 0xFFF8, 0xFFF9, 0xFFFA, 0xFFFB, 0xFFFC, 0xFFFD, 0xFFFE, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
138
};
139
 
140 37 quickwayne
//===========================================================================
141
void ConvertACMagnitudeC(unsigned char magnitude,unsigned short int *out, unsigned short int *lenght)
142
{
143 39 quickwayne
        unsigned char len;
144
 
145
        len = convertACMagnitudeCLengthTable[magnitude];
146
        if (!len) {
147
#ifndef __MICROBLAZE
148
                printf("WAARDE STAAT NIET IN TABEL!!!!!!!!!!!!!!!!!!!!\n");
149
#endif
150
                }
151
        *lenght = len;
152
        *out = convertACMagnitudeCOutTable[magnitude];
153
 
154
#if 0
155 37 quickwayne
        switch (magnitude) {
156
case 0x00 :  *lenght=0x02; *out=0x0000; break; //1010
157
case 0x01 :  *lenght=0x02; *out=0x0001; break; //00
158
case 0x02 :  *lenght=0x03; *out=0x0004; break; //01
159
case 0x03 :  *lenght=0x04; *out=0x000a; break; //100
160
case 0x04 :  *lenght=0x05; *out=0x0018; break; //1011
161
case 0x05 :  *lenght=0x05; *out=0x0019; break; //11010
162
case 0x06 :  *lenght=0x06; *out=0x0038; break; //1111000
163
case 0x07 :  *lenght=0x07; *out=0x0078; break; //11111000
164
case 0x08 :  *lenght=0x09; *out=0x01f4; break; //1111110110
165
case 0x09 :  *lenght=0x0a; *out=0x03f6; break; //1111111110000010
166
case 0x0A :  *lenght=0x0c; *out=0x0ff4; break; //1111111110000011
167
case 0x11 :  *lenght=0x04; *out=0x000b; break; //1100
168
case 0x12 :  *lenght=0x06; *out=0x0039; break; //11011
169
case 0x13 :  *lenght=0x08; *out=0x00f6; break; //1111001
170
case 0x14 :  *lenght=0x09; *out=0x01f5; break; //111110110
171
case 0x15 :  *lenght=0x0b; *out=0x07f6; break; //11111110110
172
case 0x16 :  *lenght=0x0c; *out=0x0ff5; break; //1111111110000100
173
case 0x17 :  *lenght=0x10; *out=0xff88; break; //1111111110000101
174
case 0x18 :  *lenght=0x10; *out=0xff89; break; //1111111110000110
175
case 0x19 :  *lenght=0x10; *out=0xff8a; break; //1111111110000111
176
case 0x1A :  *lenght=0x10; *out=0xff8b; break; //1111111110001000
177
case 0x21 :  *lenght=0x05; *out=0x001a; break; //11100
178
case 0x22 :  *lenght=0x08; *out=0x00f7; break; //11111001
179
case 0x23 :  *lenght=0x0a; *out=0x03f7; break; //1111110111
180
case 0x24 :  *lenght=0x0c; *out=0x0ff6; break; //111111110100
181
case 0x25 :  *lenght=0x0f; *out=0x7fc2; break; //1111111110001001
182
case 0x26 :  *lenght=0x10; *out=0xff8c; break; //1111111110001010
183
case 0x27 :  *lenght=0x10; *out=0xff8d; break; //1111111110001011
184
case 0x28 :  *lenght=0x10; *out=0xff8e; break; //1111111110001100
185
case 0x29 :  *lenght=0x10; *out=0xff8f; break; //1111111110001101
186
case 0x2A :  *lenght=0x10; *out=0xff90; break; //1111111110001110
187
case 0x31 :  *lenght=0x05; *out=0x001b; break; //111010
188
case 0x32 :  *lenght=0x08; *out=0x00f8; break; //111110111
189
case 0x33 :  *lenght=0x0a; *out=0x03f8; break; //111111110101
190
case 0x34 :  *lenght=0x0c; *out=0x0ff7; break; //1111111110001111
191
case 0x35 :  *lenght=0x10; *out=0xff91; break; //1111111110010000
192
case 0x36 :  *lenght=0x10; *out=0xff92; break; //1111111110010001
193
case 0x37 :  *lenght=0x10; *out=0xff93; break; //1111111110010010
194
case 0x38 :  *lenght=0x10; *out=0xff94; break; //1111111110010011
195
case 0x39 :  *lenght=0x10; *out=0xff95; break; //1111111110010100
196
case 0x3A :  *lenght=0x10; *out=0xff96; break; //1111111110010101
197
case 0x41 :  *lenght=0x06; *out=0x003a; break; //111011
198
case 0x42 :  *lenght=0x09; *out=0x01f6; break; //1111111000
199
case 0x43 :  *lenght=0x10; *out=0xff97; break; //1111111110010110
200
case 0x44 :  *lenght=0x10; *out=0xff98; break; //1111111110010111
201
case 0x45 :  *lenght=0x10; *out=0xff99; break; //1111111110011000
202
case 0x46 :  *lenght=0x10; *out=0xff9a; break; //1111111110011001
203
case 0x47 :  *lenght=0x10; *out=0xff9b; break; //1111111110011010
204
case 0x48 :  *lenght=0x10; *out=0xff9c; break; //1111111110011011
205
case 0x49 :  *lenght=0x10; *out=0xff9d; break; //1111111110011100
206
case 0x4A :  *lenght=0x10; *out=0xff9e; break; //1111111110011101
207
case 0x51 :  *lenght=0x06; *out=0x003b; break; //1111010
208
case 0x52 :  *lenght=0x0a; *out=0x03f9; break; //11111110111
209
case 0x53 :  *lenght=0x10; *out=0xff9f; break; //1111111110011110
210
case 0x54 :  *lenght=0x10; *out=0xffa0; break; //1111111110011111
211
case 0x55 :  *lenght=0x10; *out=0xffa1; break; //1111111110100000
212
case 0x56 :  *lenght=0x10; *out=0xFFA2; break; //1111111110100001
213
case 0x57 :  *lenght=0x10; *out=0xFFA3; break; //1111111110100010
214
case 0x58 :  *lenght=0x10; *out=0xFFA4; break; //1111111110100011
215
case 0x59 :  *lenght=0x10; *out=0xFFA5; break; //1111111110100100
216
case 0x5A :  *lenght=0x10; *out=0xFFA6; break; //1111111110100101
217
case 0x61 :  *lenght=0x07; *out=0x0079; break; //1111011
218
case 0x62 :  *lenght=0x0b; *out=0x07f7; break; //111111110110
219
case 0x63 :  *lenght=0x10; *out=0xffa7; break; //1111111110100110
220
case 0x64 :  *lenght=0x10; *out=0xffa8; break; //1111111110100111
221
case 0x65 :  *lenght=0x10; *out=0xffa9; break; //1111111110101000
222
case 0x66 :  *lenght=0x10; *out=0xffaa; break; //1111111110101001
223
case 0x67 :  *lenght=0x10; *out=0xffab; break; //1111111110101010
224
case 0x68 :  *lenght=0x10; *out=0xFFAc; break; //1111111110101011
225
case 0x69 :  *lenght=0x10; *out=0xFFAf; break; //1111111110101100
226
case 0x6A :  *lenght=0x10; *out=0xFFAe; break; //1111111110101101
227
case 0x71 :  *lenght=0x07; *out=0x007a; break; //11111010
228
case 0x72 :  *lenght=0x0b; *out=0x07f8; break; //111111110111
229
case 0x73 :  *lenght=0x10; *out=0xffaf; break; //1111111110101110
230
case 0x74 :  *lenght=0x10; *out=0xffb0; break; //1111111110101111
231
case 0x75 :  *lenght=0x10; *out=0xFFB1; break; //1111111110110000
232
case 0x76 :  *lenght=0x10; *out=0xFFB2; break; //111111110110001
233
case 0x77 :  *lenght=0x10; *out=0xFFB3; break; //111111110110010
234
case 0x78 :  *lenght=0x10; *out=0xFFB4; break; //111111110110011
235
case 0x79 :  *lenght=0x10; *out=0xFFB5; break; //1111111110110100
236
case 0x7A :  *lenght=0x10; *out=0xFFB6; break; //1111111110110101
237
case 0x81 :  *lenght=0x08; *out=0x00f9; break; //111111000
238
case 0x82 :  *lenght=0x10; *out=0xffb7; break; //111111111000000
239
case 0x83 :  *lenght=0x10; *out=0xFFB8; break; //1111111110110110
240
case 0x84 :  *lenght=0x10; *out=0xFFB9; break; //1111111110110111
241
case 0x85 :  *lenght=0x10; *out=0xFFBa; break; //1111111110111000
242
case 0x86 :  *lenght=0x10; *out=0xFFBb; break; //1111111110111001
243
case 0x87 :  *lenght=0x10; *out=0xFFBc; break; //1111111110111010
244
case 0x88 :  *lenght=0x10; *out=0xFFBd; break; //1111111110111011
245
case 0x89 :  *lenght=0x10; *out=0xFFBe; break; //1111111110111100
246
case 0x8A :  *lenght=0x10; *out=0xFFBf; break; //1111111110111101
247
case 0x91 :  *lenght=0x09; *out=0x01f7; break; //111111001
248
case 0x92 :  *lenght=0x10; *out=0xffc0; break; //1111111110111110
249
case 0x93 :  *lenght=0x10; *out=0xffc1; break; //1111111110111111
250
case 0x94 :  *lenght=0x10; *out=0xFFC2; break; //1111111111000000
251
case 0x95 :  *lenght=0x10; *out=0xFFC3; break; //1111111111000001
252
case 0x96 :  *lenght=0x10; *out=0xFFC4; break; //1111111111000010
253
case 0x97 :  *lenght=0x10; *out=0xFFC5; break; //1111111111000011
254
case 0x98 :  *lenght=0x10; *out=0xFFC6; break; //1111111111000100
255
case 0x99 :  *lenght=0x10; *out=0xFFC7; break; //1111111111000101
256
case 0x9A :  *lenght=0x10; *out=0xFFC8; break; //1111111111000110
257
case 0xA1 :  *lenght=0x09; *out=0x01f8; break; //111111010
258
case 0xA2 :  *lenght=0x10; *out=0xffc9; break; //1111111111000111
259
case 0xA3 :  *lenght=0x10; *out=0xFFCa; break; //1111111111001000
260
case 0xA4 :  *lenght=0x10; *out=0xFFCb; break; //1111111111001001
261
case 0xA5 :  *lenght=0x10; *out=0xFFCc; break; //1111111111001010
262
case 0xA6 :  *lenght=0x10; *out=0xFFCd; break; //1111111111001011
263
case 0xA7 :  *lenght=0x10; *out=0xFFCe; break; //1111111111001100
264
case 0xA8 :  *lenght=0x10; *out=0xFFCf; break; //1111111111001101
265
case 0xA9 :  *lenght=0x10; *out=0xFFd0; break; //1111111111001110
266
case 0xAA :  *lenght=0x10; *out=0xFFd1; break; //1111111111001111
267
case 0xB1 :  *lenght=0x09; *out=0x01f9; break; //1111111001
268
case 0xB2 :  *lenght=0x10; *out=0xFFD2; break; //1111111111010000
269
case 0xB3 :  *lenght=0x10; *out=0xFFD3; break; //1111111111010001
270
case 0xB4 :  *lenght=0x10; *out=0xFFD4; break; //1111111111010010
271
case 0xB5 :  *lenght=0x10; *out=0xFFD5; break; //1111111111010011
272
case 0xB6 :  *lenght=0x10; *out=0xFFD6; break; //1111111111010100
273
case 0xB7 :  *lenght=0x10; *out=0xFFD7; break; //1111111111010101
274
case 0xB8 :  *lenght=0x10; *out=0xFFD8; break; //1111111111010110
275
case 0xB9 :  *lenght=0x10; *out=0xFFD9; break; //1111111111010111
276
case 0xBA :  *lenght=0x10; *out=0xFFDa; break; //1111111111011000
277
case 0xC1 :  *lenght=0x09; *out=0x01fa; break; //1111111010
278
case 0xC2 :  *lenght=0x10; *out=0xFFDb; break; //1111111111011001
279
case 0xC3 :  *lenght=0x10; *out=0xFFDc; break; //1111111111011010
280
case 0xC4 :  *lenght=0x10; *out=0xFFDd; break; //1111111111011011
281
case 0xC5 :  *lenght=0x10; *out=0xFFDe; break; //1111111111011100
282
case 0xC6 :  *lenght=0x10; *out=0xFFDf; break; //1111111111011101
283
case 0xC7 :  *lenght=0x10; *out=0xFFe0; break; //1111111111011110
284
case 0xC8 :  *lenght=0x10; *out=0xFFe1; break; //1111111111011111
285
case 0xC9 :  *lenght=0x10; *out=0xFFe2; break; //1111111111100000
286
case 0xCA :  *lenght=0x10; *out=0xFFe3; break; //1111111111100001
287
case 0xD1 :  *lenght=0x0b; *out=0x07f9; break; //11111111000
288
case 0xD2 :  *lenght=0x10; *out=0xFFE4; break; //1111111111100010
289
case 0xD3 :  *lenght=0x10; *out=0xFFE5; break; //1111111111100011
290
case 0xD4 :  *lenght=0x10; *out=0xFFE6; break; //1111111111100100
291
case 0xD5 :  *lenght=0x10; *out=0xFFE7; break; //1111111111100101
292
case 0xD6 :  *lenght=0x10; *out=0xFFE8; break; //1111111111100110
293
case 0xD7 :  *lenght=0x10; *out=0xFFE9; break; //1111111111100111
294
case 0xD8 :  *lenght=0x10; *out=0xFFEa; break; //1111111111101000
295
case 0xD9 :  *lenght=0x10; *out=0xFFEb; break; //1111111111101001
296
case 0xDA :  *lenght=0x10; *out=0xFFEc; break; //1111111111101010
297
case 0xE1 :  *lenght=0x0e; *out=0x3fe0; break; //1111111111101011
298
case 0xE2 :  *lenght=0x10; *out=0xffed; break; //1111111111101100
299
case 0xE3 :  *lenght=0x10; *out=0xFFEe; break; //1111111111101101
300
case 0xE4 :  *lenght=0x10; *out=0xFFEf; break; //1111111111101110
301
case 0xE5 :  *lenght=0x10; *out=0xFFf0; break; //1111111111101111
302
case 0xE6 :  *lenght=0x10; *out=0xFFF1; break; //1111111111110000
303
case 0xE7 :  *lenght=0x10; *out=0xFFF2; break; //1111111111110001
304
case 0xE8 :  *lenght=0x10; *out=0xFFF3; break; //1111111111110010
305
case 0xE9 :  *lenght=0x10; *out=0xFFF4; break; //1111111111110011
306
case 0xEA :  *lenght=0x10; *out=0xFFF5; break; //1111111111110100
307
case 0xF0 :  *lenght=0x0a; *out=0x03fa; break; //11111111001
308
case 0xF1 :  *lenght=0x0f; *out=0x7fc3; break; //1111111111110101
309
case 0xF2 :  *lenght=0x10; *out=0xFFF6; break; //1111111111110110
310
case 0xF3 :  *lenght=0x10; *out=0xFFF7; break; //1111111111110111
311
case 0xF4 :  *lenght=0x10; *out=0xFFF8; break; //1111111111111000
312
case 0xF5 :  *lenght=0x10; *out=0xFFF9; break; //1111111111111001
313
case 0xF6 :  *lenght=0x10; *out=0xFFFA; break; //1111111111111010
314
case 0xF7 :  *lenght=0x10; *out=0xFFFB; break; //1111111111111011
315
case 0xF8 :  *lenght=0x10; *out=0xFFFC; break; //1111111111111100
316
case 0xF9 :  *lenght=0x10; *out=0xFFFD; break; //1111111111111101
317
case 0xFA :  *lenght=0x10; *out=0xFFFE; break; //1111111111111110
318
#ifndef __MICROBLAZE
319
default : printf("WAARDE STAAT NIET IN TABEL!!!!!!!!!!!!!!!!!!!!\n");break;
320
#endif
321
        }
322
  //      printf("magnitude= %x out= %x lenght= %d \n",magnitude,*out,*lenght);
323
        return;
324 39 quickwayne
#endif
325
 
326
 
327 37 quickwayne
}
328 39 quickwayne
 
329
static unsigned char convertDCMagnitudeYLengthTable[16] = {
330
0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x04, 0x05,
331
0x06, 0x07, 0x08, 0x09, 0x00, 0x00, 0x00, 0x00
332
};
333
 
334
static unsigned short convertDCMagnitudeYOutTable[16] = {
335
0x0000, 0x0002, 0x0003, 0x0004, 0x0005, 0x0006, 0x000e, 0x001e,
336
0x003e, 0x007e, 0x00fe, 0x01fe, 0x0000, 0x0000, 0x0000, 0x0000
337
};
338
 
339 37 quickwayne
//===========================================================================
340
void ConvertDCMagnitudeY(unsigned char magnitude,unsigned short int *out, unsigned short int *lenght)
341
{
342 39 quickwayne
        unsigned char len;
343
 
344
        if ((magnitude>16) || ((len=convertDCMagnitudeYLengthTable[magnitude])==0)) {
345
#ifndef __MICROBLAZE
346
                printf("WAARDE STAAT NIET IN TABEL!!!!!!!!!!!!!!!!!!!!\n");
347
#endif
348
                }
349
        *lenght = len;
350
        *out = convertDCMagnitudeYOutTable[magnitude];
351
#if 0
352 37 quickwayne
        switch (magnitude) {
353
                case 0x00 : *out=0x0000; *lenght=2; break;
354
                case 0x01 : *out=0x0002; *lenght=3; break;
355
                case 0x02 : *out=0x0003; *lenght=3; break;
356
                case 0x03 : *out=0x0004; *lenght=3; break;
357
                case 0x04 : *out=0x0005; *lenght=3; break;
358
                case 0x05 : *out=0x0006; *lenght=3; break;
359
                case 0x06 : *out=0x000e; *lenght=4; break;
360
                case 0x07 : *out=0x001e; *lenght=5; break;
361
                case 0x08 : *out=0x003e; *lenght=6; break;
362
                case 0x09 : *out=0x007e; *lenght=7; break;
363
                case 0x0a : *out=0x00fe; *lenght=8; break;
364
                case 0x0b : *out=0x01fe; *lenght=9; break;
365
        }
366 39 quickwayne
#endif          
367 37 quickwayne
}
368 39 quickwayne
 
369
static unsigned char convertACMagnitudeYLength[256] = {
370
0x04, 0x02, 0x02, 0x03, 0x04, 0x05, 0x07, 0x08, 0x0a, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 00 - 0f
371
0x00, 0x04, 0x05, 0x07, 0x09, 0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 10 - 1f
372
0x00, 0x05, 0x08, 0x0a, 0x0c, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 20 - 2f
373
0x00, 0x06, 0x09, 0x0c, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 30 - 3f
374
0x00, 0x06, 0x0a, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 40 - 4f
375
0x00, 0x07, 0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 50 - 5f
376
0x00, 0x07, 0x0c, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 60 - 6f
377
0x00, 0x08, 0x0c, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 70 - 7f
378
0x00, 0x09, 0x0f, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 80 - 8f
379
0x00, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // 90 - 9f
380
0x00, 0x09, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // a0 - af
381
0x00, 0x0a, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // b0 - bf
382
0x00, 0x0a, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // c0 - cf
383
0x00, 0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // d0 - df
384
0x00, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00,    // e0 - ef
385
0x0b, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00
386
};
387
 
388
static unsigned short convertACMagnitudeYOut[256] = {
389
0xFFFA, 0xFFF0, 0xFFF1, 0xFFF4, 0xFFFB, 0xFFFA, 0xFFF8, 0xFFF8, 0xFFF6, 0xFF82, 0xFF83, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 00 - 0f
390
0x0000, 0xFFFC, 0xFFFB, 0xFFF9, 0xFFF6, 0xFFF6, 0xFF84, 0xFF85, 0xFF86, 0xFF87, 0xFF88, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 10 - 1f
391
0x0000, 0xFFFC, 0xFFF9, 0xFFF7, 0xFFF4, 0xFF89, 0xFF8A, 0xFF8B, 0xFF8C, 0xFF8D, 0xFF8E, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 20 - 2f
392
0x0000, 0xFFFA, 0xFFF7, 0xFFF5, 0xFF8F, 0xFF90, 0xFF91, 0xFF92, 0xFF93, 0xFF94, 0xFF95, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 30 - 3f
393
0x0000, 0xFFFB, 0xFFF8, 0xFF96, 0xFF97, 0xFF98, 0xFF99, 0xFF9A, 0xFF9B, 0xFF9C, 0xFF9D, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 40 - 4f
394
0x0000, 0xFFFA, 0xFFF7, 0xFF9E, 0xFF9F, 0xFFA0, 0xFFA1, 0xFFA2, 0xFFA3, 0xFFA4, 0xFFA5, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 50 - 5f
395
0x0000, 0xFFFB, 0xFFF6, 0xFFA6, 0xFFA7, 0xFFA8, 0xFFA9, 0xFFAA, 0xFFAB, 0xFFAC, 0xFFAD, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 60 - 6f
396
0x0000, 0xFFFA, 0xFFF7, 0xFFAE, 0xFFAF, 0xFFB0, 0xFFB1, 0xFFB2, 0xFFB3, 0xFFB4, 0xFFB5, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 70 - 7f
397
0x0000, 0xFFF8, 0xFFC0, 0xFFB6, 0xFFB7, 0xFFB8, 0xFFB9, 0xFFBA, 0xFFBB, 0xFFBC, 0xFFBD, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 80 - 8f
398
0x0000, 0xFFF9, 0xFFBE, 0xFFBF, 0xFFC0, 0xFFC1, 0xFFC2, 0xFFC3, 0xFFC4, 0xFFC5, 0xFFC6, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // 90 - 9f
399
0x0000, 0xFFFA, 0xFFC7, 0xFFC8, 0xFFC9, 0xFFCA, 0xFFCB, 0xFFCC, 0xFFCD, 0xFFCE, 0xFFCF, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // a0 - af
400
0x0000, 0xFFF9, 0xFFD0, 0xFFD1, 0xFFD2, 0xFFD3, 0xFFD4, 0xFFD5, 0xFFD6, 0xFFD7, 0xFFD8, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // b0 - bf
401
0x0000, 0xFFFA, 0xFFD9, 0xFFDA, 0xFFDB, 0xFFDC, 0xFFDD, 0xFFDE, 0xFFDF, 0xFFE0, 0xFFE1, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // c0 - cf
402
0x0000, 0xFFF8, 0xFFE2, 0xFFE3, 0xFFE4, 0xFFE5, 0xFFE6, 0xFFE7, 0xFFE8, 0xFFE9, 0xFFEA, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // d0 - df
403
0x0000, 0xFFEB, 0xFFEC, 0xFFED, 0xFFEE, 0xFFEF, 0xFFF0, 0xFFF1, 0xFFF2, 0xFFF3, 0xFFF4, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,    // e0 - ef
404
0xFFF9, 0xFFF5, 0xFFF6, 0xFFF7, 0xFFF8, 0xFFF9, 0xFFFA, 0xFFFB, 0xFFFC, 0xFFFD, 0xFFFE, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000
405
};
406
 
407 37 quickwayne
//===========================================================================
408
void ConvertACMagnitudeY(unsigned char magnitude,unsigned short int *out, unsigned short int *lenght)
409
{
410 39 quickwayne
        unsigned char len;
411
 
412
        len = convertACMagnitudeYLength[magnitude];
413
        if (!len) {
414
#ifndef __MICROBLAZE
415
        printf("WAARDE STAAT NIET IN TABEL!!!!!!!!!!!!!!!!!!!!\n");
416
#endif
417
                }
418
        *lenght = len;
419
        *out = convertACMagnitudeYOut[magnitude];
420
 
421
#if 0
422 37 quickwayne
        switch (magnitude) {
423
case 0x00 :  *lenght=4;  *out=0xFFFA; break; //1010
424
case 0x01 :  *lenght=2;  *out=0xFFF0; break; //00
425
case 0x02 :  *lenght=2;  *out=0xFFF1; break; //01
426
case 0x03 :  *lenght=3;  *out=0xFFF4; break; //100
427
case 0x04 :  *lenght=4;  *out=0xFFFB; break; //1011
428
case 0x05 :  *lenght=5;  *out=0xFFFA; break; //11010
429
case 0x06 :  *lenght=7;  *out=0xFFF8; break; //1111000
430
case 0x07 :  *lenght=8;  *out=0xFFF8; break; //11111000
431
case 0x08 :  *lenght=10; *out=0xFFF6; break; //1111110110
432
case 0x09 :  *lenght=16; *out=0xFF82; break; //1111111110000010
433
case 0x0A :  *lenght=16; *out=0xFF83; break; //1111111110000011
434
case 0x11 :  *lenght=4;  *out=0xFFFC; break; //1100
435
case 0x12 :  *lenght=5;  *out=0xFFFB; break; //11011
436
case 0x13 :  *lenght=7;  *out=0xFFF9; break; //1111001
437
case 0x14 :  *lenght=9;  *out=0xFFF6; break; //111110110
438
case 0x15 :  *lenght=11; *out=0xFFF6; break; //11111110110
439
case 0x16 :  *lenght=16; *out=0xFF84; break; //1111111110000100
440
case 0x17 :  *lenght=16; *out=0xFF85; break; //1111111110000101
441
case 0x18 :  *lenght=16; *out=0xFF86; break; //1111111110000110
442
case 0x19 :  *lenght=16; *out=0xFF87; break; //1111111110000111
443
case 0x1A :  *lenght=16; *out=0xFF88; break; //1111111110001000
444
case 0x21 :  *lenght=5;  *out=0xFFFC; break; //11100
445
case 0x22 :  *lenght=8;  *out=0xFFF9; break; //11111001
446
case 0x23 :  *lenght=10; *out=0xFFF7; break; //1111110111
447
case 0x24 :  *lenght=12; *out=0xFFF4; break; //111111110100
448
case 0x25 :  *lenght=16; *out=0xFF89; break; //1111111110001001
449
case 0x26 :  *lenght=16; *out=0xFF8A; break; //1111111110001010
450
case 0x27 :  *lenght=16; *out=0xFF8B; break; //1111111110001011
451
case 0x28 :  *lenght=16; *out=0xFF8C; break; //1111111110001100
452
case 0x29 :  *lenght=16; *out=0xFF8D; break; //1111111110001101
453
case 0x2A :  *lenght=16; *out=0xFF8E; break; //1111111110001110
454
case 0x31 :  *lenght=6;  *out=0xFFFA; break; //111010
455
case 0x32 :  *lenght=9;  *out=0xFFF7; break; //111110111
456
case 0x33 :  *lenght=12; *out=0xFFF5; break; //111111110101
457
case 0x34 :  *lenght=16; *out=0xFF8F; break; //1111111110001111
458
case 0x35 :  *lenght=16; *out=0xFF90; break; //1111111110010000
459
case 0x36 :  *lenght=16; *out=0xFF91; break; //1111111110010001
460
case 0x37 :  *lenght=16; *out=0xFF92; break; //1111111110010010
461
case 0x38 :  *lenght=16; *out=0xFF93; break; //1111111110010011
462
case 0x39 :  *lenght=16; *out=0xFF94; break; //1111111110010100
463
case 0x3A :  *lenght=16; *out=0xFF95; break; //1111111110010101
464
case 0x41 :  *lenght=6;  *out=0xFFFB; break; //111011
465
case 0x42 :  *lenght=10; *out=0xFFF8; break; //1111111000
466
case 0x43 :  *lenght=16; *out=0xFF96; break; //1111111110010110
467
case 0x44 :  *lenght=16; *out=0xFF97; break; //1111111110010111
468
case 0x45 :  *lenght=16; *out=0xFF98; break; //1111111110011000
469
case 0x46 :  *lenght=16; *out=0xFF99; break; //1111111110011001
470
case 0x47 :  *lenght=16; *out=0xFF9A; break; //1111111110011010
471
case 0x48 :  *lenght=16; *out=0xFF9B; break; //1111111110011011
472
case 0x49 :  *lenght=16; *out=0xFF9C; break; //1111111110011100
473
case 0x4A :  *lenght=16; *out=0xFF9D; break; //1111111110011101
474
case 0x51 :  *lenght=7;  *out=0xFFFA; break; //1111010
475
case 0x52 :  *lenght=11; *out=0xFFF7; break; //11111110111
476
case 0x53 :  *lenght=16; *out=0xFF9E; break; //1111111110011110
477
case 0x54 :  *lenght=16; *out=0xFF9F; break; //1111111110011111
478
case 0x55 :  *lenght=16; *out=0xFFA0; break; //1111111110100000
479
case 0x56 :  *lenght=16; *out=0xFFA1; break; //1111111110100001
480
case 0x57 :  *lenght=16; *out=0xFFA2; break; //1111111110100010
481
case 0x58 :  *lenght=16; *out=0xFFA3; break; //1111111110100011
482
case 0x59 :  *lenght=16; *out=0xFFA4; break; //1111111110100100
483
case 0x5A :  *lenght=16; *out=0xFFA5; break; //1111111110100101
484
case 0x61 :  *lenght=7;  *out=0xFFFB; break; //1111011
485
case 0x62 :  *lenght=12; *out=0xFFF6; break; //111111110110
486
case 0x63 :  *lenght=16; *out=0xFFA6; break; //1111111110100110
487
case 0x64 :  *lenght=16; *out=0xFFA7; break; //1111111110100111
488
case 0x65 :  *lenght=16; *out=0xFFA8; break; //1111111110101000
489
case 0x66 :  *lenght=16; *out=0xFFA9; break; //1111111110101001
490
case 0x67 :  *lenght=16; *out=0xFFAA; break; //1111111110101010
491
case 0x68 :  *lenght=16; *out=0xFFAB; break; //1111111110101011
492
case 0x69 :  *lenght=16; *out=0xFFAC; break; //1111111110101100
493
case 0x6A :  *lenght=16; *out=0xFFAD; break; //1111111110101101
494
case 0x71 :  *lenght=8;  *out=0xFFFA; break; //11111010
495
case 0x72 :  *lenght=12; *out=0xFFF7; break; //111111110111
496
case 0x73 :  *lenght=16; *out=0xFFAE; break; //1111111110101110
497
case 0x74 :  *lenght=16; *out=0xFFAF; break; //1111111110101111
498
case 0x75 :  *lenght=16; *out=0xFFB0; break; //1111111110110000
499
case 0x76 :  *lenght=16; *out=0xFFB1; break; //111111110110001
500
case 0x77 :  *lenght=16; *out=0xFFB2; break; //111111110110010
501
case 0x78 :  *lenght=16; *out=0xFFB3; break; //111111110110011
502
case 0x79 :  *lenght=16; *out=0xFFB4; break; //1111111110110100
503
case 0x7A :  *lenght=16; *out=0xFFB5; break; //1111111110110101
504
case 0x81 :  *lenght=9;  *out=0xFFF8; break; //111111000
505
case 0x82 :  *lenght=15; *out=0xFFC0; break; //111111111000000
506
case 0x83 :  *lenght=16; *out=0xFFB6; break; //1111111110110110
507
case 0x84 :  *lenght=16; *out=0xFFB7; break; //1111111110110111
508
case 0x85 :  *lenght=16; *out=0xFFB8; break; //1111111110111000
509
case 0x86 :  *lenght=16; *out=0xFFB9; break; //1111111110111001
510
case 0x87 :  *lenght=16; *out=0xFFBA; break; //1111111110111010
511
case 0x88 :  *lenght=16; *out=0xFFBB; break; //1111111110111011
512
case 0x89 :  *lenght=16; *out=0xFFBC; break; //1111111110111100
513
case 0x8A :  *lenght=16; *out=0xFFBD; break; //1111111110111101
514
case 0x91 :  *lenght=9;  *out=0xFFF9; break; //111111001
515
case 0x92 :  *lenght=16; *out=0xFFBE; break; //1111111110111110
516
case 0x93 :  *lenght=16; *out=0xFFBF; break; //1111111110111111
517
case 0x94 :  *lenght=16; *out=0xFFC0; break; //1111111111000000
518
case 0x95 :  *lenght=16; *out=0xFFC1; break; //1111111111000001
519
case 0x96 :  *lenght=16; *out=0xFFC2; break; //1111111111000010
520
case 0x97 :  *lenght=16; *out=0xFFC3; break; //1111111111000011
521
case 0x98 :  *lenght=16; *out=0xFFC4; break; //1111111111000100
522
case 0x99 :  *lenght=16; *out=0xFFC5; break; //1111111111000101
523
case 0x9A :  *lenght=16; *out=0xFFC6; break; //1111111111000110
524
case 0xA1 :  *lenght=9;  *out=0xFFFA; break; //111111010
525
case 0xA2 :  *lenght=16; *out=0xFFC7; break; //1111111111000111
526
case 0xA3 :  *lenght=16; *out=0xFFC8; break; //1111111111001000
527
case 0xA4 :  *lenght=16; *out=0xFFC9; break; //1111111111001001
528
case 0xA5 :  *lenght=16; *out=0xFFCA; break; //1111111111001010
529
case 0xA6 :  *lenght=16; *out=0xFFCB; break; //1111111111001011
530
case 0xA7 :  *lenght=16; *out=0xFFCC; break; //1111111111001100
531
case 0xA8 :  *lenght=16; *out=0xFFCD; break; //1111111111001101
532
case 0xA9 :  *lenght=16; *out=0xFFCE; break; //1111111111001110
533
case 0xAA :  *lenght=16; *out=0xFFCF; break; //1111111111001111
534
case 0xB1 :  *lenght=10; *out=0xFFF9; break; //1111111001
535
case 0xB2 :  *lenght=16; *out=0xFFD0; break; //1111111111010000
536
case 0xB3 :  *lenght=16; *out=0xFFD1; break; //1111111111010001
537
case 0xB4 :  *lenght=16; *out=0xFFD2; break; //1111111111010010
538
case 0xB5 :  *lenght=16; *out=0xFFD3; break; //1111111111010011
539
case 0xB6 :  *lenght=16; *out=0xFFD4; break; //1111111111010100
540
case 0xB7 :  *lenght=16; *out=0xFFD5; break; //1111111111010101
541
case 0xB8 :  *lenght=16; *out=0xFFD6; break; //1111111111010110
542
case 0xB9 :  *lenght=16; *out=0xFFD7; break; //1111111111010111
543
case 0xBA :  *lenght=16; *out=0xFFD8; break; //1111111111011000
544
case 0xC1 :  *lenght=10; *out=0xFFFA; break; //1111111010
545
case 0xC2 :  *lenght=16; *out=0xFFD9; break; //1111111111011001
546
case 0xC3 :  *lenght=16; *out=0xFFDA; break; //1111111111011010
547
case 0xC4 :  *lenght=16; *out=0xFFDB; break; //1111111111011011
548
case 0xC5 :  *lenght=16; *out=0xFFDC; break; //1111111111011100
549
case 0xC6 :  *lenght=16; *out=0xFFDD; break; //1111111111011101
550
case 0xC7 :  *lenght=16; *out=0xFFDE; break; //1111111111011110
551
case 0xC8 :  *lenght=16; *out=0xFFDF; break; //1111111111011111
552
case 0xC9 :  *lenght=16; *out=0xFFE0; break; //1111111111100000
553
case 0xCA :  *lenght=16; *out=0xFFE1; break; //1111111111100001
554
case 0xD1 :  *lenght=11; *out=0xFFF8; break; //11111111000
555
case 0xD2 :  *lenght=16; *out=0xFFE2; break; //1111111111100010
556
case 0xD3 :  *lenght=16; *out=0xFFE3; break; //1111111111100011
557
case 0xD4 :  *lenght=16; *out=0xFFE4; break; //1111111111100100
558
case 0xD5 :  *lenght=16; *out=0xFFE5; break; //1111111111100101
559
case 0xD6 :  *lenght=16; *out=0xFFE6; break; //1111111111100110
560
case 0xD7 :  *lenght=16; *out=0xFFE7; break; //1111111111100111
561
case 0xD8 :  *lenght=16; *out=0xFFE8; break; //1111111111101000
562
case 0xD9 :  *lenght=16; *out=0xFFE9; break; //1111111111101001
563
case 0xDA :  *lenght=16; *out=0xFFEA; break; //1111111111101010
564
case 0xE1 :  *lenght=16; *out=0xFFEB; break; //1111111111101011
565
case 0xE2 :  *lenght=16; *out=0xFFEC; break; //1111111111101100
566
case 0xE3 :  *lenght=16; *out=0xFFED; break; //1111111111101101
567
case 0xE4 :  *lenght=16; *out=0xFFEE; break; //1111111111101110
568
case 0xE5 :  *lenght=16; *out=0xFFEF; break; //1111111111101111
569
case 0xE6 :  *lenght=16; *out=0xFFF0; break; //1111111111110000
570
case 0xE7 :  *lenght=16; *out=0xFFF1; break; //1111111111110001
571
case 0xE8 :  *lenght=16; *out=0xFFF2; break; //1111111111110010
572
case 0xE9 :  *lenght=16; *out=0xFFF3; break; //1111111111110011
573
case 0xEA :  *lenght=16; *out=0xFFF4; break; //1111111111110100
574
case 0xF0 :  *lenght=11; *out=0xFFF9; break; //11111111001
575
case 0xF1 :  *lenght=16; *out=0xFFF5; break; //1111111111110101
576
case 0xF2 :  *lenght=16; *out=0xFFF6; break; //1111111111110110
577
case 0xF3 :  *lenght=16; *out=0xFFF7; break; //1111111111110111
578
case 0xF4 :  *lenght=16; *out=0xFFF8; break; //1111111111111000
579
case 0xF5 :  *lenght=16; *out=0xFFF9; break; //1111111111111001
580
case 0xF6 :  *lenght=16; *out=0xFFFA; break; //1111111111111010
581
case 0xF7 :  *lenght=16; *out=0xFFFB; break; //1111111111111011
582
case 0xF8 :  *lenght=16; *out=0xFFFC; break; //1111111111111100
583
case 0xF9 :  *lenght=16; *out=0xFFFD; break; //1111111111111101
584
case 0xFA :  *lenght=16; *out=0xFFFE; break; //1111111111111110
585
#ifndef __MICROBLAZE
586
default : printf("WAARDE STAAT NIET IN TABEL!!!!!!!!!!!!!!!!!!!!\n");break;
587
#endif
588
        }
589
  //      printf("magnitude= %x out= %x lenght= %d \n",magnitude,*out,*lenght);
590
        return;
591 39 quickwayne
 #endif
592
 
593 37 quickwayne
}
594
//===========================================================================
595
char Extend (char additional, unsigned char magnitude)
596
{
597
        int vt= 1 << (magnitude-1);
598
        if ( additional < vt ) return (additional + (-1 << magnitude) + 1);
599
        else return additional;
600
}
601
//===========================================================================
602
void ReverseExtend (char value, unsigned char *magnitude, unsigned char *bits)
603
{
604
 //     printf("reverseextend value= %d\n",*magnitude);
605
        if (value >=0)
606
        {
607
                *bits=value;
608
        }
609
        else
610
        {
611
                value=-value;
612
                *bits=~value;
613
        }
614
        *magnitude=0;
615
        while (value !=0)
616
        {
617
                value>>=1;
618
                ++*magnitude;
619
        }
620
 //     printf("reverseextend magnitude= %d bits= %d",magnitude,bits);
621
        return;
622
}
623
//===========================================================================
624
void WriteRawBits16(unsigned char amount_bits, unsigned int bits)     //*remaining needs bo be more than 8 bits because 8 bits could be added and ther ecould already be up ot 7 bits in *remaining
625
// this function collects bits to send
626
// if there less than 16 bits collected, nothing is send and these bits are stored in *remaining. In *amount_remaining there is stated how much bits are stored in *remaining
627
// if more than 16 bits are collected, 16 bits are send and the remaining bits are stored again
628
{
629
        unsigned short int send;
630
        unsigned int mask;
631
        unsigned char send2;
632
        int count;
633
        mask=0x00;                                                              //init mask
634
        vlc_remaining=(vlc_remaining<<amount_bits);                                   //shift to make place for the new bits
635
        for (count=amount_bits; count>0; count--) mask=(mask<<1)|0x01;          //create mask for adding bit
636
        vlc_remaining=vlc_remaining | (bits&mask);                                    //add bits
637
        vlc_amount_remaining=vlc_amount_remaining + amount_bits;                      //change *amount_remaining to the correct new value
638
        if (vlc_amount_remaining >= 16)                                            //are there more than 16 bits in buffer, send 16 bits
639
        {
640
#ifndef __MICROBLAZE        
641
if (vlc_amount_remaining >= 32 ) printf("ERROR, more bits to send %d",vlc_amount_remaining);
642
#endif
643
                send=vlc_remaining>>(vlc_amount_remaining-16);                        //this value can be send/stored (in art this can be dony by selecting bits)
644
                send2=(send & 0xFF00) >>8;
645
                  vlc_output_byte(send2);
646
//                fwrite(&send2,1,1,file);
647
                if (send2==0xFF)
648
                {
649
                        send2=0x00;
650
                  vlc_output_byte(send2);
651
//                        fwrite(&send2,1,1,file);
652
                }
653
                send2=send & 0xFF;
654
                  vlc_output_byte(send2);
655
//                fwrite(&send2,1,1,file);
656
                if (send2==0xFF)
657
                {
658
                        send2=0x00;
659
                           vlc_output_byte(send2);
660
//                        fwrite(&send2,1,1,file);
661
                }
662
                vlc_amount_remaining=vlc_amount_remaining-16;                         //descrease by 16 because these are send
663
        }
664
        return;
665
}
666
//===========================================================================
667
void HuffmanEncodeFinishSend()
668
// There are still some bits left to send at the end of the 8x8 matrix (or maybe the file),
669
// the remaining bits are filled up with ones and send
670
// possible fault: -must it be filled up with ones?
671
{
672
        unsigned short int send;
673
        unsigned int mask;
674
        int  count;
675
        mask=0x00;                                                              //init mask
676
        if (vlc_amount_remaining >= 8)                                             //2 bytes to send, send first byte
677
        {
678
                send=vlc_remaining>>(vlc_amount_remaining-8);                         //shift so that first byte is ready to send
679 40 quickwayne
                  vlc_output_byte(send&0xff);
680 37 quickwayne
//                fwrite(&send,1,1,file);
681
                if (send==0xFF)                                                 //is this still needed????
682
                {
683
                        send=0x00;
684 40 quickwayne
                           vlc_output_byte(send&0xff);
685 37 quickwayne
//                        fwrite(&send,1,1,file);
686
                }
687
                vlc_amount_remaining=vlc_amount_remaining -8;                         // lower the value to the amount of bits that still needs to be send
688
        }
689
        if (vlc_amount_remaining >= 0)                                             //there is a last byte to send
690
        {
691
                send=vlc_remaining<<(8-vlc_amount_remaining);                         //shift the last bits to send to the front of the byte
692
                mask=0x00;                                                      //init mask
693
                for (count=(8-vlc_amount_remaining); count>0; count--) mask=(mask<<1)|0x01; //create mask to fill byte up with ones
694
                send=send | mask;                                               //add the ones to the byte
695 40 quickwayne
                vlc_output_byte(send&0xff);
696 37 quickwayne
//                fwrite(&send,1,1,file);
697
                vlc_amount_remaining=0x00;                                         //is this needed?
698
        }
699
        return;
700
}
701
//===========================================================================
702
void HuffmanEncodeUsingDCTable(unsigned char magnitude)
703
// Translate magnitude into needed data (from table) and send it
704
{
705
        unsigned char send;
706
        unsigned short int huffmancode, huffmanlengt;
707
        ConvertDCMagnitudeY(magnitude, &huffmancode, &huffmanlengt);
708
        WriteRawBits16(huffmanlengt,huffmancode);
709
        //printf("Write DC magnitude= %2x \n",magnitude);
710
        //WriteRawBits16(0x08,magnitude,remaining,amount_remaining, file);
711
        return;
712
}
713
//===========================================================================
714
void HuffmanEncodeUsingACTable(unsigned char mag)
715
// Translate magnitude into needed data (from table) and send it
716
{
717
        unsigned char send;
718
        unsigned short int huffmancode, huffmanlengt;
719
        ConvertACMagnitudeY(mag, &huffmancode, &huffmanlengt);
720
        WriteRawBits16(huffmanlengt,huffmancode);
721
        return;
722
}
723
//===========================================================================
724
char EncodeDataUnit(char dataunit[64], unsigned int color)
725
{
726
        char difference;
727
        unsigned char magnitude,zerorun,ii,ert;
728
        unsigned int bits;
729 40 quickwayne
        unsigned char bit_char;
730 37 quickwayne
         char last_dc_value;
731
                                         //init
732
  //    PrintMatrix(dataunit) ;
733
        last_dc_value = dcvalue[color];
734
        difference = dataunit[0] - last_dc_value;
735
        last_dc_value=dataunit[0];
736 40 quickwayne
        ReverseExtend(difference, &magnitude,&bit_char);
737
        bits = bit_char;
738 37 quickwayne
        HuffmanEncodeUsingDCTable(magnitude);
739
        WriteRawBits16(magnitude,bits);
740
        zerorun=0;
741
        ii=1;
742
        while ( ii < 64 )
743
        {
744
                if (dataunit[ii] != 0 )
745
                {
746
                        while ( zerorun >= 16 )
747
                        {
748
                                HuffmanEncodeUsingACTable(0xF0);
749
                                zerorun=zerorun-16;
750
                            //    printf("16 zeros:  %d\n",zerorun);
751
                        }
752 40 quickwayne
                        ReverseExtend(dataunit[ii],&magnitude,&bit_char);
753
                        bits=bit_char;
754 37 quickwayne
                        ert= ((int)zerorun *16);                                     //ERROR !!!!!!!!!!!
755
                        ert=ert + magnitude;
756
                        HuffmanEncodeUsingACTable(ert);
757
                        WriteRawBits16(magnitude,bits);
758
                        zerorun=0;
759
                }
760
                else zerorun=zerorun+1;
761
                ii++;
762
        }
763
        if ( zerorun != 0 )
764
        {
765
                HuffmanEncodeUsingACTable(0x00);
766
//                printf("NUL DE REST IS NUL\n");
767
        }
768
 //       HuffmanEncodeFinishSend(remaining,amount_remaining,file);
769
        dcvalue[color] = last_dc_value;
770
        return 0;
771
}

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.