AcessNative/acesskernel_src/syscalls.c

   1 /*
   2  * Acess2 Native Kernel
   3  * - Acess kernel emulation on another OS using SDL and UDP
   4  *
   5  * Syscall Distribution
   6  */
   7 #define DEBUG   1
   8 #include <acess.h>
   9 #include <threads.h>
  10 #include <events.h>
  11 #if DEBUG == 0
  12 # define DONT_INCLUDE_SYSCALL_NAMES
  13 #endif
  14 #include "../syscalls.h"
  15
  16 // === IMPORTS ===
  17 extern int      Threads_Fork(void);     // AcessNative only function
  18 extern int      Threads_Spawn(int nFD, int FDs[], const void *info);
  19
  20 // === TYPES ===
  21 typedef int     (*tSyscallHandler)(Uint *Errno, const char *Format, void *Args, int *Sizes);
  22
  23 // === MACROS ===
  24 #define SYSCALL6(_name, _fmtstr, _t0, _t1, _t2, _t3, _t4, _t5, _call) int _name(Uint*Errno,const char*Fmt,void*Args,int*Sizes){\
  25         _t0 a0;_t1 a1;_t2 a2;_t3 a3;_t4 a4;_t5 a5;\
  26         if(strcmp(Fmt,_fmtstr)!=0)return 0;\
  27         a0 = *(_t0*)Args;Args+=sizeof(_t0);\
  28         a1 = *(_t1*)Args;Args+=sizeof(_t1);\
  29         a2 = *(_t2*)Args;Args+=sizeof(_t2);\
  30         a3 = *(_t3*)Args;Args+=sizeof(_t3);\
  31         a4 = *(_t4*)Args;Args+=sizeof(_t4);\
  32         a5 = *(_t5*)Args;Args+=sizeof(_t5);\
  33         LOG("SYSCALL6 '%s' %p %p %p %p %p %p", Fmt, (intptr_t)a0,(intptr_t)a1,(intptr_t)a2,(intptr_t)a3,(intptr_t)a4,(intptr_t)a5);\
  34         _call\
  35 }
  36 #define SYSCALL5(_name, _fmtstr, _t0, _t1, _t2, _t3, _t4, _call) int _name(Uint*Errno,const char*Fmt,void*Args,int*Sizes){\
  37         _t0 a0;_t1 a1;_t2 a2;_t3 a3;_t4 a4;\
  38         if(strcmp(Fmt,_fmtstr)!=0)return 0;\
  39         a0 = *(_t0*)Args;Args+=sizeof(_t0);\
  40         a1 = *(_t1*)Args;Args+=sizeof(_t1);\
  41         a2 = *(_t2*)Args;Args+=sizeof(_t2);\
  42         a3 = *(_t3*)Args;Args+=sizeof(_t3);\
  43         a4 = *(_t4*)Args;Args+=sizeof(_t4);\
  44         LOG("SYSCALL5 '%s' %p %p %p %p %p", Fmt, (intptr_t)a0,(intptr_t)a1,(intptr_t)a2,(intptr_t)a3,(intptr_t)a4);\
  45         _call\
  46 }
  47 #define SYSCALL4(_name, _fmtstr, _t0, _t1, _t2, _t3, _call) int _name(Uint*Errno,const char*Fmt,void*Args,int*Sizes){\
  48         _t0 a0;_t1 a1;_t2 a2;_t3 a3;\
  49         if(strcmp(Fmt,_fmtstr)!=0)return 0;\
  50         a0 = *(_t0*)Args;Args+=sizeof(_t0);\
  51         a1 = *(_t1*)Args;Args+=sizeof(_t1);\
  52         a2 = *(_t2*)Args;Args+=sizeof(_t2);\
  53         a3 = *(_t3*)Args;Args+=sizeof(_t3);\
  54         LOG("SYSCALL4 '%s' %p %p %p %p", Fmt, (intptr_t)a0,(intptr_t)a1,(intptr_t)a2,(intptr_t)a3);\
  55         _call\
  56 }
  57
  58 #define SYSCALL3(_name, _fmtstr, _t0, _t1, _t2, _call) int _name(Uint*Errno,const char*Fmt,void*Args,int*Sizes){\
  59         _t0 a0;_t1 a1;_t2 a2;\
  60         if(strcmp(Fmt,_fmtstr)!=0)return 0;\
  61         a0 = *(_t0*)Args;Args+=sizeof(_t0);\
  62         a1 = *(_t1*)Args;Args+=sizeof(_t1);\
  63         a2 = *(_t2*)Args;Args+=sizeof(_t2);\
  64         LOG("SYSCALL3 '%s' %p %p %p", Fmt, (intptr_t)a0,(intptr_t)a1,(intptr_t)a2);\
  65         _call\
  66 }
  67
  68 #define SYSCALL2(_name, _fmtstr, _t0, _t1, _call) int _name(Uint*Errno,const char*Fmt,void*Args,int*Sizes){\
  69         _t0 a0;_t1 a1;\
  70         if(strcmp(Fmt,_fmtstr)!=0)return 0;\
  71         a0 = *(_t0*)Args;Args+=sizeof(_t0);\
  72         a1 = *(_t1*)Args;Args+=sizeof(_t1);\
  73         LOG("SYSCALL2 '%s' %p %p", Fmt, (intptr_t)a0,(intptr_t)a1);\
  74         _call;\
  75 }
  76
  77 #define SYSCALL1(_name, _fmtstr, _t0, _call) int _name(Uint*Errno,const char*Fmt, void*Args,int*Sizes){\
  78         _t0 a0;\
  79         if(strcmp(Fmt,_fmtstr)!=0)return 0;\
  80         a0 = *(_t0*)Args;Args+=sizeof(_t0);\
  81         LOG("SYSCALL1 '%s' %p", Fmt,(intptr_t)a0);\
  82         _call;\
  83 }
  84
  85 #define SYSCALL0(_name, _call) int _name(Uint*Errno,const char*Fmt, void*Args,int*Sizes){\
  86         if(strcmp(Fmt,"")!=0)return 0;\
  87         LOG("SYSCALL0");\
  88         _call;\
  89 }
  90
  91 // === CODE ===
  92 int Syscall_Null(Uint *Errno, const char *Format, void *Args, int *Sizes)
  93 {
  94         return 0;
  95 }
  96
  97 SYSCALL1(Syscall_Exit, "i", int,
  98         Threads_Exit(0, a0);
  99         return 0;
 100 );
 101
 102 SYSCALL2(Syscall_Open, "si", const char *, int,
 103         int rv = VFS_Open(a0, a1|VFS_OPENFLAG_USER);
 104         if(rv == -1)    *Errno = errno;
 105         return rv;
 106 );
 107 SYSCALL1(Syscall_Close, "i", int,
 108         VFS_Close(a0);
 109         return 0;
 110 );
 111 SYSCALL3(Syscall_Read, "iid", int, int, void *,
 112         if( Sizes[2] < a1 ) {
 113                 Log_Warning("Syscalls", "Read - %i < %i", Sizes[2], a1);
 114                 return -1;
 115         }
 116         size_t rv = VFS_Read(a0, a1, a2);
 117         if(rv == -1)    *Errno = errno;
 118         return rv;
 119 );
 120 SYSCALL3(Syscall_Write, "iid", int, int, const void *,
 121         if( Sizes[2] < a1 ) {
 122                 Log_Warning("Syscalls", "Write - %x < %x", (int)Sizes[2], (int)a1);
 123                 *Errno = EINVAL;
 124                 return -1;
 125         }
 126         size_t rv = VFS_Write(a0, a1, a2);
 127         if(rv == -1)    *Errno = errno;
 128         return rv;
 129 );
 130 SYSCALL3(Syscall_Seek, "iIi", int, int64_t, int,
 131         return VFS_Seek(a0, a1, a2);
 132 );
 133 SYSCALL1(Syscall_Tell, "i", int,
 134         return VFS_Tell(a0);
 135 );
 136 SYSCALL3(Syscall_IOCtl, "iid", int, int, void *,
 137         return VFS_IOCtl(a0, a1, a2);
 138 );
 139 SYSCALL3(Syscall_FInfo, "idi", int, void *, int,
 140         if( Sizes[1] < sizeof(tFInfo)+a2*sizeof(tVFS_ACL)) {
 141                 //LOG("offsetof(size) = %i", offsetof(tFInfo, size));
 142                 LOG("Bad size %i < %i", Sizes[1], sizeof(tFInfo)+a2*sizeof(tVFS_ACL));
 143                 *Errno = -EINVAL;
 144                 return -1;
 145         }
 146         return VFS_FInfo(a0, a1, a2);
 147 );
 148 SYSCALL2(Syscall_ReadDir, "id", int, char *,
 149         if(Sizes[1] < 255)
 150                 return -1;
 151         return VFS_ReadDir(a0, a1);
 152 );
 153 SYSCALL6(Syscall_select, "iddddi", int, fd_set *, fd_set *, fd_set *, tTime *, unsigned int,
 154         return VFS_Select(a0, a1, a2, a3, a4, a5, 0);
 155 );
 156 SYSCALL3(Syscall_OpenChild, "isi", int, const char *, int,
 157         return VFS_OpenChild(a0, a1, a2|VFS_OPENFLAG_USER);
 158 );
 159 SYSCALL2(Syscall_GetACL, "id", int, void *,
 160         if(Sizes[1] < sizeof(tVFS_ACL))
 161                 return -1;
 162         return VFS_GetACL(a0, (void*)a1);
 163 );
 164 SYSCALL4(Syscall_Mount, "ssss", const char *, const char *, const char *, const char *,
 165         return VFS_Mount(a0, a1, a2, a3);
 166 );
 167 SYSCALL1(Syscall_Chdir, "s", const char *,
 168         return VFS_ChDir(a0);
 169 );
 170 SYSCALL0(Syscall_Sleep,
 171         Threads_Sleep();
 172         return 0;
 173 );
 174 SYSCALL2(Syscall_WaitTID, "id", int, int *,
 175         if(Sizes[1] < sizeof(int))
 176                 return -1;
 177         return Threads_WaitTID(a0, a1);
 178 );
 179 SYSCALL1(Syscall_SetUID, "i", int,
 180         if(Sizes[0] < sizeof(int)) {
 181                 *Errno = -EINVAL;       // TODO: Better message
 182                 return -1;
 183         }
 184         return Threads_SetUID(a0);
 185 );
 186 SYSCALL1(Syscall_SetGID, "i", int,
 187         if(Sizes[0] < sizeof(int)) {
 188                 *Errno = -EINVAL;       // TODO: Better message
 189                 return -1;
 190         }
 191         return Threads_SetGID(a0);
 192 );
 193
 194 SYSCALL0(Syscall_GetTID, return Threads_GetTID());
 195 SYSCALL0(Syscall_GetPID, return Threads_GetPID());
 196 SYSCALL0(Syscall_GetUID, return Threads_GetUID());
 197 SYSCALL0(Syscall_GetGID, return Threads_GetGID());
 198
 199 SYSCALL1(Syscall_AN_Fork, "d", int *,
 200         if(Sizes[0] < sizeof(int))
 201                 return -1;
 202         *a0 = Threads_Fork();
 203         return *a0;
 204 );
 205
 206 SYSCALL3(Syscall_AN_Spawn, "ddd", int *, int *, void *,
 207         if(Sizes[0] < sizeof(int))
 208                 return -1;
 209         *a0 = Threads_Spawn(Sizes[1] / sizeof(int), a1, a2);
 210         return *a0;
 211 );
 212
 213 SYSCALL2(Syscall_SendMessage, "id", int, void *,
 214         return Proc_SendMessage(a0, Sizes[1], a1);
 215 );
 216
 217 SYSCALL2(Syscall_GetMessage, "dd", uint32_t *, void *,
 218         if( a0 && Sizes[0] < sizeof(*a0) ) {
 219                 Log_Notice("Syscalls", "Syscall_GetMessage - Arg 1 Undersize (%i < %i)",
 220                         Sizes[0], sizeof(*a0));
 221                 return -1;
 222         }
 223         Uint    tmp;
 224          int    rv;
 225         if( a0 ) {
 226                 rv = Proc_GetMessage(&tmp, Sizes[1], a1);
 227                 *a0 = tmp;
 228         }
 229         else
 230                 rv = Proc_GetMessage(NULL, Sizes[1], a1);
 231         return rv;
 232 );
 233
 234 SYSCALL1(Syscall_WaitEvent, "i", int,
 235         return Threads_WaitEvents(a0);
 236 );
 237
 238 const tSyscallHandler   caSyscalls[] = {
 239         [SYS_NULL]      = Syscall_Null,
 240         [SYS_EXIT]      = Syscall_Exit,
 241         [SYS_OPEN]      = Syscall_Open,
 242         [SYS_CLOSE]     = Syscall_Close,
 243         [SYS_COPYFD]    = NULL,
 244         [SYS_FDFLAGS]   = NULL,
 245         [SYS_READ]      = Syscall_Read,
 246         [SYS_WRITE]     = Syscall_Write,
 247         [SYS_SEEK]      = Syscall_Seek,
 248         [SYS_TELL]      = Syscall_Tell,
 249         [SYS_IOCTL]     = Syscall_IOCtl,
 250         [SYS_FINFO]     = Syscall_FInfo,
 251         [SYS_READDIR]   = Syscall_ReadDir,
 252         [SYS_OPENCHILD] = Syscall_OpenChild,
 253         [SYS_GETACL]    = Syscall_GetACL,
 254         [SYS_MOUNT]     = Syscall_Mount,
 255         [SYS_REOPEN]    = NULL, // SYS_REOPEN
 256         [SYS_CHDIR]     = Syscall_Chdir,
 257
 258         [SYS_WAITTID]   = Syscall_WaitTID,
 259         [SYS_SETUID]    = Syscall_SetUID,
 260         [SYS_SETGID]    = Syscall_SetGID,
 261
 262         Syscall_GetTID,
 263         Syscall_GetPID,
 264         Syscall_GetUID,
 265         Syscall_GetGID,
 266
 267         Syscall_Sleep,
 268         Syscall_AN_Fork,
 269         Syscall_AN_Spawn,
 270
 271         Syscall_SendMessage,
 272         Syscall_GetMessage,
 273         Syscall_select,
 274         Syscall_WaitEvent
 275 };
 276 const int       ciNumSyscalls = sizeof(caSyscalls)/sizeof(caSyscalls[0]);
 277 /**
 278  * \brief Recieve a syscall structure from the server code
 279  */
 280 tRequestHeader *SyscallRecieve(tRequestHeader *Request, size_t *ReturnLength)
 281 {
 282         char    formatString[Request->NParams+1];
 283         char    *inData = (char*)&Request->Params[Request->NParams];
 284          int    argListLen = 0;
 285          int    retVal;
 286         tRequestHeader  *ret;
 287          int    retValueCount;
 288          int    retDataLen;
 289         void    *returnData[Request->NParams];
 290          int    argSizes[Request->NParams];
 291         Uint    ret_errno = 0;
 292
 293         // Clear errno (Acess verson) at the start of the request
 294         errno = 0;
 295
 296         // Sanity check
 297         if( Request->CallID >= ciNumSyscalls ) {
 298                 Log_Notice("Syscalls", "Unknown syscall number %i", Request->CallID);
 299                 return NULL;
 300         }
 301
 302         if( !caSyscalls[Request->CallID] ) {
 303                 Log_Notice("Syscalls", "Unimplemented syscall %i", Request->CallID);
 304                 return NULL;
 305         }
 306
 307         // Init return count/size
 308         retValueCount = 2;
 309         retDataLen = sizeof(Uint64) + sizeof(Uint32);
 310
 311         // Get size of argument list
 312         for( int i = 0; i < Request->NParams; i ++ )
 313         {
 314                 argSizes[i] = Request->Params[i].Length;
 315                 switch(Request->Params[i].Type)
 316                 {
 317                 case ARG_TYPE_VOID:
 318                         formatString[i] = '-';
 319                         break;
 320                 case ARG_TYPE_INT32:
 321                         formatString[i] = 'i';
 322                         argListLen += sizeof(Uint32);
 323                         break;
 324                 case ARG_TYPE_INT64:
 325                         formatString[i] = 'I';
 326                         argListLen += sizeof(Uint64);
 327                         break;
 328                 case ARG_TYPE_DATA:
 329                         formatString[i] = 'd';
 330                         argListLen += sizeof(void*);
 331                         // Prepare the return values
 332                         if( Request->Params[i].Flags & ARG_FLAG_RETURN )
 333                         {
 334                                 retDataLen += Request->Params[i].Length;
 335                                 retValueCount ++;
 336                         }
 337                         break;
 338                 case ARG_TYPE_STRING:
 339                         formatString[i] = 's';
 340                         argListLen += sizeof(char*);
 341                         break;
 342                 default:
 343                         Log_Error("Syscalls", "Unknown param type %i", Request->Params[i].Type);
 344                         return NULL;    // ERROR!
 345                 }
 346         }
 347         formatString[Request->NParams] = '\0';
 348
 349         LOG("Request %i(%s) '%s'", Request->CallID, casSYSCALL_NAMES[Request->CallID], formatString);
 350
 351         {
 352                 char    argListData[argListLen];
 353                 argListLen = 0;
 354                 // Build argument list
 355                 for( int i = 0; i < Request->NParams; i ++ )
 356                 {
 357                         returnData[i] = NULL;
 358                         switch(Request->Params[i].Type)
 359                         {
 360                         case ARG_TYPE_VOID:
 361                                 break;
 362                         case ARG_TYPE_INT32:
 363                                 //LOG("%i INT32: 0x%x", i, *(Uint32*)inData);
 364                                 *(Uint32*)&argListData[argListLen] = *(Uint32*)inData;
 365                                 argListLen += sizeof(Uint32);
 366                                 inData += sizeof(Uint32);
 367                                 break;
 368                         case ARG_TYPE_INT64:
 369                                 //LOG("%i INT64: 0x%llx", i, *(Uint64*)inData);
 370                                 *(Uint64*)&argListData[argListLen] = *(Uint64*)inData;
 371                                 argListLen += sizeof(Uint64);
 372                                 inData += sizeof(Uint64);
 373                                 break;
 374                         case ARG_TYPE_STRING:
 375                                 //LOG("%i STR: '%s'", i, (char*)inData);
 376                                 *(char**)&argListData[argListLen] = (char*)inData;
 377                                 argListLen += sizeof(void*);
 378                                 inData += Request->Params[i].Length;
 379                                 break;
 380
 381                         // Data gets special handling, because only it can be returned to the user
 382                         // (ARG_TYPE_DATA is a pointer)
 383                         case ARG_TYPE_DATA:
 384                                 // Check for non-resident data
 385                                 if( Request->Params[i].Length == 0 )
 386                                 {
 387                                         returnData[i] = NULL;
 388                                         *(void**)&argListData[argListLen] = NULL;
 389                                         argListLen += sizeof(void*);
 390                                 }
 391                                 else if( Request->Params[i].Flags & ARG_FLAG_ZEROED )
 392                                 {
 393                                         // Allocate and zero the buffer
 394                                         returnData[i] = calloc(1, Request->Params[i].Length);
 395                                         //LOG("%i ZDAT: %i %p", i,
 396                                         //      Request->Params[i].Length, returnData[i]);
 397                                         *(void**)&argListData[argListLen] = returnData[i];
 398                                         argListLen += sizeof(void*);
 399                                 }
 400                                 else
 401                                 {
 402                                         returnData[i] = (void*)inData;
 403                                         //LOG("%i DATA: %i %p", i,
 404                                         //      Request->Params[i].Length, returnData[i]);
 405                                         *(void**)&argListData[argListLen] = (void*)inData;
 406                                         argListLen += sizeof(void*);
 407                                         inData += Request->Params[i].Length;
 408                                 }
 409                                 break;
 410                         }
 411                 }
 412
 413                 // --- Perform request
 414                 retVal = caSyscalls[Request->CallID](&ret_errno, formatString, argListData, argSizes);
 415         }
 416
 417         // ---------- Return
 418
 419         if( ret_errno == 0 && errno != 0 ) {
 420                 ret_errno = errno;
 421                 LOG("errno = %i", errno);
 422         }
 423
 424         // Allocate the return
 425         size_t  msglen = sizeof(tRequestHeader) + retValueCount * sizeof(tRequestValue) + retDataLen;
 426         ret = malloc(msglen);
 427         ret->ClientID = Request->ClientID;
 428         ret->CallID = Request->CallID;
 429         ret->NParams = retValueCount;
 430         ret->MessageLength = msglen;
 431         inData = (char*)&ret->Params[ ret->NParams ];
 432
 433         // Static Uint64 return value
 434         ret->Params[0].Type = ARG_TYPE_INT64;
 435         ret->Params[0].Flags = 0;
 436         ret->Params[0].Length = sizeof(Uint64);
 437         *(Uint64*)inData = retVal;
 438         inData += sizeof(Uint64);
 439
 440         // Static Uint32 errno value
 441         ret->Params[1].Type = ARG_TYPE_INT32;
 442         ret->Params[1].Flags = 0;
 443         ret->Params[1].Length = sizeof(Uint32);
 444         *(Uint32*)inData = ret_errno;
 445         inData += sizeof(Uint32);
 446
 447         LOG("Ret: %llx, errno=%i", retVal, ret_errno);
 448
 449         //Log_Debug("Syscalls", "Return 0x%llx", retVal);
 450
 451         retValueCount = 2;
 452         for( int i = 0; i < Request->NParams; i ++ )
 453         {
 454                 if( Request->Params[i].Type != ARG_TYPE_DATA )  continue;
 455                 if( !(Request->Params[i].Flags & ARG_FLAG_RETURN) )     continue;
 456
 457                 ret->Params[retValueCount].Type = Request->Params[i].Type;
 458                 ret->Params[retValueCount].Flags = 0;
 459                 ret->Params[retValueCount].Length = Request->Params[i].Length;
 460
 461                 LOG("Ret %i: Type %i, Len %i",
 462                         i, Request->Params[i].Type, Request->Params[i].Length);
 463
 464                 memcpy(inData, returnData[i], Request->Params[i].Length);
 465                 inData += Request->Params[i].Length;
 466
 467                 if( Request->Params[i].Flags & ARG_FLAG_ZEROED )
 468                         free( returnData[i] );  // Free temp buffer from above
 469                 retValueCount ++;
 470         }
 471
 472         *ReturnLength = ret->MessageLength;
 473
 474         return ret;
 475 }