359 lines
14 KiB
C
359 lines
14 KiB
C
#include <stdlib.h> /* malloc */
|
|
#include <pthread.h> /* posix only, to be replaced by a more portable version */
|
|
#include "zstd_internal.h" /* MIN, ERROR */
|
|
#include "zstdmt_compress.h"
|
|
|
|
#if 0
|
|
# include <stdio.h>
|
|
# include <unistd.h>
|
|
# include <sys/times.h>
|
|
static unsigned g_debugLevel = 2;
|
|
# define DEBUGLOG(l, ...) if (l<=g_debugLevel) { fprintf(stderr, __VA_ARGS__); fprintf(stderr, " \n"); }
|
|
|
|
static unsigned long long GetCurrentClockTimeMicroseconds()
|
|
{
|
|
static clock_t _ticksPerSecond = 0;
|
|
if (_ticksPerSecond <= 0) _ticksPerSecond = sysconf(_SC_CLK_TCK);
|
|
|
|
struct tms junk; clock_t newTicks = (clock_t) times(&junk);
|
|
return ((((unsigned long long)newTicks)*(1000000))/_ticksPerSecond);
|
|
}
|
|
|
|
#define MUTEX_WAIT_TIME_DLEVEL 5
|
|
#define PTHREAD_MUTEX_LOCK(mutex) \
|
|
if (g_debugLevel>=MUTEX_WAIT_TIME_DLEVEL) { \
|
|
unsigned long long beforeTime = GetCurrentClockTimeMicroseconds(); \
|
|
pthread_mutex_lock(mutex); \
|
|
unsigned long long afterTime = GetCurrentClockTimeMicroseconds(); \
|
|
unsigned long long elapsedTime = (afterTime-beforeTime); \
|
|
if (elapsedTime > 1000) { /* or whatever threshold you like; I'm using 1 millisecond here */ \
|
|
DEBUGLOG(MUTEX_WAIT_TIME_DLEVEL, "Thread %li took %llu microseconds to acquire mutex %s \n", \
|
|
(long int) pthread_self(), elapsedTime, #mutex); \
|
|
} \
|
|
} else pthread_mutex_lock(mutex);
|
|
|
|
#else
|
|
|
|
# define DEBUGLOG(l, ...) /* disabled */
|
|
# define PTHREAD_MUTEX_LOCK(m) pthread_mutex_lock(m)
|
|
|
|
#endif
|
|
|
|
|
|
#define ZSTDMT_NBTHREADS_MAX 128
|
|
#define ZSTDMT_NBSTACKEDFRAMES_MAX (2*ZSTDMT_NBTHREADS_MAX)
|
|
|
|
typedef struct frameToWrite_s {
|
|
const void* start;
|
|
size_t frameSize;
|
|
unsigned frameID;
|
|
unsigned isLastFrame;
|
|
} frameToWrite_t;
|
|
|
|
typedef struct ZSTDMT_dstBuffer_s {
|
|
ZSTD_outBuffer out;
|
|
unsigned frameIDToWrite;
|
|
pthread_mutex_t frameTable_mutex;
|
|
pthread_mutex_t allFramesWritten_mutex;
|
|
frameToWrite_t stackedFrame[ZSTDMT_NBSTACKEDFRAMES_MAX];
|
|
unsigned nbStackedFrames;
|
|
} ZSTDMT_dstBufferManager;
|
|
|
|
static ZSTDMT_dstBufferManager ZSTDMT_createDstBufferManager(void* dst, size_t dstCapacity)
|
|
{
|
|
ZSTDMT_dstBufferManager dbm;
|
|
dbm.out.dst = dst;
|
|
dbm.out.size = dstCapacity;
|
|
dbm.out.pos = 0;
|
|
dbm.frameIDToWrite = 0;
|
|
pthread_mutex_init(&dbm.frameTable_mutex, NULL);
|
|
pthread_mutex_t* const allFramesWritten_mutex = &dbm.allFramesWritten_mutex;
|
|
pthread_mutex_init(allFramesWritten_mutex, NULL);
|
|
PTHREAD_MUTEX_LOCK(allFramesWritten_mutex); /* maybe could be merged into init ? */
|
|
dbm.nbStackedFrames = 0;
|
|
return dbm;
|
|
}
|
|
|
|
/* note : can fail if nbStackedFrames > ZSTDMT_NBSTACKEDFRAMES_MAX.
|
|
* note2 : can only be called from a section with frameTable_mutex already locked */
|
|
static void ZSTDMT_stackFrameToWrite(ZSTDMT_dstBufferManager* dstBufferManager, frameToWrite_t frame) {
|
|
dstBufferManager->stackedFrame[dstBufferManager->nbStackedFrames++] = frame;
|
|
}
|
|
|
|
|
|
typedef struct buffer_s {
|
|
void* start;
|
|
size_t bufferSize;
|
|
} buffer_t;
|
|
|
|
static buffer_t ZSTDMT_getDstBuffer(const ZSTDMT_dstBufferManager* dstBufferManager)
|
|
{
|
|
ZSTD_outBuffer const out = dstBufferManager->out;
|
|
buffer_t buf;
|
|
buf.start = (char*)(out.dst) + out.pos;
|
|
buf.bufferSize = out.size - out.pos;
|
|
return buf;
|
|
}
|
|
|
|
/* condition : stackNumber < dstBufferManager->nbStackedFrames.
|
|
* note : there can only be one write at a time, due to frameID condition */
|
|
static size_t ZSTDMT_writeFrame(ZSTDMT_dstBufferManager* dstBufferManager, unsigned stackNumber)
|
|
{
|
|
ZSTD_outBuffer const out = dstBufferManager->out;
|
|
size_t const frameSize = dstBufferManager->stackedFrame[stackNumber].frameSize;
|
|
const void* const frameStart = dstBufferManager->stackedFrame[stackNumber].start;
|
|
if (out.pos + frameSize > out.size)
|
|
return ERROR(dstSize_tooSmall);
|
|
DEBUGLOG(3, "writing frame %u (%u bytes) ", dstBufferManager->stackedFrame[stackNumber].frameID, (U32)frameSize);
|
|
memcpy((char*)out.dst + out.pos, frameStart, frameSize);
|
|
dstBufferManager->out.pos += frameSize;
|
|
dstBufferManager->frameIDToWrite = dstBufferManager->stackedFrame[stackNumber].frameID + 1;
|
|
return 0;
|
|
}
|
|
|
|
static size_t ZSTDMT_tryWriteFrame(ZSTDMT_dstBufferManager* dstBufferManager,
|
|
const void* src, size_t srcSize,
|
|
unsigned frameID, unsigned isLastFrame)
|
|
{
|
|
unsigned lastFrameWritten = 0;
|
|
|
|
/* check if correct frame ordering; stack otherwise */
|
|
DEBUGLOG(5, "considering writing frame %u ", frameID);
|
|
PTHREAD_MUTEX_LOCK(&dstBufferManager->frameTable_mutex);
|
|
if (frameID != dstBufferManager->frameIDToWrite) {
|
|
DEBUGLOG(4, "writing frameID %u : not possible, waiting for %u ", frameID, dstBufferManager->frameIDToWrite);
|
|
frameToWrite_t const frame = { src, srcSize, frameID, isLastFrame };
|
|
ZSTDMT_stackFrameToWrite(dstBufferManager, frame);
|
|
pthread_mutex_unlock(&dstBufferManager->frameTable_mutex);
|
|
return 0;
|
|
}
|
|
pthread_mutex_unlock(&dstBufferManager->frameTable_mutex);
|
|
|
|
/* write frame
|
|
* note : only one write possible due to frameID condition */
|
|
DEBUGLOG(3, "writing frame %u (%u bytes) ", frameID, (U32)srcSize);
|
|
ZSTD_outBuffer const out = dstBufferManager->out;
|
|
if (out.pos + srcSize > out.size)
|
|
return ERROR(dstSize_tooSmall);
|
|
if (frameID) /* frameID==0 compress directly in dst buffer */
|
|
memcpy((char*)out.dst + out.pos, src, srcSize);
|
|
dstBufferManager->out.pos += srcSize;
|
|
dstBufferManager->frameIDToWrite = frameID+1;
|
|
lastFrameWritten = isLastFrame;
|
|
|
|
/* check if more frames are stacked */
|
|
PTHREAD_MUTEX_LOCK(&dstBufferManager->frameTable_mutex);
|
|
unsigned frameWritten = dstBufferManager->nbStackedFrames>0;
|
|
while (frameWritten) {
|
|
unsigned u;
|
|
frameID++;
|
|
frameWritten = 0;
|
|
for (u=0; u<dstBufferManager->nbStackedFrames; u++) {
|
|
if (dstBufferManager->stackedFrame[u].frameID == frameID) {
|
|
pthread_mutex_unlock(&dstBufferManager->frameTable_mutex);
|
|
DEBUGLOG(4, "catch up frame %u ", frameID);
|
|
{ size_t const writeError = ZSTDMT_writeFrame(dstBufferManager, u);
|
|
if (ZSTD_isError(writeError)) return writeError; }
|
|
lastFrameWritten = dstBufferManager->stackedFrame[u].isLastFrame;
|
|
dstBufferManager->frameIDToWrite = frameID+1;
|
|
/* remove frame from stack */
|
|
PTHREAD_MUTEX_LOCK(&dstBufferManager->frameTable_mutex);
|
|
dstBufferManager->stackedFrame[u] = dstBufferManager->stackedFrame[dstBufferManager->nbStackedFrames-1];
|
|
dstBufferManager->nbStackedFrames -= 1;
|
|
frameWritten = dstBufferManager->nbStackedFrames>0;
|
|
break;
|
|
} } }
|
|
pthread_mutex_unlock(&dstBufferManager->frameTable_mutex);
|
|
|
|
/* end reached : last frame written */
|
|
if (lastFrameWritten) pthread_mutex_unlock(&dstBufferManager->allFramesWritten_mutex);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
typedef struct ZSTDMT_jobDescription_s {
|
|
const void* src; /* NULL means : kill thread */
|
|
size_t srcSize;
|
|
int compressionLevel;
|
|
ZSTDMT_dstBufferManager* dstManager;
|
|
unsigned frameNumber;
|
|
unsigned isLastFrame;
|
|
} ZSTDMT_jobDescription;
|
|
|
|
typedef struct ZSTDMT_jobAgency_s {
|
|
pthread_mutex_t jobAnnounce_mutex;
|
|
pthread_mutex_t jobApply_mutex;
|
|
ZSTDMT_jobDescription jobAnnounce;
|
|
} ZSTDMT_jobAgency;
|
|
|
|
/* ZSTDMT_postjob() :
|
|
* This function is blocking as long as previous posted job is not taken.
|
|
* It could be made non-blocking, with a storage queue.
|
|
* But blocking has benefits : on top of memory savings,
|
|
* the caller will be able to measure delay, allowing dynamic speed throttle (via compression level).
|
|
*/
|
|
static void ZSTDMT_postjob(ZSTDMT_jobAgency* jobAgency, ZSTDMT_jobDescription job)
|
|
{
|
|
DEBUGLOG(5, "starting job posting ");
|
|
PTHREAD_MUTEX_LOCK(&jobAgency->jobApply_mutex); /* wait for a thread to take previous job */
|
|
DEBUGLOG(5, "job posting mutex acquired ");
|
|
jobAgency->jobAnnounce = job; /* post job */
|
|
pthread_mutex_unlock(&jobAgency->jobAnnounce_mutex); /* announce */
|
|
DEBUGLOG(5, "job available now ");
|
|
}
|
|
|
|
static ZSTDMT_jobDescription ZSTDMT_getjob(ZSTDMT_jobAgency* jobAgency)
|
|
{
|
|
PTHREAD_MUTEX_LOCK(&jobAgency->jobAnnounce_mutex); /* should check return code */
|
|
ZSTDMT_jobDescription const job = jobAgency->jobAnnounce;
|
|
pthread_mutex_unlock(&jobAgency->jobApply_mutex);
|
|
return job;
|
|
}
|
|
|
|
|
|
|
|
#define ZSTDMT_NBBUFFERSPOOLED_MAX ZSTDMT_NBTHREADS_MAX
|
|
typedef struct ZSTDMT_bufferPool_s {
|
|
pthread_mutex_t bufferPool_mutex;
|
|
buffer_t bTable[ZSTDMT_NBBUFFERSPOOLED_MAX];
|
|
unsigned nbBuffers;
|
|
} ZSTDMT_bufferPool;
|
|
|
|
static buffer_t ZSTDMT_getBuffer(ZSTDMT_bufferPool* pool, size_t bSize)
|
|
{
|
|
PTHREAD_MUTEX_LOCK(&pool->bufferPool_mutex);
|
|
if (pool->nbBuffers) { /* try to use an existing buffer */
|
|
pool->nbBuffers--;
|
|
buffer_t const buf = pool->bTable[pool->nbBuffers];
|
|
pthread_mutex_unlock(&pool->bufferPool_mutex);
|
|
size_t const availBufferSize = buf.bufferSize;
|
|
if ((availBufferSize >= bSize) & (availBufferSize <= 10*bSize)) /* large enough, but not too much */
|
|
return buf;
|
|
free(buf.start); /* size conditions not respected : create a new buffer */
|
|
}
|
|
pthread_mutex_unlock(&pool->bufferPool_mutex);
|
|
/* create new buffer */
|
|
buffer_t buf;
|
|
buf.bufferSize = bSize;
|
|
buf.start = calloc(1, bSize);
|
|
return buf;
|
|
}
|
|
|
|
/* effectively store buffer for later re-use, up to pool capacity */
|
|
static void ZSTDMT_releaseBuffer(ZSTDMT_bufferPool* pool, buffer_t buf)
|
|
{
|
|
PTHREAD_MUTEX_LOCK(&pool->bufferPool_mutex);
|
|
if (pool->nbBuffers >= ZSTDMT_NBBUFFERSPOOLED_MAX) {
|
|
pthread_mutex_unlock(&pool->bufferPool_mutex);
|
|
free(buf.start);
|
|
return;
|
|
}
|
|
pool->bTable[pool->nbBuffers++] = buf; /* store for later re-use */
|
|
pthread_mutex_unlock(&pool->bufferPool_mutex);
|
|
}
|
|
|
|
|
|
|
|
struct ZSTDMT_CCtx_s {
|
|
pthread_t pthread[ZSTDMT_NBTHREADS_MAX];
|
|
unsigned nbThreads;
|
|
ZSTDMT_jobAgency jobAgency;
|
|
ZSTDMT_bufferPool bufferPool;
|
|
};
|
|
|
|
static void* ZSTDMT_compressionThread(void* arg)
|
|
{
|
|
if (arg==NULL) return NULL; /* error : should not be possible */
|
|
ZSTDMT_CCtx* const mtctx = (ZSTDMT_CCtx*) arg;
|
|
ZSTDMT_jobAgency* const jobAgency = &mtctx->jobAgency;
|
|
ZSTDMT_bufferPool* const pool = &mtctx->bufferPool;
|
|
ZSTD_CCtx* const cctx = ZSTD_createCCtx();
|
|
if (cctx==NULL) return NULL; /* allocation failure : thread not started */
|
|
DEBUGLOG(3, "thread %li created ", (long int)pthread_self());
|
|
for (;;) {
|
|
ZSTDMT_jobDescription const job = ZSTDMT_getjob(jobAgency);
|
|
if (job.src == NULL) {
|
|
DEBUGLOG(4, "thread exit ");
|
|
ZSTD_freeCCtx(cctx);
|
|
return NULL;
|
|
}
|
|
ZSTDMT_dstBufferManager* dstBufferManager = job.dstManager;
|
|
size_t const dstBufferCapacity = ZSTD_compressBound(job.srcSize);
|
|
DEBUGLOG(4, "requesting a dstBuffer for frame %u", job.frameNumber);
|
|
buffer_t const dstBuffer = job.frameNumber ? ZSTDMT_getBuffer(pool, dstBufferCapacity) : ZSTDMT_getDstBuffer(dstBufferManager); /* lack params */
|
|
DEBUGLOG(4, "start compressing frame %u", job.frameNumber);
|
|
//size_t const cSize = ZSTD_compress(dstBuffer.start, dstBuffer.bufferSize, job.src, job.srcSize, job.compressionLevel);
|
|
size_t const cSize = ZSTD_compressCCtx(cctx, dstBuffer.start, dstBuffer.bufferSize, job.src, job.srcSize, job.compressionLevel);
|
|
if (ZSTD_isError(cSize)) return (void*)(cSize); /* error - find a better way */
|
|
size_t const writeError = ZSTDMT_tryWriteFrame(dstBufferManager, dstBuffer.start, cSize, job.frameNumber, job.isLastFrame); /* pas clair */
|
|
if (ZSTD_isError(writeError)) return (void*)writeError;
|
|
if (job.frameNumber) ZSTDMT_releaseBuffer(pool, dstBuffer);
|
|
}
|
|
}
|
|
|
|
ZSTDMT_CCtx *ZSTDMT_createCCtx(unsigned nbThreads)
|
|
{
|
|
if ((nbThreads < 1) | (nbThreads > ZSTDMT_NBTHREADS_MAX)) return NULL;
|
|
ZSTDMT_CCtx* const cctx = (ZSTDMT_CCtx*) calloc(1, sizeof(ZSTDMT_CCtx));
|
|
if (!cctx) return NULL;
|
|
/* init jobAgency */
|
|
pthread_mutex_init(&cctx->jobAgency.jobAnnounce_mutex, NULL); /* check return value ? */
|
|
pthread_mutex_init(&cctx->jobAgency.jobApply_mutex, NULL);
|
|
PTHREAD_MUTEX_LOCK(&cctx->jobAgency.jobAnnounce_mutex); /* no job at beginning */
|
|
/* init bufferPool */
|
|
pthread_mutex_init(&cctx->bufferPool.bufferPool_mutex, NULL);
|
|
/* start all workers */
|
|
cctx->nbThreads = nbThreads;
|
|
DEBUGLOG(2, "nbThreads : %u \n", nbThreads);
|
|
unsigned t;
|
|
for (t = 0; t < nbThreads; t++) {
|
|
pthread_create(&cctx->pthread[t], NULL, ZSTDMT_compressionThread, cctx); /* check return value ? */
|
|
}
|
|
return cctx;
|
|
}
|
|
|
|
size_t ZSTDMT_freeCCtx(ZSTDMT_CCtx* cctx)
|
|
{
|
|
/* free threads */
|
|
/* free mutex (if necessary) */
|
|
/* free bufferPool */
|
|
free(cctx); /* incompleted ! */
|
|
return 0;
|
|
}
|
|
|
|
size_t ZSTDMT_compressCCtx(ZSTDMT_CCtx* cctx,
|
|
void* dst, size_t dstCapacity,
|
|
const void* src, size_t srcSize,
|
|
int compressionLevel)
|
|
{
|
|
ZSTDMT_jobAgency* jobAgency = &cctx->jobAgency;
|
|
ZSTD_parameters const params = ZSTD_getParams(compressionLevel, srcSize, 0);
|
|
size_t const frameSizeTarget = (size_t)1 << (params.cParams.windowLog + 2);
|
|
unsigned const nbFramesMax = (unsigned)(srcSize / frameSizeTarget) + (srcSize < frameSizeTarget) /* min 1 */;
|
|
unsigned const nbFrames = MIN(nbFramesMax, cctx->nbThreads);
|
|
size_t const avgFrameSize = (srcSize + (nbFrames-1)) / nbFrames;
|
|
size_t remainingSrcSize = srcSize;
|
|
const char* const srcStart = (const char*)src;
|
|
size_t frameStartPos = 0;
|
|
ZSTDMT_dstBufferManager dbm = ZSTDMT_createDstBufferManager(dst, dstCapacity);
|
|
|
|
DEBUGLOG(2, "windowLog : %u => frameSizeTarget : %u ", params.cParams.windowLog, (U32)frameSizeTarget);
|
|
DEBUGLOG(2, "nbFrames : %u (size : %u bytes) ", nbFrames, (U32)avgFrameSize);
|
|
|
|
{ unsigned u;
|
|
for (u=0; u<nbFrames; u++) {
|
|
size_t const frameSize = MIN(remainingSrcSize, avgFrameSize);
|
|
DEBUGLOG(3, "posting job %u (%u bytes)", u, (U32)frameSize);
|
|
ZSTDMT_jobDescription const job = { srcStart+frameStartPos, frameSize, compressionLevel,
|
|
&dbm, u, u==(nbFrames-1) };
|
|
ZSTDMT_postjob(jobAgency, job);
|
|
frameStartPos += frameSize;
|
|
remainingSrcSize -= frameSize;
|
|
} }
|
|
|
|
PTHREAD_MUTEX_LOCK(&dbm.allFramesWritten_mutex);
|
|
DEBUGLOG(4, "compressed size : %u ", (U32)dbm.out.pos);
|
|
return dbm.out.pos;
|
|
}
|