zstd/lib/compress/zstdmt_compress.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;
}