Usermode/ld-acess - Fixing x86_64 entrypoint
[tpg/acess2.git] / Usermode / Libraries / ld-acess.so_src / main.c
1 /*\r
2  AcessOS 1 - Dynamic Loader\r
3  By thePowersGang\r
4 */\r
5 #include <stdint.h>\r
6 #include <stddef.h>\r
7 #include "common.h"\r
8 \r
9 // === PROTOTYPES ===\r
10 void    *DoRelocate(void *base, char **envp, const char *Filename);\r
11  int    CallUser(void *Entry, void *SP);\r
12 \r
13 // === Imports ===\r
14 extern char     gLinkedBase[];\r
15 extern tLoadedLib       gLoadedLibraries[];\r
16 char    **gEnvP;\r
17  \r
18 // === CODE ===\r
19 /**\r
20  \fn int SoMain(Uint base, int argc, char *argv[], char **envp)\r
21  \brief Library entry point\r
22  \note This is the entrypoint for the library\r
23 */\r
24 void *SoMain(void *base, int argc, char **argv, char **envp)\r
25 {\r
26         void    *ret;\r
27          \r
28         gEnvP = envp;\r
29 \r
30         // - Assume that the file pointer will be less than 4096\r
31         if((intptr_t)base < 0x1000) {\r
32                 SysDebug("ld-acess - SoMain: Passed file pointer %i\n", base);\r
33                 _exit(-1);\r
34                 for(;;);\r
35         }\r
36         // Check if we are being called directly\r
37         if(base == &gLinkedBase) {\r
38                 SysDebug("ld-acess should not be directly called\n");\r
39                 _exit(1);\r
40                 for(;;);\r
41         }\r
42 \r
43         gLoadedLibraries[0].Base = &gLinkedBase;\r
44         // 'libld-acess.so' because that is what applications link against\r
45         gLoadedLibraries[0].Name = "/Acess/Libs/libld-acess.so";\r
46         \r
47         // Otherwise do relocations\r
48         //ret = DoRelocate( base, envp, "Executable" );\r
49         ret = DoRelocate( base, NULL, "Executable" );\r
50         if( ret == 0 ) {\r
51                 SysDebug("ld-acess - SoMain: Relocate failed, base=0x%x\n", base);\r
52                 _exit(-1);\r
53                 for(;;);\r
54         }\r
55 \r
56         SysDebug("ld-acess - SoMain: ret = %p", ret);   \r
57         return ret;\r
58 }\r
59 \r
60 /**\r
61  \fn int DoRelocate(void *base, char **envp)\r
62  \brief Relocates an in-memory image\r
63 */\r
64 void *DoRelocate(void *base, char **envp, const char *Filename)\r
65 {\r
66         uint8_t *hdr = base;\r
67         // Load Executable\r
68         if(memcmp(base, "\x7F""ELF", 4) == 0)\r
69                 return ElfRelocate(base, envp, Filename);\r
70         if(hdr[0] == 0x7F && hdr[1] == 'E' && hdr[2] == 'L' && hdr[3] == 'F')\r
71                 return ElfRelocate(base, envp, Filename);\r
72 \r
73         if(hdr[0] == 'M' && hdr[1] == 'Z')\r
74                 return PE_Relocate(base, envp, Filename);\r
75         \r
76         SysDebug("ld-acess - DoRelocate: Unkown file format '0x%x 0x%x 0x%x 0x%x'\n",\r
77                 hdr[0], hdr[1], hdr[2], hdr[3] );\r
78         SysDebug("ld-acess - DoRelocate: File '%s'\n", Filename);\r
79         _exit(-1);\r
80         for(;;);\r
81 }\r
82 \r
83 /**\r
84  \fn int CallUser(Uint entry, Uint sp)\r
85 */\r
86 int CallUser(void *entry, void *sp)\r
87 {\r
88         #if ARCHDIR_IS_x86_64\r
89         ((void **)sp)[-1] = 0;  // Clear return address\r
90         __asm__ __volatile__ (\r
91         "mov %%rax, %%rsp;\n\t"\r
92         "jmp *%%rcx"\r
93         : : "a"(sp), "c"(entry));\r
94         #elif ARCHDIR_IS_x86\r
95         ((void **)sp)[-1] = 0;  // Clear return address\r
96         __asm__ __volatile__ (\r
97         "mov %%eax, %%esp;\n\t"\r
98         "jmp *%%ecx"\r
99         : : "a"(sp), "c"(entry));\r
100         #endif\r
101         for(;;);\r
102 }\r

UCC git Repository :: git.ucc.asn.au