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