//==========================================================================
//
//      decompress.c
//
//      RedBoot decompress support
//
//==========================================================================
//####COPYRIGHTBEGIN####
//                                                                          
// -------------------------------------------                              
// The contents of this file are subject to the Red Hat eCos Public License 
// Version 1.1 (the "License"); you may not use this file except in         
// compliance with the License.  You may obtain a copy of the License at    
// http://www.redhat.com/                                                   
//                                                                          
// Software distributed under the License is distributed on an "AS IS"      
// basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.  See the 
// License for the specific language governing rights and limitations under 
// the License.                                                             
//                                                                          
// The Original Code is eCos - Embedded Configurable Operating System,      
// released September 30, 1998.                                             
//                                                                          
// The Initial Developer of the Original Code is Red Hat.                   
// Portions created by Red Hat are                                          
// Copyright (C) 1998, 1999, 2000, 2001 Red Hat, Inc.                             
// All Rights Reserved.                                                     
// -------------------------------------------                              
//                                                                          
//####COPYRIGHTEND####
//==========================================================================
//#####DESCRIPTIONBEGIN####
//
// Author(s):    jskov
// Contributors: jskov, gthomas
// Date:         2001-03-08
// Purpose:      
// Description:  
//              
// This code is part of RedBoot (tm).
//
//####DESCRIPTIONEND####
//
//==========================================================================

#include <redboot.h>

#ifdef CYGPKG_COMPRESS_ZLIB
#include <cyg/compress/zlib.h>
static z_stream stream;

#define __ZLIB_MAGIC__ 0x5A4C4942   // 'ZLIB'

//
// Free memory [blocks] are stored as a linked list of "struct _block"
// When free, 'size' is the size of the whole block
// When allocated, 'size' is the allocation size
// The 'magic' is kept to insure that the block being freed is reasonable
//
struct _block {
    int            size;
    long           magic;  // Must be __ZLIB_MAGIC__
    struct _block *next;
    struct _block *self;
};
static struct _block *memlist;

#define ZLIB_COMPRESSION_OVERHEAD 0xC000
static void *zlib_workspace;

//
// This function is run as part of RedBoot's initialization.
// It will allocate some memory from the "workspace" pool for
// use by the gzip/zlib routines.  This allows the memory usage
// of RedBoot to be more finely controlled than if we simply
// used the generic 'malloc() from the heap' functionality.
//
static void
_zlib_init(void)
{
    // Allocate some RAM for use by the gzip/zlib routines
    workspace_end -= ZLIB_COMPRESSION_OVERHEAD;
    zlib_workspace = workspace_end;
}

RedBoot_init(_zlib_init, RedBoot_INIT_FIRST);

// #define DEBUG_ZLIB_MALLOC
#ifdef DEBUG_ZLIB_MALLOC
static void
show_memlist(char *when)
{
    struct _block *bp = memlist;

    diag_printf("memory list after %s\n", when);
    while (bp != (struct _block *)0) {
        diag_printf("   %08p %5d %08p\n", bp, bp->size, bp->next);
        bp = bp->next;
    }
}
#endif

// Note: these have to be global and match the prototype used by the
// gzip/zlib package since we are exactly replacing them.

void 
*zcalloc(void *opaque, unsigned int items, unsigned int size)
{
    voidpf res;
    int len = (items*size);
    struct _block *bp = memlist;
    struct _block *nbp, *pbp;

    // Simple, first-fit algorithm
    pbp = (struct _block *)0;
    while (bp) {
        if (bp->size > len) {
            nbp = (struct _block *)((char *)bp + len + sizeof(struct _block));
            nbp->next = bp->next;
            nbp->size = bp->size - len;
            if (pbp) {
                pbp->next = nbp;
            } else {
                memlist = nbp;
            }
            res = bp;
            break;
        }
        pbp = bp;
        bp = bp->next;
    }
    if (bp) {
        bp->size = len;
        bp->magic = __ZLIB_MAGIC__;
        bp->self = bp;
        res = bp+1;
        memset(res, 0, len);
    } else {
        res = 0;  // No memory left
    }
#ifdef DEBUG_ZLIB_MALLOC
    diag_printf("%s(%d,%d) = %p\n", __FUNCTION__, items, size, res);
    show_memlist(__FUNCTION__);
#endif
    return res;
}

