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