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(unsigned cpu_reset)
  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(src, dst, 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 //      dump_mem(src, src+0x100);
  70
  71         for(;;) {
  72                 unsigned int m_off, m_len;
  73                 while(GETBIT(bb, src, ilen)) {
  74                         dst[olen++] = src[ilen++];
  75                 }
  76                 m_off = 1;
  77                 do {
  78                         m_off = m_off*2 + GETBIT(bb, src, ilen);
  79                 } while (!GETBIT(bb, src, ilen));
  80                 if (m_off == 2)
  81                 {
  82                         m_off = last_m_off;
  83                 }
  84                 else
  85                 {
  86                         m_off = (m_off - 3)*256 + src[ilen++];
  87                         if(m_off == 0xffffffffU)
  88                                 break;
  89                         last_m_off = ++m_off;
  90                 }
  91                 m_len = GETBIT(bb, src, ilen);
  92                 m_len = m_len*2 + GETBIT(bb, src, ilen);
  93                 if (m_len == 0)
  94                 {
  95                         m_len++;
  96                         do {
  97                                 m_len = m_len*2 + GETBIT(bb, src, ilen);
  98                         } while(!GETBIT(bb, src, ilen));
  99                         m_len += 2;
 100                 }
 101                 m_len += (m_off > 0xd00);
 102                 {
 103                         const uint8_t *m_pos;
 104                         m_pos = dst + olen - m_off;
 105                         dst[olen++] = *m_pos++;
 106                         do {
 107                                 dst[olen++] = *m_pos++;
 108                         } while(--m_len > 0);
 109                 }
 110         }
 111 #endif
 112 //      dump_mem(dst, dst+0x100);
 113
 114         print_debug_cp_run("linxbios_ram.bin length = ", olen);
 115
 116         print_debug("Jumping to LinuxBIOS.\r\n");
 117
 118         if(cpu_reset == 1 ) {
 119                 __asm__ volatile (
 120                         "movl $0xffffffff, %ebp\n\t"
 121                 );
 122         }
 123         else {
 124                 __asm__ volatile (
 125                         "xorl %ebp, %ebp\n\t"
 126                 );
 127         }
 128
 129         __asm__ volatile (
 130                 "cli\n\t"
 131                 "leal    _iseg, %edi\n\t"
 132                 "jmp     %edi\n\t"
 133         );
 134
 135 }