Miguel Ruiz / Mbed 2 deprecated H261_decoder

H261 decoder

Dependencies:   SDL_lib2 SX1276Lib mbed

functions_dec.h@1:1ed97958d0f3, 2017-01-11 (annotated)

Committer:
miruga27
Date:
Wed Jan 11 20:18:38 2017 +0000
Revision:
1:1ed97958d0f3
Parent:
0:5bd441b8ab2d 
JPEG Compressor and SX1276 transmitter

Who changed what in which revision?

UserRevisionLine numberNew contents of line
miruga27 0:5bd441b8ab2d 1 /*
miruga27 0:5bd441b8ab2d 2 * functions_dec.h
miruga27 0:5bd441b8ab2d 3 *
miruga27 0:5bd441b8ab2d 4 * Created on: 5/7/2016
miruga27 0:5bd441b8ab2d 5 * Author: Miguel Ruiz García
miruga27 0:5bd441b8ab2d 6 */
miruga27 0:5bd441b8ab2d 7 #include <SDL.h>
miruga27 0:5bd441b8ab2d 8 //#include <windows.h>
miruga27 0:5bd441b8ab2d 9 #include <stdio.h>
miruga27 0:5bd441b8ab2d 10
miruga27 0:5bd441b8ab2d 11
miruga27 0:5bd441b8ab2d 12 #include <math.h>
miruga27 0:5bd441b8ab2d 13 #ifndef FUNCTIONS_DEC_H_
miruga27 0:5bd441b8ab2d 14 #define FUNCTIONS_DEC_H_
miruga27 0:5bd441b8ab2d 15
miruga27 0:5bd441b8ab2d 16
miruga27 0:5bd441b8ab2d 17
miruga27 0:5bd441b8ab2d 18 #endif /* FUNCTIONS_DEC_H_ */
miruga27 0:5bd441b8ab2d 19
miruga27 0:5bd441b8ab2d 20
miruga27 0:5bd441b8ab2d 21 #define PI 3.1415952
miruga27 0:5bd441b8ab2d 22 #define WIDTH 320
miruga27 0:5bd441b8ab2d 23 #define HEIGHT 8
miruga27 0:5bd441b8ab2d 24 #define DEPTH 32
miruga27 0:5bd441b8ab2d 25 #define RAIZ2 1.414214
miruga27 0:5bd441b8ab2d 26 #define PI16 0.19635
miruga27 0:5bd441b8ab2d 27
miruga27 1:1ed97958d0f3 28 const float coeff[8][8]={
miruga27 1:1ed97958d0f3 29 {1.000, 0.980658, 0.923381, 0.830384, 0.705265, 0.552863, 0.379075, 0.190623},
miruga27 1:1ed97958d0f3 30 {1.000000, 0.830384, 0.379075, -0.200829, -0.712605, -0.982642, -0.919336, -0.544161},
miruga27 1:1ed97958d0f3 31 {1.000000, 0.552863, -0.388685, -0.982642, -0.697848, 0.211013, 0.931171, 0.818607},
miruga27 1:1ed97958d0f3 32 {1.000000, 0.190623, -0.927326, -0.544161, 0.719867, 0.818607, -0.407777, -0.974070},
miruga27 1:1ed97958d0f3 33 {1.000000, -0.200829, -0.919336, 0.570086, 0.690356, -0.847373, -0.350003, 0.987954},
miruga27 1:1ed97958d0f3 34 {1.000000, -0.561505, -0.369424, 0.976372, -0.727052, -0.159885, 0.906605, -0.858241},
miruga27 1:1ed97958d0f3 35 {1.000000, -0.836138, 0.398253, 0.170150, -0.682790, 0.971663, -0.942098, 0.603785},
miruga27 1:1ed97958d0f3 36 {1.000000, -0.982642, 0.931171, -0.847373, 0.734158, -0.595456, 0.436082, -0.261569} };
miruga27 1:1ed97958d0f3 37
miruga27 0:5bd441b8ab2d 38 void IDCT(int matrix[8][8][3],short int f[HEIGHT][WIDTH][3],int p_fil,int p_col){
miruga27 0:5bd441b8ab2d 39 int i=0,j=0,u,v;
miruga27 0:5bd441b8ab2d 40 float cu=1,cv=1;
miruga27 0:5bd441b8ab2d 41 int linea,bpp;
miruga27 0:5bd441b8ab2d 42
miruga27 0:5bd441b8ab2d 43 Uint8 *pixel;
miruga27 0:5bd441b8ab2d 44
miruga27 0:5bd441b8ab2d 45
miruga27 0:5bd441b8ab2d 46 for(i=p_fil;i<8+p_fil;i++){
miruga27 0:5bd441b8ab2d 47
miruga27 0:5bd441b8ab2d 48
miruga27 0:5bd441b8ab2d 49 for(j=p_col;j<8+p_col;j++){
miruga27 0:5bd441b8ab2d 50 f[i][j][0]=0;
miruga27 0:5bd441b8ab2d 51 f[i][j][1]=0;
miruga27 0:5bd441b8ab2d 52 f[i][j][2]=0;
miruga27 0:5bd441b8ab2d 53
miruga27 0:5bd441b8ab2d 54
miruga27 0:5bd441b8ab2d 55 float dato=0.0;
miruga27 0:5bd441b8ab2d 56 float dato2=0.0;
miruga27 0:5bd441b8ab2d 57 float dato3=0.0;
miruga27 1:1ed97958d0f3 58
miruga27 1:1ed97958d0f3 59 float acum0=0.0,acum1=0.0,acum2=0.0;
miruga27 0:5bd441b8ab2d 60
miruga27 0:5bd441b8ab2d 61 for(u=0;u<8;u++){
miruga27 0:5bd441b8ab2d 62
miruga27 0:5bd441b8ab2d 63 for(v=0;v<8;v++){
miruga27 0:5bd441b8ab2d 64 if(u==0){
miruga27 0:5bd441b8ab2d 65 cu=RAIZ2/2;
miruga27 0:5bd441b8ab2d 66 }
miruga27 0:5bd441b8ab2d 67 else cu=1.0;
miruga27 0:5bd441b8ab2d 68 if(v==0){
miruga27 0:5bd441b8ab2d 69 cv=RAIZ2/2;
miruga27 0:5bd441b8ab2d 70
miruga27 0:5bd441b8ab2d 71 }
miruga27 0:5bd441b8ab2d 72 else cv=1.0;
miruga27 1:1ed97958d0f3 73 /*dato=(float)(cos((float)((((j-p_col)*2)+1)*v*PI16)));
miruga27 1:1ed97958d0f3 74 dato2=(float)(cos((float)((((i-p_fil)*2)+1)*u*PI16)));*/
miruga27 1:1ed97958d0f3 75 dato=coeff[j-p_col][v];//(float)(cos((float)((((j-p_col)*2)+1)*v*PI16)));
miruga27 1:1ed97958d0f3 76 dato2=coeff[i-p_fil][u];//(float)(cos((float)((((i-p_fil)*2)+1)*u*PI16)));
miruga27 0:5bd441b8ab2d 77 dato3=(float)((cu*cv)/4);
miruga27 0:5bd441b8ab2d 78
miruga27 1:1ed97958d0f3 79 acum0+=(float)(dato*dato2*(matrix[u][v][0]))*dato3;//crominancia
miruga27 1:1ed97958d0f3 80 acum1+=(float)(dato*dato2*(matrix[u][v][1]))*dato3;//crominancia
miruga27 1:1ed97958d0f3 81 acum2+=(float)(dato*dato2*(matrix[u][v][2]))*dato3;//luminancia
miruga27 0:5bd441b8ab2d 82
miruga27 0:5bd441b8ab2d 83 }
miruga27 0:5bd441b8ab2d 84 }
miruga27 1:1ed97958d0f3 85
miruga27 1:1ed97958d0f3 86 f[i][j][0]=(short int)acum0;
miruga27 1:1ed97958d0f3 87 f[i][j][1]=(short int)acum1;
miruga27 1:1ed97958d0f3 88 f[i][j][2]=(short int)acum2;
miruga27 0:5bd441b8ab2d 89
miruga27 0:5bd441b8ab2d 90 }
miruga27 0:5bd441b8ab2d 91
miruga27 0:5bd441b8ab2d 92
miruga27 0:5bd441b8ab2d 93 }
miruga27 0:5bd441b8ab2d 94
miruga27 0:5bd441b8ab2d 95 }
miruga27 0:5bd441b8ab2d 96
miruga27 0:5bd441b8ab2d 97 void yuv_to_rgb(short int f[HEIGHT][WIDTH][3]){
miruga27 0:5bd441b8ab2d 98
miruga27 0:5bd441b8ab2d 99
miruga27 0:5bd441b8ab2d 100 int i=0,j=0;
miruga27 0:5bd441b8ab2d 101
miruga27 0:5bd441b8ab2d 102 float r=0.0,g=0.0,b=0.0;
miruga27 1:1ed97958d0f3 103
miruga27 0:5bd441b8ab2d 104
miruga27 0:5bd441b8ab2d 105 int cont;
miruga27 0:5bd441b8ab2d 106
miruga27 0:5bd441b8ab2d 107 for(i=0;i<HEIGHT;i++){
miruga27 0:5bd441b8ab2d 108 for(j=0;j<WIDTH;j++){
miruga27 0:5bd441b8ab2d 109
miruga27 0:5bd441b8ab2d 110
miruga27 0:5bd441b8ab2d 111
miruga27 1:1ed97958d0f3 112 b=(f[i][j][0])+(f[i][j][1]-128)*1.765;
miruga27 1:1ed97958d0f3 113 g=(f[i][j][0])-(f[i][j][2]-128)*0.711-(f[i][j][1]-128)*0.343;
miruga27 1:1ed97958d0f3 114 r=((f[i][j][0]))+((f[i][j][2])-128)*1.400;
miruga27 0:5bd441b8ab2d 115
miruga27 0:5bd441b8ab2d 116 /* r=(*(pixel+2)-16)*1.164+(*(pixel)-128)*1.793;
miruga27 0:5bd441b8ab2d 117 g=(*(pixel+2)-16)*1.164-(*(pixel+1)-128)*0.213-(*(pixel)-128)*0.533;
miruga27 0:5bd441b8ab2d 118 b=(*(pixel+2)-16)*1.164+((*(pixel+1))-128)*2.112;*/
miruga27 1:1ed97958d0f3 119 if(b>255) r=255;
miruga27 0:5bd441b8ab2d 120 if(g>255) g=255;
miruga27 1:1ed97958d0f3 121 if(r>255) b=255;
miruga27 0:5bd441b8ab2d 122
miruga27 0:5bd441b8ab2d 123 if(r<0) r=0;
miruga27 0:5bd441b8ab2d 124 if(g<0) g=0;
miruga27 0:5bd441b8ab2d 125 if(b<0) b=0;
miruga27 0:5bd441b8ab2d 126
miruga27 0:5bd441b8ab2d 127 f[i][j][2]=(short int)r;
miruga27 0:5bd441b8ab2d 128 f[i][j][1]=(short int)g;
miruga27 0:5bd441b8ab2d 129 f[i][j][0]=(short int)b;
miruga27 0:5bd441b8ab2d 130 }
miruga27 0:5bd441b8ab2d 131
miruga27 0:5bd441b8ab2d 132 }
miruga27 0:5bd441b8ab2d 133
miruga27 0:5bd441b8ab2d 134
miruga27 0:5bd441b8ab2d 135 }
miruga27 0:5bd441b8ab2d 136
miruga27 0:5bd441b8ab2d 137 void zig_zag_dec(short int f[HEIGHT][WIDTH][3],short int *matrix){
miruga27 0:5bd441b8ab2d 138
miruga27 0:5bd441b8ab2d 139 int i=0,p_x=0,p_y=0;
miruga27 0:5bd441b8ab2d 140 int flag=0;
miruga27 0:5bd441b8ab2d 141 for(i=0;i<HEIGHT*WIDTH*3;i+=3){
miruga27 0:5bd441b8ab2d 142
miruga27 0:5bd441b8ab2d 143 f[p_y][p_x][0]= *(matrix+i);
miruga27 0:5bd441b8ab2d 144 f[p_y][p_x][1]= *(matrix+i+1);
miruga27 0:5bd441b8ab2d 145 f[p_y][p_x][2]= *(matrix+i+2);
miruga27 0:5bd441b8ab2d 146
miruga27 0:5bd441b8ab2d 147 if(flag==0){
miruga27 0:5bd441b8ab2d 148 p_x++,p_y--;
miruga27 0:5bd441b8ab2d 149 if(p_y<0){
miruga27 0:5bd441b8ab2d 150 p_y=0;
miruga27 0:5bd441b8ab2d 151 flag=1;
miruga27 0:5bd441b8ab2d 152
miruga27 0:5bd441b8ab2d 153 }
miruga27 0:5bd441b8ab2d 154 if(p_x>WIDTH-1){
miruga27 0:5bd441b8ab2d 155 p_x=WIDTH-1;
miruga27 0:5bd441b8ab2d 156 p_y+=2;
miruga27 0:5bd441b8ab2d 157 flag=1;
miruga27 0:5bd441b8ab2d 158
miruga27 0:5bd441b8ab2d 159
miruga27 0:5bd441b8ab2d 160 }
miruga27 0:5bd441b8ab2d 161 }
miruga27 0:5bd441b8ab2d 162 else{
miruga27 0:5bd441b8ab2d 163 p_x--,p_y++;
miruga27 0:5bd441b8ab2d 164 if(p_y>HEIGHT-1){
miruga27 0:5bd441b8ab2d 165 p_y=HEIGHT-1;
miruga27 0:5bd441b8ab2d 166 p_x+=2;
miruga27 0:5bd441b8ab2d 167 flag=0;
miruga27 0:5bd441b8ab2d 168
miruga27 0:5bd441b8ab2d 169 }
miruga27 0:5bd441b8ab2d 170 if(p_x<0){
miruga27 0:5bd441b8ab2d 171 p_x=0;
miruga27 0:5bd441b8ab2d 172 flag=0;
miruga27 0:5bd441b8ab2d 173 }
miruga27 0:5bd441b8ab2d 174 }
miruga27 0:5bd441b8ab2d 175
miruga27 0:5bd441b8ab2d 176
miruga27 0:5bd441b8ab2d 177 }
miruga27 0:5bd441b8ab2d 178
miruga27 0:5bd441b8ab2d 179
miruga27 0:5bd441b8ab2d 180
miruga27 0:5bd441b8ab2d 181 }
miruga27 0:5bd441b8ab2d 182
miruga27 0:5bd441b8ab2d 183 void cuantizador_dec(short int mat[HEIGHT][WIDTH][3]){
miruga27 0:5bd441b8ab2d 184 short int luma[8][8]={{16,11,10,16,24,40,51,61},
miruga27 0:5bd441b8ab2d 185 {12,12,14,19,26,58,60,55},
miruga27 0:5bd441b8ab2d 186 {14,13,16,24,40,57,69,56},
miruga27 0:5bd441b8ab2d 187 {14,17,22,29,51,87,80,62},
miruga27 0:5bd441b8ab2d 188 {18,22,37,56,68,109,103,77},
miruga27 0:5bd441b8ab2d 189 {24,35,55,64,81,104,113,92},
miruga27 0:5bd441b8ab2d 190 {49,64,78,87,103,121,120,101},
miruga27 0:5bd441b8ab2d 191 {72,92,95,98,112,100,103,99}};
miruga27 0:5bd441b8ab2d 192 short int croma[8][8]={{17,18,24,47,99,99,99,99},
miruga27 0:5bd441b8ab2d 193 {18,21,26,66,99,99,99,99},
miruga27 0:5bd441b8ab2d 194 {24,26,56,99,99,99,99,99},
miruga27 0:5bd441b8ab2d 195 {47,66,99,99,99,99,99,99},
miruga27 0:5bd441b8ab2d 196 {99,99,99,99,99,99,99,99},
miruga27 0:5bd441b8ab2d 197 {99,99,99,99,99,99,99,99},
miruga27 0:5bd441b8ab2d 198 {99,99,99,99,99,99,99,99},
miruga27 0:5bd441b8ab2d 199 {99,99,99,99,99,99,99,99}};
miruga27 0:5bd441b8ab2d 200 int i=0,x_block,y_block,j;
miruga27 0:5bd441b8ab2d 201 for(i=0;i<HEIGHT;i+=8){
miruga27 0:5bd441b8ab2d 202 for(j=0;j<WIDTH;j+=8)
miruga27 0:5bd441b8ab2d 203 for(x_block=i; x_block<i+8 ;x_block++){
miruga27 0:5bd441b8ab2d 204 for(y_block=j; y_block<j+8 ;y_block++){
miruga27 1:1ed97958d0f3 205 mat[x_block][y_block][0]*=luma[x_block-i][y_block-j];
miruga27 0:5bd441b8ab2d 206 mat[x_block][y_block][1]*=croma[x_block-i][y_block-j];
miruga27 1:1ed97958d0f3 207 mat[x_block][y_block][2]*=croma[x_block-i][y_block-j];
miruga27 0:5bd441b8ab2d 208 }
miruga27 0:5bd441b8ab2d 209 }
miruga27 0:5bd441b8ab2d 210 }
miruga27 0:5bd441b8ab2d 211
miruga27 0:5bd441b8ab2d 212 }
miruga27 0:5bd441b8ab2d 213
miruga27 0:5bd441b8ab2d 214