bootloader/deflator/deflator.c

   1 #include <pkgconf/system.h>     /* which packages are enabled/disabled */
   2 #include <pkgconf/kernel.h>
   3 #include <pkgconf/libc_startup.h>
   4 #include <cyg/compress/zlib.h>
   5 #include <cyg/hal/hal_arch.h>           /* CYGNUM_HAL_STACK_SIZE_TYPICAL */
   6 #include <cyg/hal/hal_intr.h>
   7 #include <cyg/hal/hal_diag.h>
   8
   9 #include <cyg/kernel/kapi.h>
  10 #include <cyg/io/io.h>                  /* I/O functions */
  11 #include <cyg/infra/diag.h>     // diag_printf
  12
  13 #include <cyg/compress/zlib.h>
  14 #include <string.h>
  15
  16 #include "addresses.h"
  17
  18 cyg_uint8 inflateBuffer[8192];
  19
  20 #define NONCACHE_RAM_APPLICATION_START (0x80000000 | RAM_APPLICATION_START)
  21 #define NONCACHE_ROM_APPLICATION_START (0x80000000 | ROM_APPLICATION_START)
  22
  23 int main(int argc, char **argv)
  24 {
  25         cyg_interrupt_disable();
  26         diag_printf("Deflating application...\n");
  27
  28         cyg_uint8 *DRAM = (cyg_uint8 *)NONCACHE_RAM_APPLICATION_START;
  29
  30     z_stream d_stream; /* decompression stream */
  31     d_stream.zalloc = Z_NULL;
  32     d_stream.zfree = Z_NULL;
  33     d_stream.opaque = Z_NULL;
  34
  35     d_stream.next_in  = NONCACHE_ROM_APPLICATION_START;
  36     d_stream.avail_in = 0x1000000;
  37
  38     int err = inflateInit(&d_stream);
  39
  40     if (err == Z_MEM_ERROR)
  41     {
  42         diag_printf("Failed to deflate application %d\n", err);
  43         HAL_PLATFORM_RESET();
  44     }
  45
  46     int offset = 0;
  47
  48     for (;;)
  49     {
  50         d_stream.avail_out = sizeof(inflateBuffer);
  51         d_stream.next_out = inflateBuffer;
  52
  53             int err = inflate(&d_stream, Z_NO_FLUSH);
  54         int len = sizeof(inflateBuffer) - d_stream.avail_out;
  55
  56         memcpy(DRAM + offset, inflateBuffer, len);
  57
  58         offset += len;
  59
  60         if (err == Z_STREAM_END)
  61         {
  62                         diag_printf("Launching application(%d bytes)...\n", offset);
  63                         /* launch application! */
  64                         ((void(*)(void))(NONCACHE_RAM_APPLICATION_START))();
  65
  66                         for (;;);
  67                         // never reached
  68         }
  69
  70         if (err != Z_OK)
  71         {
  72                 diag_printf("Failed to deflate application %d\n", err);
  73                 return;
  74                 HAL_PLATFORM_RESET();
  75         }
  76     }
  77     diag_printf("Failed to deflate application %d\n", err);
  78         HAL_PLATFORM_RESET();
  79
  80 }