examples/standalone/stubs.c

   1 #include <common.h>
   2 #include <exports.h>
   3 #include <linux/compiler.h>
   4
   5 #define FO(x) offsetof(struct jt_funcs, x)
   6
   7 #if defined(CONFIG_X86)
   8 /*
   9  * x86 does not have a dedicated register to store the pointer to
  10  * the global_data. Thus the jump table address is stored in a
  11  * global variable, but such approach does not allow for execution
  12  * from flash memory. The global_data address is passed as argv[-1]
  13  * to the application program.
  14  */
  15 static struct jt_funcs *jt;
  16 gd_t *global_data;
  17
  18 #define EXPORT_FUNC(f, a, x, ...) \
  19         asm volatile (                  \
  20 "       .globl " #x "\n"                \
  21 #x ":\n"                                \
  22 "       movl    %0, %%eax\n"            \
  23 "       movl    jt, %%ecx\n"            \
  24 "       jmp     *(%%ecx, %%eax)\n"      \
  25         : : "i"(FO(x)) : "eax", "ecx");
  26 #elif defined(CONFIG_PPC)
  27 /*
  28  * r2 holds the pointer to the global_data, r11 is a call-clobbered
  29  * register
  30  */
  31 #define EXPORT_FUNC(f, a, x, ...) \
  32         asm volatile (                  \
  33 "       .globl " #x "\n"                \
  34 #x ":\n"                                \
  35 "       lwz     %%r11, %0(%%r2)\n"      \
  36 "       lwz     %%r11, %1(%%r11)\n"     \
  37 "       mtctr   %%r11\n"                \
  38 "       bctr\n"                         \
  39         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "r11");
  40 #elif defined(CONFIG_ARM)
  41 #ifdef CONFIG_ARM64
  42 /*
  43  * x18 holds the pointer to the global_data, x9 is a call-clobbered
  44  * register
  45  */
  46 #define EXPORT_FUNC(f, a, x, ...) \
  47         asm volatile (                  \
  48 "       .globl " #x "\n"                \
  49 #x ":\n"                                \
  50 "       ldr     x9, [x18, %0]\n"                \
  51 "       ldr     x9, [x9, %1]\n"         \
  52 "       br      x9\n"           \
  53         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "x9");
  54 #else
  55 /*
  56  * r9 holds the pointer to the global_data, ip is a call-clobbered
  57  * register
  58  */
  59 #define EXPORT_FUNC(f, a, x, ...) \
  60         asm volatile (                  \
  61 "       .globl " #x "\n"                \
  62 #x ":\n"                                \
  63 "       ldr     ip, [r9, %0]\n"         \
  64 "       ldr     pc, [ip, %1]\n"         \
  65         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "ip");
  66 #endif
  67 #elif defined(CONFIG_MIPS)
  68 /*
  69  * k0 ($26) holds the pointer to the global_data; t9 ($25) is a call-
  70  * clobbered register that is also used to set gp ($26). Note that the
  71  * jr instruction also executes the instruction immediately following
  72  * it; however, GCC/mips generates an additional `nop' after each asm
  73  * statement
  74  */
  75 #define EXPORT_FUNC(f, a, x, ...) \
  76         asm volatile (                  \
  77 "       .globl " #x "\n"                \
  78 #x ":\n"                                \
  79 "       lw      $25, %0($26)\n"         \
  80 "       lw      $25, %1($25)\n"         \
  81 "       jr      $25\n"                  \
  82         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "t9");
  83 #elif defined(CONFIG_NIOS2)
  84 /*
  85  * gp holds the pointer to the global_data, r8 is call-clobbered
  86  */
  87 #define EXPORT_FUNC(f, a, x, ...) \
  88         asm volatile (                  \
  89 "       .globl " #x "\n"                \
  90 #x ":\n"                                \
  91 "       movhi   r8, %%hi(%0)\n"         \
  92 "       ori     r8, r0, %%lo(%0)\n"     \
  93 "       add     r8, r8, gp\n"           \
  94 "       ldw     r8, 0(r8)\n"            \
  95 "       ldw     r8, %1(r8)\n"           \
  96 "       jmp     r8\n"                   \
  97         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "gp");
  98 #elif defined(CONFIG_M68K)
  99 /*
 100  * d7 holds the pointer to the global_data, a0 is a call-clobbered
 101  * register
 102  */
 103 #define EXPORT_FUNC(f, a, x, ...) \
 104         asm volatile (                  \
 105 "       .globl " #x "\n"                \
 106 #x ":\n"                                \
 107 "       move.l  %%d7, %%a0\n"           \
 108 "       adda.l  %0, %%a0\n"             \
 109 "       move.l  (%%a0), %%a0\n"         \
 110 "       adda.l  %1, %%a0\n"             \
 111 "       move.l  (%%a0), %%a0\n"         \
 112 "       jmp     (%%a0)\n"                       \
 113         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "a0");
 114 #elif defined(CONFIG_MICROBLAZE)
 115 /*
 116  * r31 holds the pointer to the global_data. r5 is a call-clobbered.
 117  */
 118 #define EXPORT_FUNC(f, a, x, ...)                               \
 119         asm volatile (                          \
 120 "       .globl " #x "\n"                        \
 121 #x ":\n"                                        \
 122 "       lwi     r5, r31, %0\n"                  \
 123 "       lwi     r5, r5, %1\n"                   \
 124 "       bra     r5\n"                           \
 125         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "r5");
 126 #elif defined(CONFIG_BLACKFIN)
 127 /*
 128  * P3 holds the pointer to the global_data, P0 is a call-clobbered
 129  * register
 130  */
 131 #define EXPORT_FUNC(f, a, x, ...)                       \
 132         asm volatile (                  \
 133 "       .globl _" #x "\n_"              \
 134 #x ":\n"                                \
 135 "       P0 = [P3 + %0]\n"               \
 136 "       P0 = [P0 + %1]\n"               \
 137 "       JUMP (P0)\n"                    \
 138         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "P0");
 139 #elif defined(CONFIG_AVR32)
 140 /*
 141  * r6 holds the pointer to the global_data. r8 is call clobbered.
 142  */
 143 #define EXPORT_FUNC(f, a, x, ...)                                       \
 144         asm volatile(                                   \
 145                 "       .globl\t" #x "\n"               \
 146                 #x ":\n"                                \
 147                 "       ld.w    r8, r6[%0]\n"           \
 148                 "       ld.w    pc, r8[%1]\n"           \
 149                 :                                       \
 150                 : "i"(offsetof(gd_t, jt)), "i"(FO(x))   \
 151                 : "r8");
 152 #elif defined(CONFIG_SH)
 153 /*
 154  * r13 holds the pointer to the global_data. r1 is a call clobbered.
 155  */
 156 #define EXPORT_FUNC(f, a, x, ...)                                       \
 157         asm volatile (                                  \
 158                 "       .align  2\n"                    \
 159                 "       .globl " #x "\n"                \
 160                 #x ":\n"                                \
 161                 "       mov     r13, r1\n"              \
 162                 "       add     %0, r1\n"               \
 163                 "       mov.l @r1, r2\n"        \
 164                 "       add     %1, r2\n"               \
 165                 "       mov.l @r2, r1\n"        \
 166                 "       jmp     @r1\n"                  \
 167                 "       nop\n"                          \
 168                 "       nop\n"                          \
 169                 : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "r1", "r2");
 170 #elif defined(CONFIG_SPARC)
 171 /*
 172  * g7 holds the pointer to the global_data. g1 is call clobbered.
 173  */
 174 #define EXPORT_FUNC(f, a, x, ...)                                       \
 175         asm volatile(                                   \
 176 "       .globl\t" #x "\n"                               \
 177 #x ":\n"                                                \
 178 "       set %0, %%g1\n"                                 \
 179 "       or %%g1, %%g7, %%g1\n"                          \
 180 "       ld [%%g1], %%g1\n"                              \
 181 "       ld [%%g1 + %1], %%g1\n"                         \
 182 "       jmp %%g1\n"                                     \
 183 "       nop\n"                                          \
 184         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "g1");
 185 #elif defined(CONFIG_NDS32)
 186 /*
 187  * r16 holds the pointer to the global_data. gp is call clobbered.
 188  * not support reduced register (16 GPR).
 189  */
 190 #define EXPORT_FUNC(f, a, x, ...) \
 191         asm volatile (                  \
 192 "       .globl " #x "\n"                \
 193 #x ":\n"                                \
 194 "       lwi     $r16, [$gp + (%0)]\n"   \
 195 "       lwi     $r16, [$r16 + (%1)]\n"  \
 196 "       jr      $r16\n"                 \
 197         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "$r16");
 198 #elif defined(CONFIG_OPENRISC)
 199 /*
 200  * r10 holds the pointer to the global_data, r13 is a call-clobbered
 201  * register
 202  */
 203 #define EXPORT_FUNC(f, a, x, ...) \
 204         asm volatile (                  \
 205 "       .globl " #x "\n"                \
 206 #x ":\n"                                \
 207 "       l.lwz   r13, %0(r10)\n" \
 208 "       l.lwz   r13, %1(r13)\n" \
 209 "       l.jr    r13\n"          \
 210 "       l.nop\n"                                \
 211         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "r13");
 212 #elif defined(CONFIG_ARC)
 213 /*
 214  * r25 holds the pointer to the global_data. r10 is call clobbered.
 215   */
 216 #define EXPORT_FUNC(f, a, x, ...) \
 217         asm volatile( \
 218 "       .align 4\n" \
 219 "       .globl " #x "\n" \
 220 #x ":\n" \
 221 "       ld      r10, [r25, %0]\n" \
 222 "       ld      r10, [r10, %1]\n" \
 223 "       j       [r10]\n" \
 224         : : "i"(offsetof(gd_t, jt)), "i"(FO(x)) : "r10");
 225 #else
 226 /*"     addi    $sp, $sp, -24\n"        \
 227 "       br      $r16\n"                 \*/
 228
 229 #error stubs definition missing for this architecture
 230 #endif
 231
 232 /* This function is necessary to prevent the compiler from
 233  * generating prologue/epilogue, preparing stack frame etc.
 234  * The stub functions are special, they do not use the stack
 235  * frame passed to them, but pass it intact to the actual
 236  * implementation. On the other hand, asm() statements with
 237  * arguments can be used only inside the functions (gcc limitation)
 238  */
 239 #if GCC_VERSION < 30400
 240 static
 241 #endif /* GCC_VERSION */
 242 void __attribute__((unused)) dummy(void)
 243 {
 244 #include <_exports.h>
 245 }
 246
 247 #include <asm/sections.h>
 248
 249 void app_startup(char * const *argv)
 250 {
 251         char *cp = __bss_start;
 252
 253         /* Zero out BSS */
 254         while (cp < _end)
 255                 *cp++ = 0;
 256
 257 #if defined(CONFIG_X86)
 258         /* x86 does not have a dedicated register for passing global_data */
 259         global_data = (gd_t *)argv[-1];
 260         jt = global_data->jt;
 261 #endif
 262 }
 263
 264 #undef EXPORT_FUNC