mirror of
https://github.com/tuxbox-neutrino/libstb-hal.git
synced 2025-08-26 15:02:58 +02:00
900c92a67e
Origin commit data
------------------
Commit: 0737aa3ba6
Author: vanhofen <vanhofen@gmx.de>
Date: 2024-03-25 (Mon, 25 Mar 2024)
Origin message was:
------------------
- addition to "small fix"
------------------
No further description and justification available within origin commit message!
------------------
This commit was generated by Migit
358 lines
8.2 KiB
C
358 lines
8.2 KiB
C
/*
|
|
* linuxdvb output/writer handling.
|
|
*
|
|
* konfetti 2010 based on linuxdvb.c code from libeplayer2
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
*/
|
|
|
|
/* ***************************** */
|
|
/* Includes */
|
|
/* ***************************** */
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/uio.h>
|
|
#include <linux/dvb/video.h>
|
|
#include <linux/dvb/audio.h>
|
|
#include <memory.h>
|
|
#include <asm/types.h>
|
|
#include <pthread.h>
|
|
#include <errno.h>
|
|
|
|
#include <libavcodec/avcodec.h>
|
|
|
|
#include "stm_ioctls.h"
|
|
#include "common.h"
|
|
#include "output.h"
|
|
#include "debug.h"
|
|
#include "misc.h"
|
|
#include "pes.h"
|
|
#include "writer.h"
|
|
#include "pcm.h"
|
|
|
|
/* ***************************** */
|
|
/* Makros/Constants */
|
|
/* ***************************** */
|
|
|
|
/* ***************************** */
|
|
/* Types */
|
|
/* ***************************** */
|
|
|
|
/* ***************************** */
|
|
/* Variables */
|
|
/* ***************************** */
|
|
|
|
static int32_t initialHeader = 1;
|
|
static uint32_t SubFrameLen = 0;
|
|
static uint32_t SubFramesPerPES = 0;
|
|
|
|
// reference: search for TypeLpcmDVDAudio in player/frame_parser/frame_parser_audio_lpcm.cpp
|
|
static const uint8_t clpcm_prv[14] =
|
|
{
|
|
0xA0, //sub_stream_id
|
|
0, 0, //resvd and UPC_EAN_ISRC stuff, unused
|
|
0x0A, //private header length
|
|
0, 9, //first_access_unit_pointer
|
|
0x00, //emph,rsvd,stereo,downmix
|
|
0x0F, //quantisation word length 1,2
|
|
0x0F, //audio sampling freqency 1,2
|
|
0, //resvd, multi channel type
|
|
0, //bit shift on channel GR2, assignment
|
|
0x80, //dynamic range control
|
|
0, 0 //resvd for copyright management
|
|
};
|
|
|
|
static uint8_t lpcm_prv[14];
|
|
static uint8_t breakBuffer[8192];
|
|
static uint32_t breakBufferFillSize = 0;
|
|
|
|
/* ***************************** */
|
|
/* Prototypes */
|
|
/* ***************************** */
|
|
|
|
/* ***************************** */
|
|
/* MISC Functions */
|
|
/* ***************************** */
|
|
|
|
static int32_t prepareClipPlay(int32_t uNoOfChannels, int32_t uSampleRate, int32_t uBitsPerSample, uint8_t bLittleEndian __attribute__((unused)))
|
|
{
|
|
printf("rate: %d ch: %d bits: %d (%d bps)\n",
|
|
uSampleRate/*Format->dwSamplesPerSec*/,
|
|
uNoOfChannels/*Format->wChannels*/,
|
|
uBitsPerSample/*Format->wBitsPerSample*/,
|
|
(uBitsPerSample/*Format->wBitsPerSample*/ / 8)
|
|
);
|
|
|
|
SubFrameLen = 0;
|
|
SubFramesPerPES = 0;
|
|
breakBufferFillSize = 0;
|
|
|
|
memcpy(lpcm_prv, clpcm_prv, sizeof(lpcm_prv));
|
|
|
|
//figure out size of subframe
|
|
//and set up sample rate
|
|
switch (uSampleRate)
|
|
{
|
|
case 48000:
|
|
SubFrameLen = 40;
|
|
break;
|
|
case 96000:
|
|
lpcm_prv[8] |= 0x10;
|
|
SubFrameLen = 80;
|
|
break;
|
|
case 192000:
|
|
lpcm_prv[8] |= 0x20;
|
|
SubFrameLen = 160;
|
|
break;
|
|
case 44100:
|
|
lpcm_prv[8] |= 0x80;
|
|
SubFrameLen = 40;
|
|
break;
|
|
case 88200:
|
|
lpcm_prv[8] |= 0x90;
|
|
SubFrameLen = 80;
|
|
break;
|
|
case 176400:
|
|
lpcm_prv[8] |= 0xA0;
|
|
SubFrameLen = 160;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
SubFrameLen *= uNoOfChannels;
|
|
SubFrameLen *= (uBitsPerSample / 8);
|
|
|
|
//rewrite PES size to have as many complete subframes per PES as we can
|
|
// FIXME: PES header size was hardcoded to 18 in previous code. Actual size returned by InsertPesHeader is 14.
|
|
SubFramesPerPES = ((2048 - 18) - sizeof(lpcm_prv)) / SubFrameLen;
|
|
SubFrameLen *= SubFramesPerPES;
|
|
|
|
//set number of channels
|
|
lpcm_prv[10] = uNoOfChannels - 1;
|
|
|
|
switch (uBitsPerSample)
|
|
{
|
|
case 24:
|
|
lpcm_prv[7] |= 0x20;
|
|
case 16:
|
|
break;
|
|
default:
|
|
printf("inappropriate bits per sample (%d) - must be 16 or 24\n", uBitsPerSample);
|
|
return 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int32_t reset()
|
|
{
|
|
initialHeader = 1;
|
|
return 0;
|
|
}
|
|
|
|
static int32_t writeData(void *_call)
|
|
{
|
|
WriterAVCallData_t *call = (WriterAVCallData_t *) _call;
|
|
|
|
unsigned char PesHeader[PES_MAX_HEADER_SIZE];
|
|
|
|
pcm_printf(10, "\n");
|
|
|
|
if (!call)
|
|
{
|
|
pcm_err("call data is NULL...\n");
|
|
return 0;
|
|
}
|
|
|
|
pcm_printf(10, "AudioPts %lld\n", call->Pts);
|
|
|
|
if (!call->data || (call->len <= 0))
|
|
{
|
|
pcm_err("parsing NULL Data. ignoring...\n");
|
|
return 0;
|
|
}
|
|
|
|
if (call->fd < 0)
|
|
{
|
|
pcm_err("file pointer < 0. ignoring ...\n");
|
|
return 0;
|
|
}
|
|
|
|
pcmPrivateData_t *pcmPrivateData = (pcmPrivateData_t *)call->private_data;
|
|
|
|
if (initialHeader)
|
|
{
|
|
uint32_t codecID = (uint32_t)pcmPrivateData->codec_id;
|
|
uint8_t LE = 0;
|
|
switch (codecID)
|
|
{
|
|
case AV_CODEC_ID_PCM_S8:
|
|
case AV_CODEC_ID_PCM_U8:
|
|
break;
|
|
case AV_CODEC_ID_PCM_S16LE:
|
|
case AV_CODEC_ID_PCM_U16LE:
|
|
LE = 1;
|
|
case AV_CODEC_ID_PCM_S16BE:
|
|
case AV_CODEC_ID_PCM_U16BE:
|
|
break;
|
|
case AV_CODEC_ID_PCM_S24LE:
|
|
case AV_CODEC_ID_PCM_U24LE:
|
|
LE = 1;
|
|
case AV_CODEC_ID_PCM_S24BE:
|
|
case AV_CODEC_ID_PCM_U24BE:
|
|
break;
|
|
case AV_CODEC_ID_PCM_S32LE:
|
|
case AV_CODEC_ID_PCM_U32LE:
|
|
LE = 1;
|
|
case AV_CODEC_ID_PCM_S32BE:
|
|
case AV_CODEC_ID_PCM_U32BE:
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
initialHeader = 0;
|
|
prepareClipPlay(pcmPrivateData->channels, pcmPrivateData->sample_rate, pcmPrivateData->bits_per_coded_sample, LE);
|
|
}
|
|
|
|
uint8_t *buffer = call->data;
|
|
uint32_t size = call->len;
|
|
|
|
uint32_t n;
|
|
uint8_t *injectBuffer = malloc(SubFrameLen);
|
|
uint32_t pos;
|
|
|
|
for (pos = 0; pos < size;)
|
|
{
|
|
//printf("PCM %s - Position=%d\n", __FUNCTION__, pos);
|
|
if ((size - pos) < SubFrameLen)
|
|
{
|
|
breakBufferFillSize = size - pos;
|
|
memcpy(breakBuffer, &buffer[pos], sizeof(uint8_t) * breakBufferFillSize);
|
|
//printf("PCM %s - Unplayed=%d\n", __FUNCTION__, breakBufferFillSize);
|
|
break;
|
|
}
|
|
|
|
//get first PES's worth
|
|
if (breakBufferFillSize > 0)
|
|
{
|
|
memcpy(injectBuffer, breakBuffer, sizeof(uint8_t)*breakBufferFillSize);
|
|
memcpy(&injectBuffer[breakBufferFillSize], &buffer[pos], sizeof(unsigned char) * (SubFrameLen - breakBufferFillSize));
|
|
pos += (SubFrameLen - breakBufferFillSize);
|
|
breakBufferFillSize = 0;
|
|
}
|
|
else
|
|
{
|
|
memcpy(injectBuffer, &buffer[pos], sizeof(uint8_t)*SubFrameLen);
|
|
pos += SubFrameLen;
|
|
}
|
|
|
|
struct iovec iov[3];
|
|
iov[0].iov_base = PesHeader;
|
|
iov[1].iov_base = lpcm_prv;
|
|
iov[1].iov_len = sizeof(lpcm_prv);
|
|
|
|
iov[2].iov_base = injectBuffer;
|
|
iov[2].iov_len = SubFrameLen;
|
|
|
|
//write the PCM data
|
|
if (pcmPrivateData->bits_per_coded_sample == 16)
|
|
{
|
|
for (n = 0; n < SubFrameLen; n += 2)
|
|
{
|
|
uint8_t tmp;
|
|
tmp = injectBuffer[n];
|
|
injectBuffer[n] = injectBuffer[n + 1];
|
|
injectBuffer[n + 1] = tmp;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
// 0 1 2 3 4 5 6 7 8 9 10 11
|
|
// A1c A1b A1a-B1c B1b B1a-A2c A2b A2a-B2c B2b B2a
|
|
// to A1a A1b B1a B1b.A2a A2b B2a B2b-A1c B1c A2c B2c
|
|
for (n = 0; n < SubFrameLen; n += 12)
|
|
{
|
|
unsigned char t, *p = &injectBuffer[n];
|
|
t = p[0];
|
|
p[ 0] = p[ 2];
|
|
p[ 2] = p[ 5];
|
|
p[ 5] = p[ 7];
|
|
p[ 7] = p[11];
|
|
p[11] = p[ 9];
|
|
p[ 9] = p[ 3];
|
|
p[ 3] = p[ 4];
|
|
p[ 4] = p[ 8];
|
|
p[ 8] = t;
|
|
}
|
|
}
|
|
|
|
//increment err... subframe count?
|
|
lpcm_prv[1] = ((lpcm_prv[1] + SubFramesPerPES) & 0x1F);
|
|
|
|
iov[0].iov_len = InsertPesHeader(PesHeader, iov[1].iov_len + iov[2].iov_len, PCM_PES_START_CODE, call->Pts, 0);
|
|
int32_t len = call->WriteV(call->fd, iov, 3);
|
|
if (len < 0)
|
|
{
|
|
break;
|
|
}
|
|
}
|
|
free(injectBuffer);
|
|
|
|
return size;
|
|
}
|
|
|
|
/* ***************************** */
|
|
/* Writer Definition */
|
|
/* ***************************** */
|
|
|
|
static WriterCaps_t caps_pcm =
|
|
{
|
|
"pcm",
|
|
eAudio,
|
|
"A_PCM",
|
|
AUDIO_ENCODING_LPCMA
|
|
};
|
|
|
|
struct Writer_s WriterAudioPCM =
|
|
{
|
|
&reset,
|
|
&writeData,
|
|
&caps_pcm
|
|
};
|
|
|
|
static WriterCaps_t caps_ipcm =
|
|
{
|
|
"ipcm",
|
|
eAudio,
|
|
"A_IPCM",
|
|
AUDIO_ENCODING_LPCMA
|
|
};
|
|
|
|
struct Writer_s WriterAudioIPCM =
|
|
{
|
|
&reset,
|
|
&writeData,
|
|
&caps_ipcm
|
|
};
|