src/cpu/amd/car/copy_and_run.c

   1 /* by yhlu 6.2005
   2         moved from nrv2v.c and some lines from crt0.S
   3 */
   4 #ifndef ENDIAN
   5 #define ENDIAN   0
   6 #endif
   7 #ifndef BITSIZE
   8 #define BITSIZE 32
   9 #endif
  10
  11 #define GETBIT_8(bb, src, ilen) \
  12     (((bb = bb & 0x7f ? bb*2 : ((unsigned)src[ilen++]*2+1)) >> 8) & 1)
  13
  14 #define GETBIT_LE16(bb, src, ilen) \
  15     (bb*=2,bb&0xffff ? (bb>>16)&1 : (ilen+=2,((bb=(src[ilen-2]+src[ilen-1]*256u)*2+1)>>16)&1))
  16
  17 #define GETBIT_LE32(bb, src, ilen) \
  18     (bc > 0 ? ((bb>>--bc)&1) : (bc=31,\
  19     bb=*(const uint32_t *)((src)+ilen),ilen+=4,(bb>>31)&1))
  20
  21 #if ENDIAN == 0 && BITSIZE == 8
  22 #define GETBIT(bb, src, ilen) GETBIT_8(bb, src, ilen)
  23 #endif
  24 #if ENDIAN == 0 && BITSIZE == 16
  25 #define GETBIT(bb, src, ilen) GETBIT_LE16(bb, src, ilen)
  26 #endif
  27 #if ENDIAN == 0 && BITSIZE == 32
  28 #define GETBIT(bb, src, ilen) GETBIT_LE32(bb, src, ilen)
  29 #endif
  30
  31 static inline void print_debug_cp_run(const char *strval, uint32_t val)
  32 {
  33 #if CONFIG_USE_INIT
  34         printk_debug("%s%08x\r\n", strval, val);
  35 #else
  36         print_debug(strval); print_debug_hex32(val); print_debug("\r\n");
  37 #endif
  38 }
  39
  40 static void copy_and_run(void)
  41 {
  42         uint8_t *src, *dst;
  43         unsigned long ilen = 0, olen = 0, last_m_off =  1;
  44         uint32_t bb = 0;
  45         unsigned bc = 0;
  46
  47         print_debug("Copying LinuxBIOS to ram.\r\n");
  48
  49 #if !CONFIG_COMPRESS
  50         __asm__ volatile (
  51                 "leal _liseg, %0\n\t"
  52                 "leal _iseg, %1\n\t"
  53                 "leal _eiseg, %2\n\t"
  54                 "subl %1, %2\n\t"
  55                 : "=a" (src), "=b" (dst), "=c" (olen)
  56         );
  57         memcpy(dst, src, olen);
  58 #else
  59
  60         __asm__ volatile (
  61                 "leal  4+_liseg, %0\n\t"
  62                 "leal    _iseg,  %1\n\t"
  63                 : "=a" (src) , "=b" (dst)
  64         );
  65
  66         print_debug_cp_run("src=",(uint32_t)src);
  67         print_debug_cp_run("dst=",(uint32_t)dst);
  68
  69         for(;;) {
  70                 unsigned int m_off, m_len;
  71                 while(GETBIT(bb, src, ilen)) {
  72                         dst[olen++] = src[ilen++];
  73                 }
  74
  75                 m_off = 1;
  76                 do {
  77                         m_off = m_off*2 + GETBIT(bb, src, ilen);
  78                 } while (!GETBIT(bb, src, ilen));
  79                 if (m_off == 2)
  80                 {
  81                         m_off = last_m_off;
  82                 }
  83                 else
  84                 {
  85                         m_off = (m_off - 3)*256 + src[ilen++];
  86                         if(m_off == 0xffffffffU)
  87                                 break;
  88                         last_m_off = ++m_off;
  89                 }
  90                 m_len = GETBIT(bb, src, ilen);
  91                 m_len = m_len*2 + GETBIT(bb, src, ilen);
  92                 if (m_len == 0)
  93                 {
  94                         m_len++;
  95                         do {
  96                                 m_len = m_len*2 + GETBIT(bb, src, ilen);
  97                         } while(!GETBIT(bb, src, ilen));
  98                         m_len += 2;
  99                 }
 100                 m_len += (m_off > 0xd00);
 101                 {
 102                         const uint8_t *m_pos;
 103                         m_pos = dst + olen - m_off;
 104                         dst[olen++] = *m_pos++;
 105                         do {
 106                                 dst[olen++] = *m_pos++;
 107                         } while(--m_len > 0);
 108                 }
 109         }
 110 #endif
 111
 112         print_debug_cp_run("linxbios_ram.bin length = ", olen);
 113
 114         print_debug("Jumping to LinuxBIOS.\r\n");
 115
 116         __asm__ volatile (
 117                 "xorl %ebp, %ebp\n\t" /* cpu_reset for hardwaremain dummy */
 118                 "cli\n\t"
 119                 "leal    _iseg, %edi\n\t"
 120                 "jmp     *%edi\n\t"
 121         );
 122
 123 }