Mercurial > mplayer.hg
annotate libaf/af_format.c @ 12478:7f8eb5f6814a
support for 24 bit pcm/wav files
author | reimar |
---|---|
date | Sun, 16 May 2004 10:48:59 +0000 |
parents | be1e7cfddc08 |
children | dbbc25ea6403 |
rev | line source |
---|---|
7568 | 1 /* This audio output filter changes the format of a data block. Valid |
2 formats are: AFMT_U8, AFMT_S8, AFMT_S16_LE, AFMT_S16_BE | |
3 AFMT_U16_LE, AFMT_U16_BE, AFMT_S32_LE and AFMT_S32_BE. | |
4 */ | |
5 | |
6 #include <stdio.h> | |
7 #include <stdlib.h> | |
8 #include <string.h> | |
9 #include <unistd.h> | |
10 #include <inttypes.h> | |
11 #include <limits.h> | |
12 | |
13 #include "af.h" | |
14 | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
15 // Integer to float conversion through lrintf() |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
16 #ifdef HAVE_LRINTF |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
17 #define __USE_ISOC99 1 |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
18 #include <math.h> |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
19 #else |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
20 #define lrintf(x) ((int)(x)) |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
21 #endif |
8167 | 22 |
23 /* Functions used by play to convert the input audio to the correct | |
24 format */ | |
7568 | 25 |
8167 | 26 /* The below includes retrives functions for converting to and from |
27 ulaw and alaw */ | |
28 #include "af_format_ulaw.c" | |
29 #include "af_format_alaw.c" | |
7568 | 30 |
8167 | 31 // Switch endianess |
32 static void endian(void* in, void* out, int len, int bps); | |
33 // From singed to unsigned | |
34 static void si2us(void* in, void* out, int len, int bps); | |
35 // From unsinged to signed | |
36 static void us2si(void* in, void* out, int len, int bps); | |
37 // Change the number of bits per sample | |
38 static void change_bps(void* in, void* out, int len, int inbps, int outbps); | |
39 // From float to int signed | |
40 static void float2int(void* in, void* out, int len, int bps); | |
41 // From signed int to float | |
42 static void int2float(void* in, void* out, int len, int bps); | |
7719
41e8d0916c60
Fix for audio filters on big endian cpus. It's working now on Solaris SPARC &
jkeil
parents:
7711
diff
changeset
|
43 |
8167 | 44 // Convert from string to format |
45 static int str2fmt(char* str) | |
7568 | 46 { |
8167 | 47 int format=0; |
48 // Scan for endianess | |
49 if(strstr(str,"be") || strstr(str,"BE")) | |
50 format |= AF_FORMAT_BE; | |
51 else if(strstr(str,"le") || strstr(str,"LE")) | |
52 format |= AF_FORMAT_LE; | |
53 else | |
54 format |= AF_FORMAT_NE; | |
55 | |
56 // Scan for special formats | |
57 if(strstr(str,"mulaw") || strstr(str,"MULAW")){ | |
58 format |= AF_FORMAT_MU_LAW; return format; | |
59 } | |
60 if(strstr(str,"alaw") || strstr(str,"ALAW")){ | |
61 format |= AF_FORMAT_A_LAW; return format; | |
62 } | |
63 if(strstr(str,"ac3") || strstr(str,"AC3")){ | |
64 format |= AF_FORMAT_AC3; return format; | |
65 } | |
66 if(strstr(str,"mpeg2") || strstr(str,"MPEG2")){ | |
67 format |= AF_FORMAT_MPEG2; return format; | |
68 } | |
69 if(strstr(str,"imaadpcm") || strstr(str,"IMAADPCM")){ | |
70 format |= AF_FORMAT_IMA_ADPCM; return format; | |
71 } | |
72 | |
73 // Scan for int/float | |
74 if(strstr(str,"float") || strstr(str,"FLOAT")){ | |
75 format |= AF_FORMAT_F; return format; | |
7568 | 76 } |
8167 | 77 else |
78 format |= AF_FORMAT_I; | |
7568 | 79 |
8167 | 80 // Scan for signed/unsigned |
81 if(strstr(str,"unsigned") || strstr(str,"UNSIGNED")) | |
82 format |= AF_FORMAT_US; | |
83 else | |
84 format |= AF_FORMAT_SI; | |
85 | |
86 return format; | |
87 } | |
88 | |
89 /* Convert format to str input str is a buffer for the | |
90 converted string, size is the size of the buffer */ | |
8994 | 91 char* fmt2str(int format, char* str, size_t size) |
8167 | 92 { |
93 int i=0; | |
94 // Print endinaness | |
95 if(AF_FORMAT_LE == (format & AF_FORMAT_END_MASK)) | |
96 i+=snprintf(str,size,"little endian "); | |
97 else | |
98 i+=snprintf(str,size,"big endian "); | |
99 | |
100 if(format & AF_FORMAT_SPECIAL_MASK){ | |
101 switch(format & AF_FORMAT_SPECIAL_MASK){ | |
102 case(AF_FORMAT_MU_LAW): | |
103 i+=snprintf(&str[i],size-i,"mu law "); break; | |
104 case(AF_FORMAT_A_LAW): | |
105 i+=snprintf(&str[i],size-i,"A law "); break; | |
106 case(AF_FORMAT_MPEG2): | |
107 i+=snprintf(&str[i],size-i,"MPEG 2 "); break; | |
108 case(AF_FORMAT_AC3): | |
109 i+=snprintf(&str[i],size-i,"AC3 "); break; | |
110 } | |
111 } | |
112 else{ | |
113 // Point | |
114 if(AF_FORMAT_F == (format & AF_FORMAT_POINT_MASK)) | |
115 i+=snprintf(&str[i],size,"float "); | |
116 else{ | |
117 // Sign | |
118 if(AF_FORMAT_US == (format & AF_FORMAT_SIGN_MASK)) | |
119 i+=snprintf(&str[i],size-i,"unsigned "); | |
120 else | |
121 i+=snprintf(&str[i],size-i,"signed "); | |
122 | |
123 i+=snprintf(&str[i],size,"int "); | |
124 } | |
125 } | |
126 return str; | |
7568 | 127 } |
128 | |
8607 | 129 // Helper functions to check sanity for input arguments |
130 | |
131 // Sanity check for bytes per sample | |
132 int check_bps(int bps) | |
133 { | |
12478 | 134 if(bps != 4 && bps != 3 && bps != 2 && bps != 1){ |
8607 | 135 af_msg(AF_MSG_ERROR,"[format] The number of bytes per sample" |
12478 | 136 " must be 1, 2, 3 or 4. Current value is %i \n",bps); |
8607 | 137 return AF_ERROR; |
138 } | |
139 return AF_OK; | |
140 } | |
141 | |
142 // Check for unsupported formats | |
143 int check_format(int format) | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
144 { |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
145 char buf[256]; |
8607 | 146 switch(format & AF_FORMAT_SPECIAL_MASK){ |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
147 case(AF_FORMAT_MPEG2): |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
148 case(AF_FORMAT_AC3): |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
149 af_msg(AF_MSG_ERROR,"[format] Sample format %s not yet supported \n", |
8607 | 150 fmt2str(format,buf,255)); |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
151 return AF_ERROR; |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
152 } |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
153 return AF_OK; |
8607 | 154 } |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
155 |
7568 | 156 // Initialization and runtime control |
157 static int control(struct af_instance_s* af, int cmd, void* arg) | |
158 { | |
159 switch(cmd){ | |
8167 | 160 case AF_CONTROL_REINIT:{ |
161 char buf1[256]; | |
162 char buf2[256]; | |
7568 | 163 // Make sure this filter isn't redundant |
8167 | 164 if(af->data->format == ((af_data_t*)arg)->format && |
165 af->data->bps == ((af_data_t*)arg)->bps) | |
7568 | 166 return AF_DETACH; |
8607 | 167 |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
168 // Check for errors in configuraton |
8607 | 169 if((AF_OK != check_bps(((af_data_t*)arg)->bps)) || |
170 (AF_OK != check_format(((af_data_t*)arg)->format)) || | |
171 (AF_OK != check_bps(af->data->bps)) || | |
172 (AF_OK != check_format(af->data->format))) | |
8167 | 173 return AF_ERROR; |
174 | |
175 af_msg(AF_MSG_VERBOSE,"[format] Changing sample format from %ibit %sto %ibit %s \n", | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
176 ((af_data_t*)arg)->bps*8,fmt2str(((af_data_t*)arg)->format,buf1,255), |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
177 af->data->bps*8,fmt2str(af->data->format,buf2,255)); |
7568 | 178 |
179 af->data->rate = ((af_data_t*)arg)->rate; | |
180 af->data->nch = ((af_data_t*)arg)->nch; | |
181 af->mul.n = af->data->bps; | |
182 af->mul.d = ((af_data_t*)arg)->bps; | |
183 return AF_OK; | |
8167 | 184 } |
7998
d48a06d07afb
Adding commandline options for filters and fixing stupid bug in cfg
anders
parents:
7719
diff
changeset
|
185 case AF_CONTROL_COMMAND_LINE:{ |
8607 | 186 int bps = 2; |
187 int format = AF_FORMAT_NE; | |
8167 | 188 char str[256]; |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
189 str[0] = '\0'; |
8607 | 190 sscanf((char*)arg,"%i:%s",&bps,str); |
8167 | 191 // Convert string to format |
8607 | 192 format = str2fmt(str); |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
193 |
8167 | 194 // Automatic correction of errors |
8607 | 195 switch(format & AF_FORMAT_SPECIAL_MASK){ |
8167 | 196 case(AF_FORMAT_A_LAW): |
197 case(AF_FORMAT_MU_LAW): | |
8607 | 198 bps=1; break; |
8167 | 199 case(AF_FORMAT_AC3): |
8607 | 200 bps=4; break; // I think |
8167 | 201 } |
8607 | 202 if(AF_FORMAT_F == (format & AF_FORMAT_POINT_MASK)) |
203 bps=4; | |
204 | |
205 if((AF_OK != af->control(af,AF_CONTROL_FORMAT_BPS | AF_CONTROL_SET,&bps)) || | |
206 (AF_OK != af->control(af,AF_CONTROL_FORMAT_FMT | AF_CONTROL_SET,&format))) | |
207 return AF_ERROR; | |
208 return AF_OK; | |
8167 | 209 } |
8607 | 210 case AF_CONTROL_FORMAT_BPS | AF_CONTROL_SET: |
7568 | 211 // Reinit must be called after this function has been called |
212 | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
213 // Check for errors in configuraton |
8607 | 214 if(AF_OK != check_bps(*(int*)arg)) |
7568 | 215 return AF_ERROR; |
8167 | 216 |
8607 | 217 af->data->bps = *(int*)arg; |
218 return AF_OK; | |
219 case AF_CONTROL_FORMAT_FMT | AF_CONTROL_SET: | |
220 // Reinit must be called after this function has been called | |
221 | |
222 // Check for errors in configuraton | |
223 if(AF_OK != check_format(*(int*)arg)) | |
224 return AF_ERROR; | |
225 | |
226 af->data->format = *(int*)arg; | |
7568 | 227 return AF_OK; |
228 } | |
229 return AF_UNKNOWN; | |
230 } | |
231 | |
232 // Deallocate memory | |
233 static void uninit(struct af_instance_s* af) | |
234 { | |
235 if(af->data) | |
236 free(af->data); | |
12386 | 237 af->setup = 0; |
7568 | 238 } |
239 | |
240 // Filter data through filter | |
241 static af_data_t* play(struct af_instance_s* af, af_data_t* data) | |
242 { | |
8167 | 243 af_data_t* l = af->data; // Local data |
244 af_data_t* c = data; // Current working data | |
245 int len = c->len/c->bps; // Lenght in samples of current audio block | |
7568 | 246 |
247 if(AF_OK != RESIZE_LOCAL_BUFFER(af,data)) | |
248 return NULL; | |
249 | |
8167 | 250 // Change to cpu native endian format |
251 if((c->format&AF_FORMAT_END_MASK)!=AF_FORMAT_NE) | |
252 endian(c->audio,c->audio,len,c->bps); | |
7719
41e8d0916c60
Fix for audio filters on big endian cpus. It's working now on Solaris SPARC &
jkeil
parents:
7711
diff
changeset
|
253 |
8167 | 254 // Conversion table |
255 switch(c->format & ~AF_FORMAT_END_MASK){ | |
256 case(AF_FORMAT_MU_LAW): | |
257 from_ulaw(c->audio, l->audio, len, l->bps, l->format&AF_FORMAT_POINT_MASK); | |
258 if(AF_FORMAT_A_LAW == (l->format&AF_FORMAT_SPECIAL_MASK)) | |
259 to_ulaw(l->audio, l->audio, len, 1, AF_FORMAT_SI); | |
260 if((l->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) | |
261 si2us(l->audio,l->audio,len,l->bps); | |
262 break; | |
263 case(AF_FORMAT_A_LAW): | |
264 from_alaw(c->audio, l->audio, len, l->bps, l->format&AF_FORMAT_POINT_MASK); | |
265 if(AF_FORMAT_A_LAW == (l->format&AF_FORMAT_SPECIAL_MASK)) | |
266 to_alaw(l->audio, l->audio, len, 1, AF_FORMAT_SI); | |
267 if((l->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) | |
268 si2us(l->audio,l->audio,len,l->bps); | |
269 break; | |
270 case(AF_FORMAT_F): | |
271 switch(l->format&AF_FORMAT_SPECIAL_MASK){ | |
272 case(AF_FORMAT_MU_LAW): | |
273 to_ulaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); | |
274 break; | |
275 case(AF_FORMAT_A_LAW): | |
276 to_alaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); | |
7568 | 277 break; |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
278 default: |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
279 float2int(c->audio, l->audio, len, l->bps); |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
280 if((l->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
281 si2us(l->audio,l->audio,len,l->bps); |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
282 break; |
8167 | 283 } |
284 break; | |
285 default: | |
286 // Input must be int | |
287 | |
288 // Change signed/unsigned | |
289 if((c->format&AF_FORMAT_SIGN_MASK) != (l->format&AF_FORMAT_SIGN_MASK)){ | |
290 if((c->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) | |
291 us2si(c->audio,c->audio,len,c->bps); | |
292 else | |
293 si2us(c->audio,c->audio,len,c->bps); | |
294 } | |
295 // Convert to special formats | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
296 switch(l->format&(AF_FORMAT_SPECIAL_MASK|AF_FORMAT_POINT_MASK)){ |
8167 | 297 case(AF_FORMAT_MU_LAW): |
298 to_ulaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); | |
299 break; | |
300 case(AF_FORMAT_A_LAW): | |
301 to_alaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); | |
302 break; | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
303 case(AF_FORMAT_F): |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
304 int2float(c->audio, l->audio, len, c->bps); |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
305 break; |
8167 | 306 default: |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
307 // Change the number of bits |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
308 if(c->bps != l->bps) |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
309 change_bps(c->audio,l->audio,len,c->bps,l->bps); |
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
310 else |
8185 | 311 memcpy(l->audio,c->audio,len*c->bps); |
7568 | 312 break; |
313 } | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
314 break; |
7568 | 315 } |
7719
41e8d0916c60
Fix for audio filters on big endian cpus. It's working now on Solaris SPARC &
jkeil
parents:
7711
diff
changeset
|
316 |
41e8d0916c60
Fix for audio filters on big endian cpus. It's working now on Solaris SPARC &
jkeil
parents:
7711
diff
changeset
|
317 // Switch from cpu native endian to the correct endianess |
8167 | 318 if((l->format&AF_FORMAT_END_MASK)!=AF_FORMAT_NE) |
319 endian(l->audio,l->audio,len,l->bps); | |
7568 | 320 |
321 // Set output data | |
322 c->audio = l->audio; | |
8167 | 323 c->len = len*l->bps; |
7568 | 324 c->bps = l->bps; |
325 c->format = l->format; | |
326 return c; | |
327 } | |
328 | |
329 // Allocate memory and set function pointers | |
330 static int open(af_instance_t* af){ | |
331 af->control=control; | |
332 af->uninit=uninit; | |
333 af->play=play; | |
334 af->mul.n=1; | |
335 af->mul.d=1; | |
336 af->data=calloc(1,sizeof(af_data_t)); | |
337 if(af->data == NULL) | |
338 return AF_ERROR; | |
339 return AF_OK; | |
340 } | |
341 | |
342 // Description of this filter | |
343 af_info_t af_info_format = { | |
344 "Sample format conversion", | |
345 "format", | |
346 "Anders", | |
347 "", | |
7615 | 348 AF_FLAGS_REENTRANT, |
7568 | 349 open |
350 }; | |
8167 | 351 |
12478 | 352 static inline uint32_t load24bit(void* data, int pos) { |
353 #if WORDS_BIGENDIAN | |
354 return (((uint32_t)((uint8_t*)data)[3*pos])<<24) | | |
355 (((uint32_t)((uint8_t*)data)[3*pos+1])<<16) | | |
356 (((uint32_t)((uint8_t*)data)[3*pos+2])<<8); | |
357 #else | |
358 return (((uint32_t)((uint8_t*)data)[3*pos])<<8) | | |
359 (((uint32_t)((uint8_t*)data)[3*pos+1])<<16) | | |
360 (((uint32_t)((uint8_t*)data)[3*pos+2])<<24); | |
361 #endif | |
362 } | |
363 | |
364 static inline void store24bit(void* data, int pos, uint32_t expanded_value) { | |
365 #if WORDS_BIGENDIAN | |
366 ((uint8_t*)data)[3*pos]=expanded_value>>24; | |
367 ((uint8_t*)data)[3*pos+1]=expanded_value>>16; | |
368 ((uint8_t*)data)[3*pos+2]=expanded_value>>8; | |
369 #else | |
370 ((uint8_t*)data)[3*pos]=expanded_value>>8; | |
371 ((uint8_t*)data)[3*pos+1]=expanded_value>>16; | |
372 ((uint8_t*)data)[3*pos+2]=expanded_value>>24; | |
373 #endif | |
374 } | |
375 | |
8167 | 376 // Function implementations used by play |
377 static void endian(void* in, void* out, int len, int bps) | |
378 { | |
379 register int i; | |
380 switch(bps){ | |
381 case(2):{ | |
382 register uint16_t s; | |
383 for(i=0;i<len;i++){ | |
384 s=((uint16_t*)in)[i]; | |
385 ((uint16_t*)out)[i]=(uint16_t)(((s&0x00FF)<<8) | (s&0xFF00)>>8); | |
386 } | |
387 break; | |
388 } | |
12478 | 389 case(3):{ |
390 register uint8_t s; | |
391 for(i=0;i<len;i++){ | |
392 s=((uint8_t*)in)[3*i]; | |
393 ((uint8_t*)out)[3*i]=((uint8_t*)in)[3*i+2]; | |
394 ((uint8_t*)out)[3*i+2]=s; | |
395 } | |
396 break; | |
397 } | |
8167 | 398 case(4):{ |
399 register uint32_t s; | |
400 for(i=0;i<len;i++){ | |
401 s=((uint32_t*)in)[i]; | |
402 ((uint32_t*)out)[i]=(uint32_t)(((s&0x000000FF)<<24) | | |
403 ((s&0x0000FF00)<<8) | | |
404 ((s&0x00FF0000)>>8) | | |
405 ((s&0xFF000000)>>24)); | |
406 } | |
407 break; | |
408 } | |
409 } | |
410 } | |
411 | |
412 static void si2us(void* in, void* out, int len, int bps) | |
413 { | |
414 register int i; | |
415 switch(bps){ | |
416 case(1): | |
417 for(i=0;i<len;i++) | |
418 ((uint8_t*)out)[i]=(uint8_t)(SCHAR_MAX+((int)((int8_t*)in)[i])); | |
419 break; | |
420 case(2): | |
421 for(i=0;i<len;i++) | |
422 ((uint16_t*)out)[i]=(uint16_t)(SHRT_MAX+((int)((int16_t*)in)[i])); | |
423 break; | |
12478 | 424 case(3): |
425 for(i=0;i<len;i++) | |
426 store24bit(out, i, (uint32_t)(INT_MAX+(int32_t)load24bit(in, i))); | |
427 break; | |
8167 | 428 case(4): |
429 for(i=0;i<len;i++) | |
430 ((uint32_t*)out)[i]=(uint32_t)(INT_MAX+((int32_t*)in)[i]); | |
431 break; | |
432 } | |
433 } | |
434 | |
435 static void us2si(void* in, void* out, int len, int bps) | |
436 { | |
437 register int i; | |
438 switch(bps){ | |
439 case(1): | |
440 for(i=0;i<len;i++) | |
441 ((int8_t*)out)[i]=(int8_t)(SCHAR_MIN+((int)((uint8_t*)in)[i])); | |
442 break; | |
443 case(2): | |
444 for(i=0;i<len;i++) | |
445 ((int16_t*)out)[i]=(int16_t)(SHRT_MIN+((int)((uint16_t*)in)[i])); | |
446 break; | |
12478 | 447 case(3): |
448 for(i=0;i<len;i++) | |
449 store24bit(out, i, (int32_t)(INT_MIN+(uint32_t)load24bit(in, i))); | |
450 break; | |
8167 | 451 case(4): |
452 for(i=0;i<len;i++) | |
453 ((int32_t*)out)[i]=(int32_t)(INT_MIN+((uint32_t*)in)[i]); | |
454 break; | |
455 } | |
456 } | |
457 | |
458 static void change_bps(void* in, void* out, int len, int inbps, int outbps) | |
459 { | |
460 register int i; | |
461 switch(inbps){ | |
462 case(1): | |
463 switch(outbps){ | |
464 case(2): | |
465 for(i=0;i<len;i++) | |
466 ((uint16_t*)out)[i]=((uint16_t)((uint8_t*)in)[i])<<8; | |
467 break; | |
12478 | 468 case(3): |
469 for(i=0;i<len;i++) | |
470 store24bit(out, i, ((uint32_t)((uint8_t*)in)[i])<<24); | |
471 break; | |
8167 | 472 case(4): |
473 for(i=0;i<len;i++) | |
474 ((uint32_t*)out)[i]=((uint32_t)((uint8_t*)in)[i])<<24; | |
475 break; | |
476 } | |
477 break; | |
478 case(2): | |
479 switch(outbps){ | |
480 case(1): | |
481 for(i=0;i<len;i++) | |
482 ((uint8_t*)out)[i]=(uint8_t)((((uint16_t*)in)[i])>>8); | |
483 break; | |
12478 | 484 case(3): |
485 for(i=0;i<len;i++) | |
486 store24bit(out, i, ((uint32_t)((uint16_t*)in)[i])<<16); | |
487 break; | |
8167 | 488 case(4): |
489 for(i=0;i<len;i++) | |
490 ((uint32_t*)out)[i]=((uint32_t)((uint16_t*)in)[i])<<16; | |
491 break; | |
492 } | |
493 break; | |
12478 | 494 case(3): |
495 switch(outbps){ | |
496 case(1): | |
497 for(i=0;i<len;i++) | |
498 ((uint8_t*)out)[i]=(uint8_t)(load24bit(in, i)>>24); | |
499 break; | |
500 case(2): | |
501 for(i=0;i<len;i++) | |
502 ((uint16_t*)out)[i]=(uint16_t)(load24bit(in, i)>>16); | |
503 break; | |
504 case(4): | |
505 for(i=0;i<len;i++) | |
506 ((uint32_t*)out)[i]=(uint32_t)load24bit(in, i); | |
507 break; | |
508 } | |
509 break; | |
8167 | 510 case(4): |
511 switch(outbps){ | |
512 case(1): | |
513 for(i=0;i<len;i++) | |
514 ((uint8_t*)out)[i]=(uint8_t)((((uint32_t*)in)[i])>>24); | |
515 break; | |
516 case(2): | |
517 for(i=0;i<len;i++) | |
518 ((uint16_t*)out)[i]=(uint16_t)((((uint32_t*)in)[i])>>16); | |
519 break; | |
12478 | 520 case(3): |
521 for(i=0;i<len;i++) | |
522 store24bit(out, i, ((uint32_t*)in)[i]); | |
523 break; | |
8167 | 524 } |
525 break; | |
526 } | |
527 } | |
528 | |
529 static void float2int(void* in, void* out, int len, int bps) | |
530 { | |
531 register int i; | |
532 switch(bps){ | |
533 case(1): | |
534 for(i=0;i<len;i++) | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
535 ((int8_t*)out)[i]=(int8_t)lrintf(SCHAR_MAX*((float*)in)[i]); |
8167 | 536 break; |
537 case(2): | |
538 for(i=0;i<len;i++) | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
539 ((int16_t*)out)[i]=(int16_t)lrintf(SHRT_MAX*((float*)in)[i]); |
8167 | 540 break; |
12478 | 541 case(3): |
542 for(i=0;i<len;i++) | |
543 store24bit(out, i, (int32_t)lrintf(INT_MAX*((float*)in)[i])); | |
544 break; | |
8167 | 545 case(4): |
546 for(i=0;i<len;i++) | |
8180
4ba9aed295f2
Fixing segfault bug and addnig support for lrintf() in format conversion
anders
parents:
8167
diff
changeset
|
547 ((int32_t*)out)[i]=(int32_t)lrintf(INT_MAX*((float*)in)[i]); |
8167 | 548 break; |
549 } | |
550 } | |
551 | |
552 static void int2float(void* in, void* out, int len, int bps) | |
553 { | |
554 register int i; | |
555 switch(bps){ | |
556 case(1): | |
557 for(i=0;i<len;i++) | |
558 ((float*)out)[i]=(1.0/SCHAR_MAX)*((float)((int8_t*)in)[i]); | |
559 break; | |
560 case(2): | |
561 for(i=0;i<len;i++) | |
562 ((float*)out)[i]=(1.0/SHRT_MAX)*((float)((int16_t*)in)[i]); | |
563 break; | |
12478 | 564 case(3): |
565 for(i=0;i<len;i++) | |
566 ((float*)out)[i]=(1.0/INT_MAX)*((float)((int32_t)load24bit(in, i))); | |
567 break; | |
8167 | 568 case(4): |
569 for(i=0;i<len;i++) | |
570 ((float*)out)[i]=(1.0/INT_MAX)*((float)((int32_t*)in)[i]); | |
571 break; | |
572 } | |
573 } |