void 
zcfree(void *opaque, void *ptr)
{
    struct _block *bp, *pbp, *nbp;
    int size;

    if (!ptr) return;  // Safety
    bp = (struct _block *)((char *)ptr - sizeof(struct _block));
    if ((bp->magic != __ZLIB_MAGIC__) || (bp->self != bp)) {
        diag_printf("%s(%p) - invalid block\n", __FUNCTION__, ptr);
        return;
    }
    size = bp->size;
#ifdef DEBUG_ZLIB_MALLOC
    diag_printf("%s(%p) = %d bytes\n", __FUNCTION__, ptr, size);
#endif
    // See if this block is adjacent to a free block
    nbp = memlist;
    pbp = (struct _block *)0;
    while (nbp) {
        if ((char *)bp+size+sizeof(struct _block) == (char *)nbp) {
            // The block being freed fits just before
            bp->next = nbp->next;
            bp->size = nbp->size + size + sizeof(struct _block);
#ifdef DEBUG_ZLIB_MALLOC
            diag_printf("Free before\n");
#endif
            if (pbp) {
                pbp->next = bp;
                // See if this new block and the previous one can
                // be combined.
                if ((char *)pbp+pbp->size == (char *)bp) {
#ifdef DEBUG_ZLIB_MALLOC
                    diag_printf("Collapse [before] - p: %p/%d/%p, n: %p/%d/%p\n",
                                pbp, pbp->size, pbp->next,
                                bp, bp->size, bp->next);
#endif
                    pbp->size += bp->size;
                    pbp->next = bp->next;
                }
            } else {
                memlist = bp;
            }
#ifdef DEBUG_ZLIB_MALLOC
            show_memlist(__FUNCTION__);
#endif
            return;
        } else
        if ((char *)nbp+nbp->size == (char *)bp) {
            // The block being freed fits just after
            nbp->size += size + sizeof(struct _block);
            // See if it will now collapse with the following block
#ifdef DEBUG_ZLIB_MALLOC
            diag_printf("Free after\n");
#endif
            if (nbp->next != (struct _block *)0) {
                if ((char *)nbp+nbp->size == (char *)nbp->next) {
#ifdef DEBUG_ZLIB_MALLOC
                    diag_printf("Collapse [after] - p: %p/%d/%p, n: %p/%d/%p\n",
                                nbp, nbp->size, nbp->next,
                                nbp->next, nbp->next->size, nbp->next->next);
#endif
                    nbp->size += (nbp->next)->size;
                    nbp->next = (nbp->next)->next;
                }
            }
#ifdef DEBUG_ZLIB_MALLOC
            show_memlist(__FUNCTION__);
#endif
            return;
        } else {
            pbp = nbp;
            nbp = nbp->next;
        }
    }
}

//
// This function is called to initialize a gzip/zlib stream.
// Note that it also reinitializes the memory pool every time.
//
static int
gzip_init(_pipe_t* p)
{
    int err;
    struct _block *bp;

    bp = (struct _block *)zlib_workspace;
    memlist = bp;
    bp->next = 0;
    bp->size = ZLIB_COMPRESSION_OVERHEAD;
    stream.zalloc = zcalloc;
    stream.zfree = zcfree;
    stream.next_in = NULL;
    stream.avail_in = 0;
    stream.next_out = NULL;
    stream.avail_out = 0;
    err = inflateInit(&stream);

    return err;
}

//
// This function is called during the decompression cycle to
// actually cause a buffer to be filled with uncompressed data.
//
static int
gzip_inflate(_pipe_t* p)
{
    int err;

    stream.next_in = p->in_buf;
    stream.avail_in = p->in_avail;
    stream.next_out = p->out_buf;
    stream.avail_out = -1;              // no limits
    err = inflate(&stream, Z_SYNC_FLUSH);
    p->out_size += (stream.next_out - p->out_buf);
    p->out_buf = stream.next_out;
    p->msg = stream.msg;

    return err;
}

//
// Called when the input data is completed or an error has
// occured.  This allows for clean up as well as passing error
// information up.
//
static int
gzip_close(_pipe_t* p, int err)
{
    switch (err) {
    case Z_STREAM_END:
        err = 0;
        break;
    case Z_OK:
        // Decompression didn't complete
        p->msg = "premature end of input";
        // fall-through
    default:
        err = -1;
        break;
    }

    inflateEnd(&stream);

    return err;
}

//
// Exported interfaces
//
_decompress_fun_init* _dc_init = gzip_init;
_decompress_fun_inflate* _dc_inflate = gzip_inflate;
_decompress_fun_close* _dc_close = gzip_close;
#endif // CYGPKG_COMPRESS_ZLIB