AcessNative/ld-acess_src/exports.c

   1 /*
   2  * AcessNative
   3  *
   4  * exports.c
   5  * - Exported functions
   6  */
   7 #define DONT_INCLUDE_SYSCALL_NAMES 1
   8 #include "../../Usermode/include/acess/sys.h"
   9 #include "../syscalls.h"
  10 #include "exports.h"
  11 #include <stdarg.h>
  12 #include <stddef.h>
  13
  14 #define DEBUG(v...)     Debug(v)
  15
  16 typedef struct sFILE    FILE;
  17
  18 extern FILE     *stderr;
  19 extern void     exit(int) __attribute__ ((noreturn));
  20 extern int      printf(const char *, ...);
  21 extern int      fprintf(FILE *,const char *, ...);
  22 extern int      sprintf(char *,const char *, ...);
  23 extern int      vprintf(const char *, va_list);
  24 extern int      strncmp(const char *, const char *, size_t);
  25
  26 extern int      gSocket;
  27 extern int      giSyscall_ClientID;     // Needed for execve
  28 extern void     _InitSyscalls(void);
  29 extern void     _CloseSyscalls(void);
  30
  31 extern void     Debug(const char *Format, ...);
  32 extern int      AllocateMemory(uintptr_t VirtAddr, size_t ByteCount);
  33
  34 // === CONSTANTS ===
  35 #define NATIVE_FILE_MASK        0x40000000
  36
  37 // === CODE ===
  38 // --- VFS Calls
  39 int acess_chdir(const char *Path)
  40 {
  41         return _Syscall(SYS_CHDIR, ">s", Path);
  42 }
  43
  44 int acess_open(const char *Path, int Flags)
  45 {
  46         if( strncmp(Path, "$$$$", 4) == 0 )
  47         {
  48                 return native_open(Path, Flags) | NATIVE_FILE_MASK;
  49         }
  50         DEBUG("open(\"%s\", 0x%x)", Path, Flags);
  51         return _Syscall(SYS_OPEN, ">s >i", Path, Flags);
  52 }
  53
  54 void acess_close(int FD) {
  55         if(FD & NATIVE_FILE_MASK) {
  56                 return native_close(FD & (NATIVE_FILE_MASK-1));
  57         }
  58         DEBUG("close(%i)", FD);
  59         _Syscall(SYS_CLOSE, ">i", FD);
  60 }
  61
  62 int acess_reopen(int FD, const char *Path, int Flags) {
  63         DEBUG("reopen(0x%x, \"%s\", 0x%x)", FD, Path, Flags);
  64         return _Syscall(SYS_REOPEN, ">i >s >i", FD, Path, Flags);
  65 }
  66
  67 size_t acess_read(int FD, void *Dest, size_t Bytes) {
  68         if(FD & NATIVE_FILE_MASK)
  69                 return native_read(FD & (NATIVE_FILE_MASK-1), Dest, Bytes);
  70         DEBUG("read(0x%x, 0x%x, *%p)", FD, Bytes, Dest);
  71         return _Syscall(SYS_READ, ">i >i <d", FD, Bytes, Bytes, Dest);
  72 }
  73
  74 size_t acess_write(int FD, const void *Src, size_t Bytes) {
  75         if(FD & NATIVE_FILE_MASK)
  76                 return native_write(FD & (NATIVE_FILE_MASK-1), Src, Bytes);
  77         DEBUG("write(0x%x, 0x%x, %p\"%.*s\")", FD, Bytes, Src, Bytes, (char*)Src);
  78         return _Syscall(SYS_WRITE, ">i >i >d", FD, Bytes, Bytes, Src);
  79 }
  80
  81 int acess_seek(int FD, int64_t Ofs, int Dir) {
  82         if(FD & NATIVE_FILE_MASK) {
  83                 return native_seek(FD & (NATIVE_FILE_MASK-1), Ofs, Dir);
  84         }
  85         DEBUG("seek(0x%x, 0x%llx, %i)", FD, Ofs, Dir);
  86         return _Syscall(SYS_SEEK, ">i >I >i", FD, Ofs, Dir);
  87 }
  88
  89 uint64_t acess_tell(int FD) {
  90         if(FD & NATIVE_FILE_MASK)
  91                 return native_tell( FD & (NATIVE_FILE_MASK-1) );
  92         return _Syscall(SYS_TELL, ">i", FD);
  93 }
  94
  95 int acess_ioctl(int fd, int id, void *data) {
  96         // NOTE: 1024 byte size is a hack
  97         DEBUG("ioctl(%i, %i, %p)", fd, id, data);
  98         return _Syscall(SYS_IOCTL, ">i >i ?d", fd, id, 1024, data);
  99 }
 100 int acess_finfo(int fd, t_sysFInfo *info, int maxacls) {
 101 //      DEBUG("offsetof(size, t_sysFInfo) = %i", offsetof(t_sysFInfo, size));
 102         DEBUG("finfo(%i, %p, %i)", fd, info, maxacls);
 103         return _Syscall(SYS_FINFO, ">i <d >i",
 104                 fd,
 105                 sizeof(t_sysFInfo)+maxacls*sizeof(t_sysACL), info,
 106                 maxacls
 107                 );
 108 }
 109
 110 int acess_readdir(int fd, char *dest) {
 111         DEBUG("readdir(%i, %p)", fd, dest);
 112         return _Syscall(SYS_READDIR, ">i <d", fd, 256, dest);
 113 }
 114
 115 int acess__SysSelect(int nfds, fd_set *read, fd_set *write, fd_set *error, time_t *timeout, uint32_t events)
 116 {
 117         DEBUG("_SysSelect(%i, %p, %p, %p, %p, 0x%x)", nfds, read, write, error, timeout, events);
 118         return _Syscall(SYS_SELECT, ">i ?d ?d ?d >d >i", nfds,
 119                 read ? (nfds+7)/8 : 0, read,
 120                 write ? (nfds+7)/8 : 0, write,
 121                 error ? (nfds+7)/8 : 0, error,
 122                 sizeof(*timeout), timeout,
 123                 events
 124                 );
 125 }
 126
 127 int acess_select(int nfds, fd_set *read, fd_set *write, fd_set *error, time_t *timeout)
 128 {
 129         return acess__SysSelect(nfds, read, write, error, timeout, 0);
 130 }
 131
 132
 133 int acess__SysOpenChild(int fd, char *name, int flags) {
 134         return _Syscall(SYS_OPENCHILD, ">i >s >i", fd, name, flags);
 135 }
 136
 137 int acess__SysGetACL(int fd, t_sysACL *dest) {
 138         return _Syscall(SYS_GETACL, ">i <d", fd, sizeof(t_sysACL), dest);
 139 }
 140
 141 int acess__SysMount(const char *Device, const char *Directory, const char *Type, const char *Options) {
 142         return _Syscall(SYS_MOUNT, ">s >s >s >s", Device, Directory, Type, Options);
 143 }
 144
 145
 146 // --- Error Handler
 147 int acess__SysSetFaultHandler(int (*Handler)(int)) {
 148         printf("TODO: Set fault handler (asked to set to %p)\n", Handler);
 149         return 0;
 150 }
 151
 152 // --- Memory Management ---
 153 uint64_t acess__SysAllocate(uint vaddr)
 154 {
 155         if( AllocateMemory(vaddr, 0x1000) == -1 )       // Allocate a page
 156                 return 0;
 157
 158         return vaddr;   // Just ignore the need for paddrs :)
 159 }
 160
 161 // --- Process Management ---
 162 int acess_clone(int flags, void *stack)
 163 {
 164         extern int fork(void);
 165         if(flags & CLONE_VM) {
 166                  int    ret, newID, kernel_tid=0;
 167                 printf("USERSIDE fork()\n");
 168
 169                 newID = _Syscall(SYS_AN_FORK, "<d", sizeof(int), &kernel_tid);
 170                 ret = fork();
 171                 if(ret < 0) {
 172                         return ret;
 173                 }
 174
 175                 if(ret == 0)
 176                 {
 177                         _CloseSyscalls();
 178                         _InitSyscalls();
 179                         giSyscall_ClientID = newID;
 180                         return 0;
 181                 }
 182
 183                 // Return the acess TID instead
 184                 return kernel_tid;
 185         }
 186         else
 187         {
 188                 fprintf(stderr, "ERROR: Threads currently unsupported\n");
 189                 exit(-1);
 190         }
 191 }
 192
 193 int acess_execve(char *path, char **argv, char **envp)
 194 {
 195          int    i, argc;
 196
 197         DEBUG("acess_execve: (path='%s', argv=%p, envp=%p)", path, argv, envp);
 198
 199         // Get argument count
 200         for( argc = 0; argv[argc]; argc ++ ) ;
 201         DEBUG(" acess_execve: argc = %i", argc);
 202
 203         char    *new_argv[7+argc+1];
 204         char    client_id_str[11];
 205         char    socket_fd_str[11];
 206         sprintf(client_id_str, "%i", giSyscall_ClientID);
 207         sprintf(socket_fd_str, "%i", gSocket);
 208         new_argv[0] = "ld-acess";       // TODO: Get path to ld-acess executable
 209         new_argv[1] = "--key";          // Set client ID for Request.c
 210         new_argv[2] = client_id_str;
 211         new_argv[3] = "--socket";       // Socket
 212         new_argv[4] = socket_fd_str;
 213         new_argv[5] = "--binary";       // Set the binary path (instead of using argv[0])
 214         new_argv[6] = path;
 215         for( i = 0; i < argc; i ++ )    new_argv[7+i] = argv[i];
 216         new_argv[7+i] = NULL;
 217
 218         #if 1
 219         argc += 7;
 220         for( i = 0; i < argc; i ++ )
 221                 printf("\"%s\" ", new_argv[i]);
 222         printf("\n");
 223         if(envp)
 224         {
 225                 printf("envp = %p\n", envp);
 226                 for( i = 0; envp[i]; i ++ )
 227                         printf("%i: \"%s\"\n", i, envp[i]);
 228                 printf("envc = %i\n", i);
 229         }
 230         #endif
 231
 232         // Call actual execve
 233         return native_execve("./ld-acess", new_argv, envp);
 234 }
 235
 236 void acess_sleep(void)
 237 {
 238         _Syscall(SYS_SLEEP, "");
 239 }
 240
 241 int acess_waittid(int TID, int *ExitStatus)
 242 {
 243         return _Syscall(SYS_WAITTID, ">i <d", TID, sizeof(int), &ExitStatus);
 244 }
 245
 246 int acess_setuid(int ID) { return _Syscall(SYS_SETUID, ">i", ID); }
 247 int acess_setgid(int ID) { return _Syscall(SYS_SETGID, ">i", ID); }
 248 int acess_gettid(void) { return _Syscall(SYS_GETTID, ""); }
 249 int acess_getpid(void) { return _Syscall(SYS_GETPID, ""); }
 250 int acess_getuid(void) { return _Syscall(SYS_GETUID, ""); }
 251 int acess_getgid(void) { return _Syscall(SYS_GETGID, ""); }
 252
 253 int acess_SysSendMessage(int DestTID, int Length, void *Data)
 254 {
 255         return _Syscall(SYS_SENDMSG, ">i >d", DestTID, Length, Data);
 256 }
 257
 258 int acess_SysGetMessage(int *SourceTID, void *Data)
 259 {
 260         return _Syscall(SYS_GETMSG, "<d <d",
 261                 SourceTID ? sizeof(int) : 0, SourceTID,
 262                 Data ? 4096 : 0, Data
 263                 );
 264 }
 265
 266 // --- Logging
 267 void acess__SysDebug(const char *Format, ...)
 268 {
 269         va_list args;
 270
 271         va_start(args, Format);
 272
 273         printf("[_SysDebug %i]", giSyscall_ClientID);
 274         vprintf(Format, args);
 275         printf("\n");
 276
 277         va_end(args);
 278 }
 279
 280 void acess__exit(int Status)
 281 {
 282         DEBUG("_exit(%i)", Status);
 283         _Syscall(SYS_EXIT, ">i", Status);
 284         exit(Status);
 285 }
 286
 287
 288 // === Symbol List ===
 289 #define DEFSYM(name)    {#name, acess_##name}
 290 const tSym      caBuiltinSymbols[] = {
 291         DEFSYM(_exit),
 292
 293         DEFSYM(chdir),
 294         DEFSYM(open),
 295         DEFSYM(close),
 296         DEFSYM(reopen),
 297         DEFSYM(read),
 298         DEFSYM(write),
 299         DEFSYM(seek),
 300         DEFSYM(tell),
 301         DEFSYM(ioctl),
 302         DEFSYM(finfo),
 303         DEFSYM(readdir),
 304         DEFSYM(select),
 305         DEFSYM(_SysOpenChild),
 306         DEFSYM(_SysGetACL),
 307         DEFSYM(_SysMount),
 308         DEFSYM(_SysSelect),
 309
 310         DEFSYM(clone),
 311         DEFSYM(execve),
 312         DEFSYM(sleep),
 313
 314         DEFSYM(waittid),
 315         DEFSYM(setuid),
 316         DEFSYM(setgid),
 317         DEFSYM(gettid),
 318
 319         DEFSYM(SysSendMessage),
 320         DEFSYM(SysGetMessage),
 321
 322         DEFSYM(_SysAllocate),
 323         DEFSYM(_SysDebug),
 324         DEFSYM(_SysSetFaultHandler)
 325 };
 326
 327 const int       ciNumBuiltinSymbols = sizeof(caBuiltinSymbols)/sizeof(caBuiltinSymbols[0]);
 328