interpretor/lib/src/libsndfile-1.0.25/src/paf.c

   1 /*
   2 ** Copyright (C) 1999-2011 Erik de Castro Lopo <erikd@mega-nerd.com>
   3 **
   4 ** This program is free software; you can redistribute it and/or modify
   5 ** it under the terms of the GNU Lesser General Public License as published by
   6 ** the Free Software Foundation; either version 2.1 of the License, or
   7 ** (at your option) any later version.
   8 **
   9 ** This program is distributed in the hope that it will be useful,
  10 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12 ** GNU Lesser General Public License for more details.
  13 **
  14 ** You should have received a copy of the GNU Lesser General Public License
  15 ** along with this program; if not, write to the Free Software
  16 ** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  17 */
  18
  19 #include "sfconfig.h"
  20
  21 #include <stdio.h>
  22 #include <stdlib.h>
  23 #include <fcntl.h>
  24 #include <string.h>
  25 #include <ctype.h>
  26 #include <math.h>
  27
  28 #include "sndfile.h"
  29 #include "sfendian.h"
  30 #include "common.h"
  31
  32 /*------------------------------------------------------------------------------
  33 ** Macros to handle big/little endian issues.
  34 */
  35
  36 #define FAP_MARKER      (MAKE_MARKER ('f', 'a', 'p', ' '))
  37 #define PAF_MARKER      (MAKE_MARKER (' ', 'p', 'a', 'f'))
  38
  39 /*------------------------------------------------------------------------------
  40 ** Other defines.
  41 */
  42
  43 #define PAF_HEADER_LENGTH                       2048
  44
  45 #define PAF24_SAMPLES_PER_BLOCK         10
  46 #define PAF24_BLOCK_SIZE                        32
  47
  48 /*------------------------------------------------------------------------------
  49 ** Typedefs.
  50 */
  51
  52 typedef struct
  53 {       int     version ;
  54         int     endianness ;
  55     int samplerate ;
  56     int format ;
  57         int     channels ;
  58         int     source ;
  59 } PAF_FMT ;
  60
  61 typedef struct
  62 {       int                             max_blocks, channels, samplesperblock, blocksize ;
  63         int                             read_block, write_block, read_count, write_count ;
  64         sf_count_t              sample_count ;
  65         int                             *samples ;
  66         unsigned char   *block ;
  67 #if HAVE_FLEXIBLE_ARRAY
  68         int                             data [] ; /* ISO C99 struct flexible array. */
  69 #else
  70         int                             data [1] ; /* This is a hack and may not work. */
  71 #endif
  72 } PAF24_PRIVATE ;
  73
  74 /*------------------------------------------------------------------------------
  75 ** Private static functions.
  76 */
  77
  78 static int paf24_init (SF_PRIVATE *psf) ;
  79
  80 static int      paf_read_header (SF_PRIVATE *psf) ;
  81 static int      paf_write_header (SF_PRIVATE *psf, int calc_length) ;
  82
  83 static sf_count_t paf24_read_s (SF_PRIVATE *psf, short *ptr, sf_count_t len) ;
  84 static sf_count_t paf24_read_i (SF_PRIVATE *psf, int *ptr, sf_count_t len) ;
  85 static sf_count_t paf24_read_f (SF_PRIVATE *psf, float *ptr, sf_count_t len) ;
  86 static sf_count_t paf24_read_d (SF_PRIVATE *psf, double *ptr, sf_count_t len) ;
  87
  88 static sf_count_t paf24_write_s (SF_PRIVATE *psf, const short *ptr, sf_count_t len) ;
  89 static sf_count_t paf24_write_i (SF_PRIVATE *psf, const int *ptr, sf_count_t len) ;
  90 static sf_count_t paf24_write_f (SF_PRIVATE *psf, const float *ptr, sf_count_t len) ;
  91 static sf_count_t paf24_write_d (SF_PRIVATE *psf, const double *ptr, sf_count_t len) ;
  92
  93 static sf_count_t paf24_seek (SF_PRIVATE *psf, int mode, sf_count_t offset) ;
  94
  95 enum
  96 {       PAF_PCM_16 = 0,
  97         PAF_PCM_24 = 1,
  98         PAF_PCM_S8 = 2
  99 } ;
 100
 101 /*------------------------------------------------------------------------------
 102 ** Public function.
 103 */
 104
 105 int
 106 paf_open        (SF_PRIVATE *psf)
 107 {       int             subformat, error, endian ;
 108
 109         psf->dataoffset = PAF_HEADER_LENGTH ;
 110
 111         if (psf->file.mode == SFM_READ || (psf->file.mode == SFM_RDWR && psf->filelength > 0))
 112         {       if ((error = paf_read_header (psf)))
 113                         return error ;
 114                 } ;
 115
 116         subformat = SF_CODEC (psf->sf.format) ;
 117
 118         if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
 119         {       if ((SF_CONTAINER (psf->sf.format)) != SF_FORMAT_PAF)
 120                         return  SFE_BAD_OPEN_FORMAT ;
 121
 122                 endian = SF_ENDIAN (psf->sf.format) ;
 123
 124                 /* PAF is by default big endian. */
 125                 psf->endian = SF_ENDIAN_BIG ;
 126
 127                 if (endian == SF_ENDIAN_LITTLE || (CPU_IS_LITTLE_ENDIAN && (endian == SF_ENDIAN_CPU)))
 128                         psf->endian = SF_ENDIAN_LITTLE ;
 129
 130                 if ((error = paf_write_header (psf, SF_FALSE)))
 131                         return error ;
 132
 133                 psf->write_header = paf_write_header ;
 134                 } ;
 135
 136         switch (subformat)
 137         {       case SF_FORMAT_PCM_S8 :
 138                                         psf->bytewidth = 1 ;
 139                                         error = pcm_init (psf) ;
 140                                         break ;
 141
 142                 case SF_FORMAT_PCM_16 :
 143                                         psf->bytewidth = 2 ;
 144                                         error = pcm_init (psf) ;
 145                                         break ;
 146
 147                 case SF_FORMAT_PCM_24 :
 148                                         /* No bytewidth because of whacky 24 bit encoding. */
 149                                         error = paf24_init (psf) ;
 150                                         break ;
 151
 152                 default : return SFE_PAF_UNKNOWN_FORMAT ;
 153                 } ;
 154
 155         return error ;
 156 } /* paf_open */
 157
 158 /*------------------------------------------------------------------------------
 159 */
 160
 161 static int
 162 paf_read_header (SF_PRIVATE *psf)
 163 {       PAF_FMT         paf_fmt ;
 164         int                     marker ;
 165
 166         if (psf->filelength < PAF_HEADER_LENGTH)
 167                 return SFE_PAF_SHORT_HEADER ;
 168
 169         memset (&paf_fmt, 0, sizeof (paf_fmt)) ;
 170         psf_binheader_readf (psf, "pm", 0, &marker) ;
 171
 172         psf_log_printf (psf, "Signature   : '%M'\n", marker) ;
 173
 174         if (marker == PAF_MARKER)
 175         {       psf_binheader_readf (psf, "E444444", &(paf_fmt.version), &(paf_fmt.endianness),
 176                         &(paf_fmt.samplerate), &(paf_fmt.format), &(paf_fmt.channels), &(paf_fmt.source)) ;
 177                 }
 178         else if (marker == FAP_MARKER)
 179         {       psf_binheader_readf (psf, "e444444", &(paf_fmt.version), &(paf_fmt.endianness),
 180                         &(paf_fmt.samplerate), &(paf_fmt.format), &(paf_fmt.channels), &(paf_fmt.source)) ;
 181                 }
 182         else
 183                 return SFE_PAF_NO_MARKER ;
 184
 185         psf_log_printf (psf, "Version     : %d\n", paf_fmt.version) ;
 186
 187         if (paf_fmt.version != 0)
 188         {       psf_log_printf (psf, "*** Bad version number. should be zero.\n") ;
 189                 return SFE_PAF_VERSION ;
 190                 } ;
 191
 192         psf_log_printf (psf, "Sample Rate : %d\n", paf_fmt.samplerate) ;
 193         psf_log_printf (psf, "Channels    : %d\n", paf_fmt.channels) ;
 194
 195         psf_log_printf (psf, "Endianness  : %d => ", paf_fmt.endianness) ;
 196         if (paf_fmt.endianness)
 197         {       psf_log_printf (psf, "Little\n", paf_fmt.endianness) ;
 198                 psf->endian = SF_ENDIAN_LITTLE ;
 199                 }
 200         else
 201         {       psf_log_printf (psf, "Big\n", paf_fmt.endianness) ;
 202                 psf->endian = SF_ENDIAN_BIG ;
 203                 } ;
 204
 205         if (paf_fmt.channels > SF_MAX_CHANNELS)
 206                 return SFE_PAF_BAD_CHANNELS ;
 207
 208         psf->datalength = psf->filelength - psf->dataoffset ;
 209
 210         psf_binheader_readf (psf, "p", (int) psf->dataoffset) ;
 211
 212         psf->sf.samplerate      = paf_fmt.samplerate ;
 213         psf->sf.channels        = paf_fmt.channels ;
 214
 215         /* Only fill in type major. */
 216         psf->sf.format = SF_FORMAT_PAF ;
 217
 218         psf_log_printf (psf, "Format      : %d => ", paf_fmt.format) ;
 219
 220         /* PAF is by default big endian. */
 221         psf->sf.format |= paf_fmt.endianness ? SF_ENDIAN_LITTLE : SF_ENDIAN_BIG ;
 222
 223         switch (paf_fmt.format)
 224         {       case PAF_PCM_S8 :
 225                                         psf_log_printf (psf, "8 bit linear PCM\n") ;
 226                                         psf->bytewidth = 1 ;
 227
 228                                         psf->sf.format |= SF_FORMAT_PCM_S8 ;
 229
 230                                         psf->blockwidth = psf->bytewidth * psf->sf.channels ;
 231                                         psf->sf.frames = psf->datalength / psf->blockwidth ;
 232                                         break ;
 233
 234                 case PAF_PCM_16 :
 235                                         psf_log_printf (psf, "16 bit linear PCM\n") ;
 236                                         psf->bytewidth = 2 ;
 237
 238                                         psf->sf.format |= SF_FORMAT_PCM_16 ;
 239
 240                                         psf->blockwidth = psf->bytewidth * psf->sf.channels ;
 241                                         psf->sf.frames = psf->datalength / psf->blockwidth ;
 242                                         break ;
 243
 244                 case PAF_PCM_24 :
 245                                         psf_log_printf (psf, "24 bit linear PCM\n") ;
 246                                         psf->bytewidth = 3 ;
 247
 248                                         psf->sf.format |= SF_FORMAT_PCM_24 ;
 249
 250                                         psf->blockwidth = 0 ;
 251                                         psf->sf.frames = PAF24_SAMPLES_PER_BLOCK * psf->datalength /
 252                                                                                         (PAF24_BLOCK_SIZE * psf->sf.channels) ;
 253                                         break ;
 254
 255                 default :       psf_log_printf (psf, "Unknown\n") ;
 256                                         return SFE_PAF_UNKNOWN_FORMAT ;
 257                                         break ;
 258                 } ;
 259
 260         psf_log_printf (psf, "Source      : %d => ", paf_fmt.source) ;
 261
 262         switch (paf_fmt.source)
 263         {       case 1 : psf_log_printf (psf, "Analog Recording\n") ;
 264                                         break ;
 265                 case 2 : psf_log_printf (psf, "Digital Transfer\n") ;
 266                                         break ;
 267                 case 3 : psf_log_printf (psf, "Multi-track Mixdown\n") ;
 268                                         break ;
 269                 case 5 : psf_log_printf (psf, "Audio Resulting From DSP Processing\n") ;
 270                                         break ;
 271                 default : psf_log_printf (psf, "Unknown\n") ;
 272                                         break ;
 273                 } ;
 274
 275         return 0 ;
 276 } /* paf_read_header */
 277
 278 static int
 279 paf_write_header (SF_PRIVATE *psf, int UNUSED (calc_length))
 280 {       int                     paf_format ;
 281
 282         /* PAF header already written so no need to re-write. */
 283         if (psf_ftell (psf) >= PAF_HEADER_LENGTH)
 284                 return 0 ;
 285
 286         psf->dataoffset = PAF_HEADER_LENGTH ;
 287
 288         switch (SF_CODEC (psf->sf.format))
 289         {       case SF_FORMAT_PCM_S8 :
 290                                         paf_format = PAF_PCM_S8 ;
 291                                         break ;
 292
 293                 case SF_FORMAT_PCM_16 :
 294                                         paf_format = PAF_PCM_16 ;
 295                                         break ;
 296
 297                 case SF_FORMAT_PCM_24 :
 298                                         paf_format = PAF_PCM_24 ;
 299                                         break ;
 300
 301                 default : return SFE_PAF_UNKNOWN_FORMAT ;
 302                 } ;
 303
 304         /* Reset the current header length to zero. */
 305         psf->header [0] = 0 ;
 306         psf->headindex = 0 ;
 307
 308         if (psf->endian == SF_ENDIAN_BIG)
 309         {       /* Marker, version, endianness, samplerate */
 310                 psf_binheader_writef (psf, "Em444", PAF_MARKER, 0, 0, psf->sf.samplerate) ;
 311                 /* format, channels, source */
 312                 psf_binheader_writef (psf, "E444", paf_format, psf->sf.channels, 0) ;
 313                 }
 314         else if (psf->endian == SF_ENDIAN_LITTLE)
 315         {       /* Marker, version, endianness, samplerate */
 316                 psf_binheader_writef (psf, "em444", FAP_MARKER, 0, 1, psf->sf.samplerate) ;
 317                 /* format, channels, source */
 318                 psf_binheader_writef (psf, "e444", paf_format, psf->sf.channels, 0) ;
 319                 } ;
 320
 321         /* Zero fill to dataoffset. */
 322         psf_binheader_writef (psf, "z", (size_t) (psf->dataoffset - psf->headindex)) ;
 323
 324         psf_fwrite (psf->header, psf->headindex, 1, psf) ;
 325
 326         return psf->error ;
 327 } /* paf_write_header */
 328
 329 /*===============================================================================
 330 **      24 bit PAF files have a really weird encoding.
 331 **  For a mono file, 10 samples (each being 3 bytes) are packed into a 32 byte
 332 **      block. The 8 ints in this 32 byte block are then endian swapped (as ints)
 333 **      if necessary before being written to disk.
 334 **  For a stereo file, blocks of 10 samples from the same channel are encoded
 335 **  into 32 bytes as for the mono case. The 32 byte blocks are then interleaved
 336 **      on disk.
 337 **      Reading has to reverse the above process :-).
 338 **      Weird!!!
 339 **
 340 **      The code below attempts to gain efficiency while maintaining readability.
 341 */
 342
 343 static int paf24_read_block (SF_PRIVATE *psf, PAF24_PRIVATE *ppaf24) ;
 344 static int paf24_write_block (SF_PRIVATE *psf, PAF24_PRIVATE *ppaf24) ;
 345 static int paf24_close (SF_PRIVATE *psf) ;
 346
 347
 348 static int
 349 paf24_init (SF_PRIVATE *psf)
 350 {       PAF24_PRIVATE   *ppaf24 ;
 351         int     paf24size ;
 352
 353         paf24size = sizeof (PAF24_PRIVATE) + psf->sf.channels *
 354                                         (PAF24_BLOCK_SIZE + PAF24_SAMPLES_PER_BLOCK * sizeof (int)) ;
 355
 356         /*
 357         **      Not exatly sure why this needs to be here but the tests
 358         **      fail without it.
 359         */
 360         psf->last_op = 0 ;
 361
 362         if (! (psf->codec_data = calloc (1, paf24size)))
 363                 return SFE_MALLOC_FAILED ;
 364
 365         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 366
 367         ppaf24->channels        = psf->sf.channels ;
 368         ppaf24->samples         = ppaf24->data ;
 369         ppaf24->block           = (unsigned char*) (ppaf24->data + PAF24_SAMPLES_PER_BLOCK * ppaf24->channels) ;
 370
 371         ppaf24->blocksize = PAF24_BLOCK_SIZE * ppaf24->channels ;
 372         ppaf24->samplesperblock = PAF24_SAMPLES_PER_BLOCK ;
 373
 374         if (psf->file.mode == SFM_READ || psf->file.mode == SFM_RDWR)
 375         {       paf24_read_block (psf, ppaf24) ;        /* Read first block. */
 376
 377                 psf->read_short         = paf24_read_s ;
 378                 psf->read_int           = paf24_read_i ;
 379                 psf->read_float         = paf24_read_f ;
 380                 psf->read_double        = paf24_read_d ;
 381                 } ;
 382
 383         if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
 384         {       psf->write_short        = paf24_write_s ;
 385                 psf->write_int          = paf24_write_i ;
 386                 psf->write_float        = paf24_write_f ;
 387                 psf->write_double       = paf24_write_d ;
 388                 } ;
 389
 390         psf->seek       = paf24_seek ;
 391         psf->container_close    = paf24_close ;
 392
 393         psf->filelength = psf_get_filelen (psf) ;
 394         psf->datalength = psf->filelength - psf->dataoffset ;
 395
 396         if (psf->datalength % PAF24_BLOCK_SIZE)
 397         {       if (psf->file.mode == SFM_READ)
 398                         psf_log_printf (psf, "*** Warning : file seems to be truncated.\n") ;
 399                 ppaf24->max_blocks = psf->datalength / ppaf24->blocksize + 1 ;
 400                 }
 401         else
 402                 ppaf24->max_blocks = psf->datalength / ppaf24->blocksize ;
 403
 404         ppaf24->read_block = 0 ;
 405         if (psf->file.mode == SFM_RDWR)
 406                 ppaf24->write_block = ppaf24->max_blocks ;
 407         else
 408                 ppaf24->write_block = 0 ;
 409
 410         psf->sf.frames = ppaf24->samplesperblock * ppaf24->max_blocks ;
 411         ppaf24->sample_count = psf->sf.frames ;
 412
 413         return 0 ;
 414 } /* paf24_init */
 415
 416 static sf_count_t
 417 paf24_seek (SF_PRIVATE *psf, int mode, sf_count_t offset)
 418 {       PAF24_PRIVATE   *ppaf24 ;
 419         int                             newblock, newsample ;
 420
 421         if (psf->codec_data == NULL)
 422         {       psf->error = SFE_INTERNAL ;
 423                 return PSF_SEEK_ERROR ;
 424                 } ;
 425
 426         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 427
 428         if (mode == SFM_READ && ppaf24->write_count > 0)
 429                 paf24_write_block (psf, ppaf24) ;
 430
 431         newblock        = offset / ppaf24->samplesperblock ;
 432         newsample       = offset % ppaf24->samplesperblock ;
 433
 434         switch (mode)
 435         {       case SFM_READ :
 436                                 if (psf->last_op == SFM_WRITE && ppaf24->write_count)
 437                                         paf24_write_block (psf, ppaf24) ;
 438
 439                                 psf_fseek (psf, psf->dataoffset + newblock * ppaf24->blocksize, SEEK_SET) ;
 440                                 ppaf24->read_block = newblock ;
 441                                 paf24_read_block (psf, ppaf24) ;
 442                                 ppaf24->read_count = newsample ;
 443                                 break ;
 444
 445                 case SFM_WRITE :
 446                                 if (offset > ppaf24->sample_count)
 447                                 {       psf->error = SFE_BAD_SEEK ;
 448                                         return PSF_SEEK_ERROR ;
 449                                         } ;
 450
 451                                 if (psf->last_op == SFM_WRITE && ppaf24->write_count)
 452                                         paf24_write_block (psf, ppaf24) ;
 453
 454                                 psf_fseek (psf, psf->dataoffset + newblock * ppaf24->blocksize, SEEK_SET) ;
 455                                 ppaf24->write_block = newblock ;
 456                                 paf24_read_block (psf, ppaf24) ;
 457                                 ppaf24->write_count = newsample ;
 458                                 break ;
 459
 460                 default :
 461                                 psf->error = SFE_BAD_SEEK ;
 462                                 return PSF_SEEK_ERROR ;
 463                 } ;
 464
 465         return newblock * ppaf24->samplesperblock + newsample ;
 466 } /* paf24_seek */
 467
 468 static int
 469 paf24_close (SF_PRIVATE *psf)
 470 {       PAF24_PRIVATE *ppaf24 ;
 471
 472         if (psf->codec_data == NULL)
 473                 return 0 ;
 474
 475         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 476
 477         if (psf->file.mode == SFM_WRITE || psf->file.mode == SFM_RDWR)
 478         {       if (ppaf24->write_count > 0)
 479                         paf24_write_block (psf, ppaf24) ;
 480                 } ;
 481
 482         return 0 ;
 483 } /* paf24_close */
 484
 485 /*---------------------------------------------------------------------------
 486 */
 487 static int
 488 paf24_read_block (SF_PRIVATE *psf, PAF24_PRIVATE *ppaf24)
 489 {       int                             k, channel ;
 490         unsigned char   *cptr ;
 491
 492         ppaf24->read_block ++ ;
 493         ppaf24->read_count = 0 ;
 494
 495         if (ppaf24->read_block * ppaf24->samplesperblock > ppaf24->sample_count)
 496         {       memset (ppaf24->samples, 0, ppaf24->samplesperblock * ppaf24->channels) ;
 497                 return 1 ;
 498                 } ;
 499
 500         /* Read the block. */
 501         if ((k = psf_fread (ppaf24->block, 1, ppaf24->blocksize, psf)) != ppaf24->blocksize)
 502                 psf_log_printf (psf, "*** Warning : short read (%d != %d).\n", k, ppaf24->blocksize) ;
 503
 504
 505         if (CPU_IS_LITTLE_ENDIAN)
 506         {       /* Do endian swapping if necessary. */
 507                 if (psf->endian == SF_ENDIAN_BIG)
 508                         endswap_int_array       (ppaf24->data, 8 * ppaf24->channels) ;
 509
 510                 /* Unpack block. */
 511                 for (k = 0 ; k < PAF24_SAMPLES_PER_BLOCK * ppaf24->channels ; k++)
 512                 {       channel = k % ppaf24->channels ;
 513                         cptr = ppaf24->block + PAF24_BLOCK_SIZE * channel + 3 * (k / ppaf24->channels) ;
 514                         ppaf24->samples [k] = (cptr [0] << 8) | (cptr [1] << 16) | (cptr [2] << 24) ;
 515                         } ;
 516                 }
 517         else
 518         {       /* Do endian swapping if necessary. */
 519                 if (psf->endian == SF_ENDIAN_BIG)
 520                         endswap_int_array       (ppaf24->data, 8 * ppaf24->channels) ;
 521
 522                 /* Unpack block. */
 523                 for (k = 0 ; k < PAF24_SAMPLES_PER_BLOCK * ppaf24->channels ; k++)
 524                 {       channel = k % ppaf24->channels ;
 525                         cptr = ppaf24->block + PAF24_BLOCK_SIZE * channel + 3 * (k / ppaf24->channels) ;
 526                         ppaf24->samples [k] = (cptr [0] << 8) | (cptr [1] << 16) | (cptr [2] << 24) ;
 527                         } ;
 528                 } ;
 529
 530         return 1 ;
 531 } /* paf24_read_block */
 532
 533 static int
 534 paf24_read (SF_PRIVATE *psf, PAF24_PRIVATE *ppaf24, int *ptr, int len)
 535 {       int     count, total = 0 ;
 536
 537         while (total < len)
 538         {       if (ppaf24->read_block * ppaf24->samplesperblock >= ppaf24->sample_count)
 539                 {       memset (&(ptr [total]), 0, (len - total) * sizeof (int)) ;
 540                         return total ;
 541                         } ;
 542
 543                 if (ppaf24->read_count >= ppaf24->samplesperblock)
 544                         paf24_read_block (psf, ppaf24) ;
 545
 546                 count = (ppaf24->samplesperblock - ppaf24->read_count) * ppaf24->channels ;
 547                 count = (len - total > count) ? count : len - total ;
 548
 549                 memcpy (&(ptr [total]), &(ppaf24->samples [ppaf24->read_count * ppaf24->channels]), count * sizeof (int)) ;
 550                 total += count ;
 551                 ppaf24->read_count += count / ppaf24->channels ;
 552                 } ;
 553
 554         return total ;
 555 } /* paf24_read */
 556
 557 static sf_count_t
 558 paf24_read_s (SF_PRIVATE *psf, short *ptr, sf_count_t len)
 559 {       PAF24_PRIVATE   *ppaf24 ;
 560         int                             *iptr ;
 561         int                             k, bufferlen, readcount, count ;
 562         sf_count_t              total = 0 ;
 563
 564         if (psf->codec_data == NULL)
 565                 return 0 ;
 566         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 567
 568         iptr = psf->u.ibuf ;
 569         bufferlen = ARRAY_LEN (psf->u.ibuf) ;
 570         while (len > 0)
 571         {       readcount = (len >= bufferlen) ? bufferlen : len ;
 572                 count = paf24_read (psf, ppaf24, iptr, readcount) ;
 573                 for (k = 0 ; k < readcount ; k++)
 574                         ptr [total + k] = iptr [k] >> 16 ;
 575                 total += count ;
 576                 len -= readcount ;
 577                 } ;
 578         return total ;
 579 } /* paf24_read_s */
 580
 581 static sf_count_t
 582 paf24_read_i (SF_PRIVATE *psf, int *ptr, sf_count_t len)
 583 {       PAF24_PRIVATE *ppaf24 ;
 584         int                             total ;
 585
 586         if (psf->codec_data == NULL)
 587                 return 0 ;
 588         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 589
 590         total = paf24_read (psf, ppaf24, ptr, len) ;
 591
 592         return total ;
 593 } /* paf24_read_i */
 594
 595 static sf_count_t
 596 paf24_read_f (SF_PRIVATE *psf, float *ptr, sf_count_t len)
 597 {       PAF24_PRIVATE   *ppaf24 ;
 598         int                             *iptr ;
 599         int                             k, bufferlen, readcount, count ;
 600         sf_count_t              total = 0 ;
 601         float                   normfact ;
 602
 603         if (psf->codec_data == NULL)
 604                 return 0 ;
 605         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 606
 607         normfact = (psf->norm_float == SF_TRUE) ? (1.0 / 0x80000000) : (1.0 / 0x100) ;
 608
 609         iptr = psf->u.ibuf ;
 610         bufferlen = ARRAY_LEN (psf->u.ibuf) ;
 611         while (len > 0)
 612         {       readcount = (len >= bufferlen) ? bufferlen : len ;
 613                 count = paf24_read (psf, ppaf24, iptr, readcount) ;
 614                 for (k = 0 ; k < readcount ; k++)
 615                         ptr [total + k] = normfact * iptr [k] ;
 616                 total += count ;
 617                 len -= readcount ;
 618                 } ;
 619         return total ;
 620 } /* paf24_read_f */
 621
 622 static sf_count_t
 623 paf24_read_d (SF_PRIVATE *psf, double *ptr, sf_count_t len)
 624 {       PAF24_PRIVATE   *ppaf24 ;
 625         int                             *iptr ;
 626         int                             k, bufferlen, readcount, count ;
 627         sf_count_t              total = 0 ;
 628         double                  normfact ;
 629
 630         if (psf->codec_data == NULL)
 631                 return 0 ;
 632         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 633
 634         normfact = (psf->norm_double == SF_TRUE) ? (1.0 / 0x80000000) : (1.0 / 0x100) ;
 635
 636         iptr = psf->u.ibuf ;
 637         bufferlen = ARRAY_LEN (psf->u.ibuf) ;
 638         while (len > 0)
 639         {       readcount = (len >= bufferlen) ? bufferlen : len ;
 640                 count = paf24_read (psf, ppaf24, iptr, readcount) ;
 641                 for (k = 0 ; k < readcount ; k++)
 642                         ptr [total + k] = normfact * iptr [k] ;
 643                 total += count ;
 644                 len -= readcount ;
 645                 } ;
 646         return total ;
 647 } /* paf24_read_d */
 648
 649 /*---------------------------------------------------------------------------
 650 */
 651
 652 static int
 653 paf24_write_block (SF_PRIVATE *psf, PAF24_PRIVATE *ppaf24)
 654 {       int                             k, nextsample, channel ;
 655         unsigned char   *cptr ;
 656
 657         /* First pack block. */
 658
 659         if (CPU_IS_LITTLE_ENDIAN)
 660         {       for (k = 0 ; k < PAF24_SAMPLES_PER_BLOCK * ppaf24->channels ; k++)
 661                 {       channel = k % ppaf24->channels ;
 662                         cptr = ppaf24->block + PAF24_BLOCK_SIZE * channel + 3 * (k / ppaf24->channels) ;
 663                         nextsample = ppaf24->samples [k] >> 8 ;
 664                         cptr [0] = nextsample ;
 665                         cptr [1] = nextsample >> 8 ;
 666                         cptr [2] = nextsample >> 16 ;
 667                         } ;
 668
 669                 /* Do endian swapping if necessary. */
 670                 if (psf->endian == SF_ENDIAN_BIG)
 671                         endswap_int_array (ppaf24->data, 8 * ppaf24->channels) ;
 672                 }
 673         else if (CPU_IS_BIG_ENDIAN)
 674         {       /* This is correct. */
 675                 for (k = 0 ; k < PAF24_SAMPLES_PER_BLOCK * ppaf24->channels ; k++)
 676                 {       channel = k % ppaf24->channels ;
 677                         cptr = ppaf24->block + PAF24_BLOCK_SIZE * channel + 3 * (k / ppaf24->channels) ;
 678                         nextsample = ppaf24->samples [k] >> 8 ;
 679                         cptr [0] = nextsample ;
 680                         cptr [1] = nextsample >> 8 ;
 681                         cptr [2] = nextsample >> 16 ;
 682                         } ;
 683                 if (psf->endian == SF_ENDIAN_BIG)
 684                         endswap_int_array (ppaf24->data, 8 * ppaf24->channels) ;
 685                 } ;
 686
 687         /* Write block to disk. */
 688         if ((k = psf_fwrite (ppaf24->block, 1, ppaf24->blocksize, psf)) != ppaf24->blocksize)
 689                 psf_log_printf (psf, "*** Warning : short write (%d != %d).\n", k, ppaf24->blocksize) ;
 690
 691         if (ppaf24->sample_count < ppaf24->write_block * ppaf24->samplesperblock + ppaf24->write_count)
 692                 ppaf24->sample_count = ppaf24->write_block * ppaf24->samplesperblock + ppaf24->write_count ;
 693
 694         if (ppaf24->write_count == ppaf24->samplesperblock)
 695         {       ppaf24->write_block ++ ;
 696                 ppaf24->write_count = 0 ;
 697                 } ;
 698
 699         return 1 ;
 700 } /* paf24_write_block */
 701
 702 static int
 703 paf24_write (SF_PRIVATE *psf, PAF24_PRIVATE *ppaf24, const int *ptr, int len)
 704 {       int             count, total = 0 ;
 705
 706         while (total < len)
 707         {       count = (ppaf24->samplesperblock - ppaf24->write_count) * ppaf24->channels ;
 708
 709                 if (count > len - total)
 710                         count = len - total ;
 711
 712                 memcpy (&(ppaf24->samples [ppaf24->write_count * ppaf24->channels]), &(ptr [total]), count * sizeof (int)) ;
 713                 total += count ;
 714                 ppaf24->write_count += count / ppaf24->channels ;
 715
 716                 if (ppaf24->write_count >= ppaf24->samplesperblock)
 717                         paf24_write_block (psf, ppaf24) ;
 718                 } ;
 719
 720         return total ;
 721 } /* paf24_write */
 722
 723 static sf_count_t
 724 paf24_write_s (SF_PRIVATE *psf, const short *ptr, sf_count_t len)
 725 {       PAF24_PRIVATE   *ppaf24 ;
 726         int                             *iptr ;
 727         int                             k, bufferlen, writecount = 0, count ;
 728         sf_count_t              total = 0 ;
 729
 730         if (psf->codec_data == NULL)
 731                 return 0 ;
 732         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 733
 734         iptr = psf->u.ibuf ;
 735         bufferlen = ARRAY_LEN (psf->u.ibuf) ;
 736         while (len > 0)
 737         {       writecount = (len >= bufferlen) ? bufferlen : len ;
 738                 for (k = 0 ; k < writecount ; k++)
 739                         iptr [k] = ptr [total + k] << 16 ;
 740                 count = paf24_write (psf, ppaf24, iptr, writecount) ;
 741                 total += count ;
 742                 len -= writecount ;
 743                 if (count != writecount)
 744                         break ;
 745                 } ;
 746         return total ;
 747 } /* paf24_write_s */
 748
 749 static sf_count_t
 750 paf24_write_i (SF_PRIVATE *psf, const int *ptr, sf_count_t len)
 751 {       PAF24_PRIVATE   *ppaf24 ;
 752         int                             writecount, count ;
 753         sf_count_t              total = 0 ;
 754
 755         if (psf->codec_data == NULL)
 756                 return 0 ;
 757         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 758
 759         while (len > 0)
 760         {       writecount = (len > 0x10000000) ? 0x10000000 : (int) len ;
 761
 762                 count = paf24_write (psf, ppaf24, ptr, writecount) ;
 763
 764                 total += count ;
 765                 len -= count ;
 766                 if (count != writecount)
 767                         break ;
 768                 } ;
 769
 770         return total ;
 771 } /* paf24_write_i */
 772
 773 static sf_count_t
 774 paf24_write_f (SF_PRIVATE *psf, const float *ptr, sf_count_t len)
 775 {       PAF24_PRIVATE   *ppaf24 ;
 776         int                             *iptr ;
 777         int                             k, bufferlen, writecount = 0, count ;
 778         sf_count_t              total = 0 ;
 779         float                   normfact ;
 780
 781         if (psf->codec_data == NULL)
 782                 return 0 ;
 783         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 784
 785         normfact = (psf->norm_float == SF_TRUE) ? (1.0 * 0x7FFFFFFF) : (1.0 / 0x100) ;
 786
 787         iptr = psf->u.ibuf ;
 788         bufferlen = ARRAY_LEN (psf->u.ibuf) ;
 789         while (len > 0)
 790         {       writecount = (len >= bufferlen) ? bufferlen : len ;
 791                 for (k = 0 ; k < writecount ; k++)
 792                         iptr [k] = lrintf (normfact * ptr [total + k]) ;
 793                 count = paf24_write (psf, ppaf24, iptr, writecount) ;
 794                 total += count ;
 795                 len -= writecount ;
 796                 if (count != writecount)
 797                         break ;
 798                 } ;
 799
 800         return total ;
 801 } /* paf24_write_f */
 802
 803 static sf_count_t
 804 paf24_write_d (SF_PRIVATE *psf, const double *ptr, sf_count_t len)
 805 {       PAF24_PRIVATE   *ppaf24 ;
 806         int                             *iptr ;
 807         int                             k, bufferlen, writecount = 0, count ;
 808         sf_count_t              total = 0 ;
 809         double                  normfact ;
 810
 811         if (psf->codec_data == NULL)
 812                 return 0 ;
 813         ppaf24 = (PAF24_PRIVATE*) psf->codec_data ;
 814
 815         normfact = (psf->norm_double == SF_TRUE) ? (1.0 * 0x7FFFFFFF) : (1.0 / 0x100) ;
 816
 817         iptr = psf->u.ibuf ;
 818         bufferlen = ARRAY_LEN (psf->u.ibuf) ;
 819         while (len > 0)
 820         {       writecount = (len >= bufferlen) ? bufferlen : len ;
 821                 for (k = 0 ; k < writecount ; k++)
 822                         iptr [k] = lrint (normfact * ptr [total+k]) ;
 823                 count = paf24_write (psf, ppaf24, iptr, writecount) ;
 824                 total += count ;
 825                 len -= writecount ;
 826                 if (count != writecount)
 827                         break ;
 828                 } ;
 829
 830         return total ;
 831 } /* paf24_write_d */
 832