Removed some unused page functions
[akaros.git] / kern / src / syscall.c
1 /* See COPYRIGHT for copyright information. */
2
3 #ifdef __SHARC__
4 #pragma nosharc
5 #endif
6
7 #include <ros/common.h>
8 #include <ros/notification.h>
9 #include <arch/types.h>
10 #include <arch/arch.h>
11 #include <arch/mmu.h>
12 #include <arch/console.h>
13 #include <ros/timer.h>
14 #include <error.h>
15
16 #include <elf.h>
17 #include <string.h>
18 #include <assert.h>
19 #include <process.h>
20 #include <schedule.h>
21 #include <pmap.h>
22 #include <umem.h>
23 #include <mm.h>
24 #include <trap.h>
25 #include <syscall.h>
26 #include <kmalloc.h>
27 #include <stdio.h>
28 #include <resource.h>
29 #include <frontend.h>
30 #include <colored_caches.h>
31 #include <hashtable.h>
32 #include <arch/bitmask.h>
33 #include <vfs.h>
34 #include <devfs.h>
35 #include <smp.h>
36 #include <arsc_server.h>
37
38
39 #ifdef __CONFIG_NETWORKING__
40 #include <arch/nic_common.h>
41 extern int (*send_frame)(const char *CT(len) data, size_t len);
42 extern unsigned char device_mac[6];
43 #endif
44
45 /* Tracing Globals */
46 int systrace_flags = 0;
47 struct systrace_record *systrace_buffer = 0;
48 unsigned int systrace_bufidx = 0;
49 size_t systrace_bufsize = 0;
50 struct proc *systrace_procs[MAX_NUM_TRACED] = {0};
51 spinlock_t systrace_lock = SPINLOCK_INITIALIZER;
52
53 /* Not enforcing the packing of systrace_procs yet, but don't rely on that */
54 static bool proc_is_traced(struct proc *p)
55 {
56         for (int i = 0; i < MAX_NUM_TRACED; i++)
57                 if (systrace_procs[i] == p)
58                         return true;
59         return false;
60 }
61
62 /************** Utility Syscalls **************/
63
64 static int sys_null(void)
65 {
66         return 0;
67 }
68
69 // Writes 'val' to 'num_writes' entries of the well-known array in the kernel
70 // address space.  It's just #defined to be some random 4MB chunk (which ought
71 // to be boot_alloced or something).  Meant to grab exclusive access to cache
72 // lines, to simulate doing something useful.
73 static int sys_cache_buster(struct proc *p, uint32_t num_writes,
74                              uint32_t num_pages, uint32_t flags)
75 { TRUSTEDBLOCK /* zra: this is not really part of the kernel */
76         #define BUSTER_ADDR             0xd0000000  // around 512 MB deep
77         #define MAX_WRITES              1048576*8
78         #define MAX_PAGES               32
79         #define INSERT_ADDR     (UINFO + 2*PGSIZE) // should be free for these tests
80         uint32_t* buster = (uint32_t*)BUSTER_ADDR;
81         static spinlock_t buster_lock = SPINLOCK_INITIALIZER;
82         uint64_t ticks = -1;
83         page_t* a_page[MAX_PAGES];
84
85         /* Strided Accesses or Not (adjust to step by cachelines) */
86         uint32_t stride = 1;
87         if (flags & BUSTER_STRIDED) {
88                 stride = 16;
89                 num_writes *= 16;
90         }
91
92         /* Shared Accesses or Not (adjust to use per-core regions)
93          * Careful, since this gives 8MB to each core, starting around 512MB.
94          * Also, doesn't separate memory for core 0 if it's an async call.
95          */
96         if (!(flags & BUSTER_SHARED))
97                 buster = (uint32_t*)(BUSTER_ADDR + core_id() * 0x00800000);
98
99         /* Start the timer, if we're asked to print this info*/
100         if (flags & BUSTER_PRINT_TICKS)
101                 ticks = start_timing();
102
103         /* Allocate num_pages (up to MAX_PAGES), to simulate doing some more
104          * realistic work.  Note we don't write to these pages, even if we pick
105          * unshared.  Mostly due to the inconvenience of having to match up the
106          * number of pages with the number of writes.  And it's unnecessary.
107          */
108         if (num_pages) {
109                 spin_lock(&buster_lock);
110                 for (int i = 0; i < MIN(num_pages, MAX_PAGES); i++) {
111                         upage_alloc(p, &a_page[i],1);
112                         page_insert(p->env_pgdir, a_page[i], (void*)INSERT_ADDR + PGSIZE*i,
113                                     PTE_USER_RW);
114                 }
115                 spin_unlock(&buster_lock);
116         }
117
118         if (flags & BUSTER_LOCKED)
119                 spin_lock(&buster_lock);
120         for (int i = 0; i < MIN(num_writes, MAX_WRITES); i=i+stride)
121                 buster[i] = 0xdeadbeef;
122         if (flags & BUSTER_LOCKED)
123                 spin_unlock(&buster_lock);
124
125         if (num_pages) {
126                 spin_lock(&buster_lock);
127                 for (int i = 0; i < MIN(num_pages, MAX_PAGES); i++) {
128                         page_remove(p->env_pgdir, (void*)(INSERT_ADDR + PGSIZE * i));
129                         page_decref(a_page[i]);
130                 }
131                 spin_unlock(&buster_lock);
132         }
133
134         /* Print info */
135         if (flags & BUSTER_PRINT_TICKS) {
136                 ticks = stop_timing(ticks);
137                 printk("%llu,", ticks);
138         }
139         return 0;
140 }
141
142 static int sys_cache_invalidate(void)
143 {
144         #ifdef __i386__
145                 wbinvd();
146         #endif
147         return 0;
148 }
149
150 /* sys_reboot(): called directly from dispatch table. */
151
152 /* Print a string to the system console. */
153 static ssize_t sys_cputs(struct proc *p, const char *DANGEROUS string,
154                          size_t strlen)
155 {
156         char *t_string;
157         t_string = user_strdup_errno(p, string, strlen);
158         if (!t_string)
159                 return -1;
160         printk("%.*s", strlen, t_string);
161         user_memdup_free(p, t_string);
162         return (ssize_t)strlen;
163 }
164
165 // Read a character from the system console.
166 // Returns the character.
167 static uint16_t sys_cgetc(struct proc *p)
168 {
169         uint16_t c;
170
171         // The cons_getc() primitive doesn't wait for a character,
172         // but the sys_cgetc() system call does.
173         while ((c = cons_getc()) == 0)
174                 cpu_relax();
175
176         return c;
177 }
178
179 /* Returns the id of the cpu this syscall is executed on. */
180 static uint32_t sys_getcpuid(void)
181 {
182         return core_id();
183 }
184
185 // TODO: Temporary hack until thread-local storage is implemented on i386 and
186 // this is removed from the user interface
187 static size_t sys_getvcoreid(struct proc *p)
188 {
189         return proc_get_vcoreid(p, core_id());
190 }
191
192 /************** Process management syscalls **************/
193
194 /* Returns the calling process's pid */
195 static pid_t sys_getpid(struct proc *p)
196 {
197         return p->pid;
198 }
199
200 /* Creates a process from the file 'path'.  The process is not runnable by
201  * default, so it needs it's status to be changed so that the next call to
202  * schedule() will try to run it.  TODO: take args/envs from userspace. */
203 static int sys_proc_create(struct proc *p, char *path, size_t path_l,
204                            struct procinfo *pi)
205 {
206         int pid = 0;
207         char *t_path;
208         struct file *program;
209         struct proc *new_p;
210
211         /* Copy in the path.  Consider putting an upper bound on path_l. */
212         t_path = user_strdup_errno(p, path, path_l);
213         if (!t_path)
214                 return -1;
215         program = do_file_open(t_path, 0, 0);
216         user_memdup_free(p, t_path);
217         if (!program)
218                 return -1;                      /* presumably, errno is already set */
219         /* TODO: need to split the proc creation, since you must load after setting
220          * args/env, since auxp gets set up there. */
221         //new_p = proc_create(program, 0, 0);
222         if (proc_alloc(&new_p, current))
223                 goto mid_error;
224         /* Set the argument stuff needed by glibc */
225         if (memcpy_from_user_errno(p, new_p->procinfo->argp, pi->argp,
226                                    sizeof(pi->argp)))
227                 goto late_error;
228         if (memcpy_from_user_errno(p, new_p->procinfo->argbuf, pi->argbuf,
229                                    sizeof(pi->argbuf)))
230                 goto late_error;
231         if (load_elf(new_p, program))
232                 goto late_error;
233         kref_put(&program->f_kref);
234         /* Connect to stdin, stdout, stderr (part of proc_create()) */
235         assert(insert_file(&new_p->open_files, dev_stdin,  0) == 0);
236         assert(insert_file(&new_p->open_files, dev_stdout, 0) == 1);
237         assert(insert_file(&new_p->open_files, dev_stderr, 0) == 2);
238         __proc_ready(new_p);
239         pid = new_p->pid;
240         kref_put(&new_p->kref); /* give up the reference created in proc_create() */
241         return pid;
242 late_error:
243         proc_destroy(new_p);
244 mid_error:
245         kref_put(&program->f_kref);
246         return -1;
247 }
248
249 /* Makes process PID runnable.  Consider moving the functionality to process.c */
250 static error_t sys_proc_run(struct proc *p, unsigned pid)
251 {
252         struct proc *target = pid2proc(pid);
253         error_t retval = 0;
254
255         if (!target)
256                 return -EBADPROC;
257         // note we can get interrupted here. it's not bad.
258         spin_lock(&p->proc_lock);
259         // make sure we have access and it's in the right state to be activated
260         if (!proc_controls(p, target)) {
261                 kref_put(&target->kref);
262                 retval = -EPERM;
263         } else if (target->state != PROC_CREATED) {
264                 kref_put(&target->kref);
265                 retval = -EINVAL;
266         } else {
267                 __proc_set_state(target, PROC_RUNNABLE_S);
268                 schedule_proc(target);
269         }
270         spin_unlock(&p->proc_lock);
271         kref_put(&target->kref);
272         return retval;
273 }
274
275 /* Destroy proc pid.  If this is called by the dying process, it will never
276  * return.  o/w it will return 0 on success, or an error.  Errors include:
277  * - EBADPROC: if there is no such process with pid
278  * - EPERM: if caller does not control pid */
279 static error_t sys_proc_destroy(struct proc *p, pid_t pid, int exitcode)
280 {
281         error_t r;
282         struct proc *p_to_die = pid2proc(pid);
283
284         if (!p_to_die) {
285                 set_errno(ESRCH);
286                 return -1;
287         }
288         if (!proc_controls(p, p_to_die)) {
289                 kref_put(&p_to_die->kref);
290                 set_errno(EPERM);
291                 return -1;
292         }
293         if (p_to_die == p) {
294                 // syscall code and pid2proc both have edible references, only need 1.
295                 p->exitcode = exitcode;
296                 kref_put(&p_to_die->kref);
297                 printd("[PID %d] proc exiting gracefully (code %d)\n", p->pid,exitcode);
298         } else {
299                 printd("[%d] destroying proc %d\n", p->pid, p_to_die->pid);
300         }
301         proc_destroy(p_to_die);
302         kref_put(&p_to_die->kref);
303         return ESUCCESS;
304 }
305
306 static int sys_proc_yield(struct proc *p, bool being_nice)
307 {
308         proc_yield(p, being_nice);
309         return 0;
310 }
311
312 static ssize_t sys_fork(env_t* e)
313 {
314         // TODO: right now we only support fork for single-core processes
315         if (e->state != PROC_RUNNING_S) {
316                 set_errno(EINVAL);
317                 return -1;
318         }
319         /* Can't really fork if we don't have a current_tf to fork */
320         if (!current_tf) {
321                 set_errno(EINVAL);
322                 return -1;
323         }
324         env_t* env;
325         assert(!proc_alloc(&env, current));
326         assert(env != NULL);
327
328         env->heap_top = e->heap_top;
329         env->ppid = e->pid;
330         env->env_tf = *current_tf;
331
332         env->cache_colors_map = cache_colors_map_alloc();
333         for(int i=0; i < llc_cache->num_colors; i++)
334                 if(GET_BITMASK_BIT(e->cache_colors_map,i))
335                         cache_color_alloc(llc_cache, env->cache_colors_map);
336
337         duplicate_vmrs(e, env);
338
339         int copy_page(env_t* e, pte_t* pte, void* va, void* arg)
340         {
341                 env_t* env = (env_t*)arg;
342
343                 if(PAGE_PRESENT(*pte))
344                 {
345                         page_t* pp;
346                         if(upage_alloc(env,&pp,0))
347                                 return -1;
348                         if(page_insert(env->env_pgdir,pp,va,*pte & PTE_PERM))
349                         {
350                                 page_decref(pp);
351                                 return -1;
352                         }
353
354                         pagecopy(page2kva(pp),ppn2kva(PTE2PPN(*pte)));
355                 } else {
356                         assert(PAGE_PAGED_OUT(*pte));
357                         /* TODO: (SWAP) will need to either make a copy or CoW/refcnt the
358                          * backend store.  For now, this PTE will be the same as the
359                          * original PTE */
360                         panic("Swapping not supported!");
361                         pte_t* newpte = pgdir_walk(env->env_pgdir,va,1);
362                         if(!newpte)
363                                 return -1;
364                         *newpte = *pte;
365                 }
366                 return 0;
367         }
368
369         // TODO: (PC) this won't work.  Needs revisiting.
370         // copy procdata and procinfo
371         memcpy(env->procdata,e->procdata,sizeof(struct procdata));
372         memcpy(env->procinfo,e->procinfo,sizeof(struct procinfo));
373         env->procinfo->pid = env->pid;
374         env->procinfo->ppid = env->ppid;
375
376         /* for now, just copy the contents of every present page in the entire
377          * address space. */
378         if (env_user_mem_walk(e, 0, UMAPTOP, &copy_page, env)) {
379                 proc_destroy(env);      /* this is prob what you want, not decref by 2 */
380                 set_errno(ENOMEM);
381                 return -1;
382         }
383         clone_files(&e->open_files, &env->open_files);
384         __proc_ready(env);
385         __proc_set_state(env, PROC_RUNNABLE_S);
386         schedule_proc(env);
387
388         // don't decref the new process.
389         // that will happen when the parent waits for it.
390         // TODO: if the parent doesn't wait, we need to change the child's parent
391         // when the parent dies, or at least decref it
392
393         printd("[PID %d] fork PID %d\n",e->pid,env->pid);
394         return env->pid;
395 }
396
397 /* Load the binary "path" into the current process, and start executing it.
398  * argv and envp are magically bundled in procinfo for now.  Keep in sync with
399  * glibc's sysdeps/ros/execve.c */
400 static int sys_exec(struct proc *p, char *path, size_t path_l,
401                     struct procinfo *pi)
402 {
403         int ret = -1;
404         char *t_path;
405         struct file *program;
406
407         /* We probably want it to never be allowed to exec if it ever was _M */
408         if (p->state != PROC_RUNNING_S) {
409                 set_errno(EINVAL);
410                 return -1;
411         }
412         /* Can't really exec if we don't have a current_tf to reset */
413         if (!current_tf) {
414                 set_errno(EINVAL);
415                 return -1;
416         }
417         /* Copy in the path.  Consider putting an upper bound on path_l. */
418         t_path = user_strdup_errno(p, path, path_l);
419         if (!t_path)
420                 return -1;
421         program = do_file_open(t_path, 0, 0);
422         user_memdup_free(p, t_path);
423         if (!program)
424                 return -1;                      /* presumably, errno is already set */
425         /* Set the argument stuff needed by glibc */
426         if (memcpy_from_user_errno(p, p->procinfo->argp, pi->argp,
427                                    sizeof(pi->argp)))
428                 goto mid_error;
429         if (memcpy_from_user_errno(p, p->procinfo->argbuf, pi->argbuf,
430                                    sizeof(pi->argbuf)))
431                 goto mid_error;
432         /* This is the point of no return for the process. */
433         /* TODO: issues with this: Need to also assert there are no outstanding
434          * users of the sysrings.  the ldt page will get freed shortly, so that's
435          * okay.  Potentially issues with the nm and vcpd if we were in _M before
436          * and someone is trying to notify. */
437         memset(p->procdata, 0, sizeof(procdata_t));
438         destroy_vmrs(p);
439         close_all_files(&p->open_files, TRUE);
440         env_user_mem_free(p, 0, UMAPTOP);
441         if (load_elf(p, program)) {
442                 kref_put(&program->f_kref);
443                 proc_destroy(p);
444                 smp_idle();             /* syscall can't return on failure now */
445         }
446         printd("[PID %d] exec %s\n", p->pid, file_name(program));
447         kref_put(&program->f_kref);
448         *current_tf = p->env_tf;
449         return 0;
450 mid_error:
451         kref_put(&program->f_kref);
452         return -1;
453 }
454
455 static ssize_t sys_trywait(env_t* e, pid_t pid, int* status)
456 {
457         struct proc* p = pid2proc(pid);
458
459         // TODO: this syscall is racy, so we only support for single-core procs
460         if(e->state != PROC_RUNNING_S)
461                 return -1;
462
463         // TODO: need to use errno properly.  sadly, ROS error codes conflict..
464
465         if(p)
466         {
467                 ssize_t ret;
468
469                 if(current->pid == p->ppid)
470                 {
471                         if(p->state == PROC_DYING)
472                         {
473                                 memcpy_to_user(e,status,&p->exitcode,sizeof(int));
474                                 printd("[PID %d] waited for PID %d (code %d)\n",
475                                        e->pid,p->pid,p->exitcode);
476                                 ret = 0;
477                         }
478                         else // not dead yet
479                         {
480                                 set_errno(ESUCCESS);
481                                 ret = -1;
482                         }
483                 }
484                 else // not a child of the calling process
485                 {
486                         set_errno(EPERM);
487                         ret = -1;
488                 }
489
490                 // if the wait succeeded, decref twice
491                 if (ret == 0)
492                         kref_put(&p->kref);
493                 kref_put(&p->kref);
494                 return ret;
495         }
496
497         set_errno(EPERM);
498         return -1;
499 }
500
501 /************** Memory Management Syscalls **************/
502
503 static void *sys_mmap(struct proc *p, uintreg_t a1, uintreg_t a2, uintreg_t a3,
504                       uintreg_t *a456)
505 {
506         uintreg_t _a456[3];
507         if (memcpy_from_user(p, _a456, a456, 3 * sizeof(uintreg_t)))
508                 sys_proc_destroy(p, p->pid, -1);
509         return mmap(p, a1, a2, a3, _a456[0], _a456[1], _a456[2]);
510 }
511
512 static intreg_t sys_mprotect(struct proc *p, void *addr, size_t len, int prot)
513 {
514         return mprotect(p, (uintptr_t)addr, len, prot);
515 }
516
517 static intreg_t sys_munmap(struct proc *p, void *addr, size_t len)
518 {
519         return munmap(p, (uintptr_t)addr, len);
520 }
521
522 static ssize_t sys_shared_page_alloc(env_t* p1,
523                                      void**DANGEROUS _addr, pid_t p2_id,
524                                      int p1_flags, int p2_flags
525                                     )
526 {
527         printk("[kernel] shared page alloc is deprecated/unimplemented.\n");
528         return -1;
529 }
530
531 static int sys_shared_page_free(env_t* p1, void*DANGEROUS addr, pid_t p2)
532 {
533         return -1;
534 }
535
536
537 /* sys_resource_req(): called directly from dispatch table. */
538
539 /* Will notify the target on the given vcore, if the caller controls the target.
540  * Will honor the target's wanted/vcoreid.  u_ne can be NULL. */
541 static int sys_notify(struct proc *p, int target_pid, unsigned int notif,
542                       struct notif_event *u_ne)
543 {
544         struct notif_event local_ne;
545         struct proc *target = pid2proc(target_pid);
546
547         if (!target) {
548                 set_errno(EBADPROC);
549                 return -1;
550         }
551         if (!proc_controls(p, target)) {
552                 kref_put(&target->kref);
553                 set_errno(EPERM);
554                 return -1;
555         }
556         /* if the user provided a notif_event, copy it in and use that */
557         if (u_ne) {
558                 if (memcpy_from_user(p, &local_ne, u_ne, sizeof(struct notif_event))) {
559                         kref_put(&target->kref);
560                         set_errno(EINVAL);
561                         return -1;
562                 }
563                 proc_notify(target, local_ne.ne_type, &local_ne);
564         } else {
565                 proc_notify(target, notif, 0);
566         }
567         kref_put(&target->kref);
568         return 0;
569 }
570
571 /* Will notify the calling process on the given vcore, independently of WANTED
572  * or advertised vcoreid.  If you change the parameters, change pop_ros_tf() */
573 static int sys_self_notify(struct proc *p, uint32_t vcoreid, unsigned int notif,
574                            struct notif_event *u_ne)
575 {
576         struct notif_event local_ne;
577
578         printd("[kernel] received self notify for vcoreid %d, notif %d, ne %08p\n",
579                vcoreid, notif, u_ne);
580         /* if the user provided a notif_event, copy it in and use that */
581         if (u_ne) {
582                 if (memcpy_from_user(p, &local_ne, u_ne, sizeof(struct notif_event))) {
583                         set_errno(EINVAL);
584                         return -1;
585                 }
586                 do_notify(p, vcoreid, local_ne.ne_type, &local_ne);
587         } else {
588                 do_notify(p, vcoreid, notif, 0);
589         }
590         return 0;
591 }
592
593 /* This will set a local timer for usec, then shut down the core */
594 static int sys_halt_core(struct proc *p, unsigned int usec)
595 {
596         /* TODO: ought to check and see if a timer was already active, etc, esp so
597          * userspace can't turn off timers.  also note we will also call whatever
598          * timer_interrupt() will do, though all we care about is just
599          * self_ipi/interrupting. */
600         set_core_timer(usec);
601         cpu_halt();
602
603         return 0;
604 }
605
606 /************** Platform Specific Syscalls **************/
607
608 //Read a buffer over the serial port
609 static ssize_t sys_serial_read(env_t* e, char *DANGEROUS _buf, size_t len)
610 {
611         printk("[kernel] serial reading is deprecated.\n");
612         if (len == 0)
613                 return 0;
614
615         #ifdef __CONFIG_SERIAL_IO__
616             char *COUNT(len) buf = user_mem_assert(e, _buf, len, PTE_USER_RO);
617                 size_t bytes_read = 0;
618                 int c;
619                 while((c = serial_read_byte()) != -1) {
620                         buf[bytes_read++] = (uint8_t)c;
621                         if(bytes_read == len) break;
622                 }
623                 return (ssize_t)bytes_read;
624         #else
625                 return -EINVAL;
626         #endif
627 }
628
629 //Write a buffer over the serial port
630 static ssize_t sys_serial_write(env_t* e, const char *DANGEROUS buf, size_t len)
631 {
632         printk("[kernel] serial writing is deprecated.\n");
633         if (len == 0)
634                 return 0;
635         #ifdef __CONFIG_SERIAL_IO__
636                 char *COUNT(len) _buf = user_mem_assert(e, buf, len, PTE_USER_RO);
637                 for(int i =0; i<len; i++)
638                         serial_send_byte(buf[i]);
639                 return (ssize_t)len;
640         #else
641                 return -EINVAL;
642         #endif
643 }
644
645 #ifdef __CONFIG_NETWORKING__
646 // This is not a syscall we want. Its hacky. Here just for syscall stuff until get a stack.
647 static ssize_t sys_eth_read(env_t* e, char *DANGEROUS buf)
648 {
649         if (eth_up) {
650
651                 uint32_t len;
652                 char *ptr;
653
654                 spin_lock(&packet_buffers_lock);
655
656                 if (num_packet_buffers == 0) {
657                         spin_unlock(&packet_buffers_lock);
658                         return 0;
659                 }
660
661                 ptr = packet_buffers[packet_buffers_head];
662                 len = packet_buffers_sizes[packet_buffers_head];
663
664                 num_packet_buffers--;
665                 packet_buffers_head = (packet_buffers_head + 1) % MAX_PACKET_BUFFERS;
666
667                 spin_unlock(&packet_buffers_lock);
668
669                 char* _buf = user_mem_assert(e, buf, len, PTE_U);
670
671                 memcpy(_buf, ptr, len);
672
673                 kfree(ptr);
674
675                 return len;
676         }
677         else
678                 return -EINVAL;
679 }
680
681 // This is not a syscall we want. Its hacky. Here just for syscall stuff until get a stack.
682 static ssize_t sys_eth_write(env_t* e, const char *DANGEROUS buf, size_t len)
683 {
684         if (eth_up) {
685
686                 if (len == 0)
687                         return 0;
688
689                 // HACK TO BYPASS HACK
690                 int just_sent = send_frame(buf, len);
691
692                 if (just_sent < 0) {
693                         printk("Packet send fail\n");
694                         return 0;
695                 }
696
697                 return just_sent;
698
699                 // END OF RECURSIVE HACK
700 /*
701                 char *COUNT(len) _buf = user_mem_assert(e, buf, len, PTE_U);
702                 int total_sent = 0;
703                 int just_sent = 0;
704                 int cur_packet_len = 0;
705                 while (total_sent != len) {
706                         cur_packet_len = ((len - total_sent) > MTU) ? MTU : (len - total_sent);
707                         char dest_mac[6] = APPSERVER_MAC_ADDRESS;
708                         char* wrap_buffer = eth_wrap(_buf + total_sent, cur_packet_len, device_mac, dest_mac, APPSERVER_PORT);
709                         just_sent = send_frame(wrap_buffer, cur_packet_len + sizeof(struct ETH_Header));
710
711                         if (just_sent < 0)
712                                 return 0; // This should be an error code of its own
713
714                         if (wrap_buffer)
715                                 kfree(wrap_buffer);
716
717                         total_sent += cur_packet_len;
718                 }
719
720                 return (ssize_t)len;
721 */
722         }
723         else
724                 return -EINVAL;
725 }
726
727 static ssize_t sys_eth_get_mac_addr(env_t* e, char *DANGEROUS buf) 
728 {
729         if (eth_up) {
730                 for (int i = 0; i < 6; i++)
731                         buf[i] = device_mac[i];
732                 return 0;
733         }
734         else
735                 return -EINVAL;
736 }
737
738 static int sys_eth_recv_check(env_t* e) 
739 {
740         if (num_packet_buffers != 0) 
741                 return 1;
742         else
743                 return 0;
744 }
745
746 #endif // Network
747
748 static intreg_t sys_read(struct proc *p, int fd, void *buf, int len)
749 {
750         ssize_t ret;
751         struct file *file = get_file_from_fd(&p->open_files, fd);
752         if (!file) {
753                 set_errno(EBADF);
754                 return -1;
755         }
756         if (!file->f_op->read) {
757                 kref_put(&file->f_kref);
758                 set_errno(EINVAL);
759                 return -1;
760         }
761         /* TODO: (UMEM) currently, read() handles user memcpy issues, but we
762          * probably should user_mem_check and pin the region here, so read doesn't
763          * worry about it */
764         ret = file->f_op->read(file, buf, len, &file->f_pos);
765         kref_put(&file->f_kref);
766         return ret;
767 }
768
769 static intreg_t sys_write(struct proc *p, int fd, const void *buf, int len)
770 {
771         ssize_t ret;
772         struct file *file = get_file_from_fd(&p->open_files, fd);
773         if (!file) {
774                 set_errno(EBADF);
775                 return -1;
776         }
777         if (!file->f_op->write) {
778                 kref_put(&file->f_kref);
779                 set_errno(EINVAL);
780                 return -1;
781         }
782         /* TODO: (UMEM) */
783         ret = file->f_op->write(file, buf, len, &file->f_pos);
784         kref_put(&file->f_kref);
785         return ret;
786 }
787
788 /* Checks args/reads in the path, opens the file, and inserts it into the
789  * process's open file list. 
790  *
791  * TODO: take the path length */
792 static intreg_t sys_open(struct proc *p, const char *path, size_t path_l,
793                          int oflag, int mode)
794 {
795         int fd = 0;
796         struct file *file;
797
798         printd("File %s Open attempt\n", path);
799         char *t_path = user_strdup_errno(p, path, path_l);
800         if (!t_path)
801                 return -1;
802         mode &= ~p->fs_env.umask;
803         file = do_file_open(t_path, oflag, mode);
804         user_memdup_free(p, t_path);
805         if (!file)
806                 return -1;
807         fd = insert_file(&p->open_files, file, 0);      /* stores the ref to file */
808         kref_put(&file->f_kref);
809         if (fd < 0) {
810                 warn("File insertion failed");
811                 return -1;
812         }
813         printd("File %s Open, res=%d\n", path, fd);
814         return fd;
815 }
816
817 static intreg_t sys_close(struct proc *p, int fd)
818 {
819         struct file *file = put_file_from_fd(&p->open_files, fd);
820         if (!file) {
821                 set_errno(EBADF);
822                 return -1;
823         }
824         return 0;
825 }
826
827 /* kept around til we remove the last ufe */
828 #define ufe(which,a0,a1,a2,a3) \
829         frontend_syscall_errno(p,APPSERVER_SYSCALL_##which,\
830                            (int)(a0),(int)(a1),(int)(a2),(int)(a3))
831
832 static intreg_t sys_fstat(struct proc *p, int fd, struct kstat *u_stat)
833 {
834         struct kstat *kbuf;
835         struct file *file = get_file_from_fd(&p->open_files, fd);
836         if (!file) {
837                 set_errno(EBADF);
838                 return -1;
839         }
840         kbuf = kmalloc(sizeof(struct kstat), 0);
841         if (!kbuf) {
842                 kref_put(&file->f_kref);
843                 set_errno(ENOMEM);
844                 return -1;
845         }
846         stat_inode(file->f_dentry->d_inode, kbuf);
847         kref_put(&file->f_kref);
848         /* TODO: UMEM: pin the memory, copy directly, and skip the kernel buffer */
849         if (memcpy_to_user_errno(p, u_stat, kbuf, sizeof(struct kstat))) {
850                 kfree(kbuf);
851                 set_errno(EINVAL);
852                 return -1;
853         }
854         kfree(kbuf);
855         return 0;
856 }
857
858 /* sys_stat() and sys_lstat() do nearly the same thing, differing in how they
859  * treat a symlink for the final item, which (probably) will be controlled by
860  * the lookup flags */
861 static intreg_t stat_helper(struct proc *p, const char *path, size_t path_l,
862                             struct kstat *u_stat, int flags)
863 {
864         struct kstat *kbuf;
865         struct dentry *path_d;
866         char *t_path = user_strdup_errno(p, path, path_l);
867         if (!t_path)
868                 return -1;
869         path_d = lookup_dentry(t_path, flags);
870         user_memdup_free(p, t_path);
871         if (!path_d)
872                 return -1;
873         kbuf = kmalloc(sizeof(struct kstat), 0);
874         if (!kbuf) {
875                 set_errno(ENOMEM);
876                 kref_put(&path_d->d_kref);
877                 return -1;
878         }
879         stat_inode(path_d->d_inode, kbuf);
880         kref_put(&path_d->d_kref);
881         /* TODO: UMEM: pin the memory, copy directly, and skip the kernel buffer */
882         if (memcpy_to_user_errno(p, u_stat, kbuf, sizeof(struct kstat))) {
883                 kfree(kbuf);
884                 set_errno(EINVAL);
885                 return -1;
886         }
887         kfree(kbuf);
888         return 0;
889 }
890
891 /* Follow a final symlink */
892 static intreg_t sys_stat(struct proc *p, const char *path, size_t path_l,
893                          struct kstat *u_stat)
894 {
895         return stat_helper(p, path, path_l, u_stat, LOOKUP_FOLLOW);
896 }
897
898 /* Don't follow a final symlink */
899 static intreg_t sys_lstat(struct proc *p, const char *path, size_t path_l,
900                           struct kstat *u_stat)
901 {
902         return stat_helper(p, path, path_l, u_stat, 0);
903 }
904
905 intreg_t sys_fcntl(struct proc *p, int fd, int cmd, int arg)
906 {
907         int retval = 0;
908         struct file *file = get_file_from_fd(&p->open_files, fd);
909         if (!file) {
910                 set_errno(EBADF);
911                 return -1;
912         }
913         switch (cmd) {
914                 case (F_DUPFD):
915                         retval = insert_file(&p->open_files, file, arg);
916                         if (retval < 0) {
917                                 set_errno(-retval);
918                                 retval = -1;
919                         }
920                         break;
921                 case (F_GETFD):
922                         /* GET and SETFD just care about CLOEXEC.  We don't have a separate
923                          * flag variable for the FD (we might need to, technically). */
924                         if (file->f_flags & O_CLOEXEC)
925                                 retval = FD_CLOEXEC;
926                         break;
927                 case (F_SETFD):
928                         if (arg == FD_CLOEXEC)
929                                 file->f_flags |= O_CLOEXEC;
930                         break;
931                 case (F_GETFL):
932                         retval = file->f_flags;
933                         break;
934                 case (F_SETFL):
935                         /* only allowed to set certain flags. */
936                         arg &= O_FCNTL_FLAGS;
937                         file->f_flags = (file->f_flags & ~O_FCNTL_FLAGS) | arg;
938                         break;
939                 default:
940                         warn("Unsupported fcntl cmd %d\n", cmd);
941         }
942         kref_put(&file->f_kref);
943         return retval;
944 }
945
946 static intreg_t sys_access(struct proc *p, const char *path, size_t path_l,
947                            int mode)
948 {
949         int retval;
950         char *t_path = user_strdup_errno(p, path, path_l);
951         if (!t_path)
952                 return -1;
953         retval = do_access(t_path, mode);
954         user_memdup_free(p, t_path);
955         printd("Access for path: %s retval: %d\n", path, retval);
956         if (retval < 0) {
957                 set_errno(-retval);
958                 return -1;
959         }
960         return retval;
961 }
962
963 intreg_t sys_umask(struct proc *p, int mask)
964 {
965         int old_mask = p->fs_env.umask;
966         p->fs_env.umask = mask & S_PMASK;
967         return old_mask;
968 }
969
970 intreg_t sys_chmod(struct proc *p, const char *path, size_t path_l, int mode)
971 {
972         int retval;
973         char *t_path = user_strdup_errno(p, path, path_l);
974         if (!t_path)
975                 return -1;
976         retval = do_chmod(t_path, mode);
977         user_memdup_free(p, t_path);
978         if (retval < 0) {
979                 set_errno(-retval);
980                 return -1;
981         }
982         return retval;
983 }
984
985 static intreg_t sys_lseek(struct proc *p, int fd, off_t offset, int whence)
986 {
987         off_t ret;
988         struct file *file = get_file_from_fd(&p->open_files, fd);
989         if (!file) {
990                 set_errno(EBADF);
991                 return -1;
992         }
993         ret = file->f_op->llseek(file, offset, whence);
994         kref_put(&file->f_kref);
995         return ret;
996 }
997
998 intreg_t sys_link(struct proc *p, char *old_path, size_t old_l,
999                   char *new_path, size_t new_l)
1000 {
1001         int ret;
1002         char *t_oldpath = user_strdup_errno(p, old_path, old_l);
1003         if (t_oldpath == NULL)
1004                 return -1;
1005         char *t_newpath = user_strdup_errno(p, new_path, new_l);
1006         if (t_newpath == NULL) {
1007                 user_memdup_free(p, t_oldpath);
1008                 return -1;
1009         }
1010         ret = do_link(t_oldpath, t_newpath);
1011         user_memdup_free(p, t_oldpath);
1012         user_memdup_free(p, t_newpath);
1013         return ret;
1014 }
1015
1016 intreg_t sys_unlink(struct proc *p, const char *path, size_t path_l)
1017 {
1018         int retval;
1019         char *t_path = user_strdup_errno(p, path, path_l);
1020         if (!t_path)
1021                 return -1;
1022         retval = do_unlink(t_path);
1023         user_memdup_free(p, t_path);
1024         return retval;
1025 }
1026
1027 intreg_t sys_symlink(struct proc *p, char *old_path, size_t old_l,
1028                      char *new_path, size_t new_l)
1029 {
1030         int ret;
1031         char *t_oldpath = user_strdup_errno(p, old_path, old_l);
1032         if (t_oldpath == NULL)
1033                 return -1;
1034         char *t_newpath = user_strdup_errno(p, new_path, new_l);
1035         if (t_newpath == NULL) {
1036                 user_memdup_free(p, t_oldpath);
1037                 return -1;
1038         }
1039         ret = do_symlink(new_path, old_path, S_IRWXU | S_IRWXG | S_IRWXO);
1040         user_memdup_free(p, t_oldpath);
1041         user_memdup_free(p, t_newpath);
1042         return ret;
1043 }
1044
1045 intreg_t sys_readlink(struct proc *p, char *path, size_t path_l,
1046                       char *u_buf, size_t buf_l)
1047 {
1048         char *symname;
1049         ssize_t copy_amt;
1050         struct dentry *path_d;
1051         char *t_path = user_strdup_errno(p, path, path_l);
1052         if (t_path == NULL)
1053                 return -1;
1054         path_d = lookup_dentry(t_path, 0);
1055         user_memdup_free(p, t_path);
1056         if (!path_d)
1057                 return -1;
1058         symname = path_d->d_inode->i_op->readlink(path_d);
1059         copy_amt = strnlen(symname, buf_l - 1) + 1;
1060         if (memcpy_to_user_errno(p, u_buf, symname, copy_amt)) {
1061                 kref_put(&path_d->d_kref);
1062                 set_errno(EINVAL);
1063                 return -1;
1064         }
1065         kref_put(&path_d->d_kref);
1066         printd("READLINK returning %s\n", u_buf);
1067         return copy_amt;
1068 }
1069
1070 intreg_t sys_chdir(struct proc *p, const char *path, size_t path_l)
1071 {
1072         int retval;
1073         char *t_path = user_strdup_errno(p, path, path_l);
1074         if (!t_path)
1075                 return -1;
1076         retval = do_chdir(&p->fs_env, t_path);
1077         user_memdup_free(p, t_path);
1078         if (retval) {
1079                 set_errno(-retval);
1080                 return -1;
1081         }
1082         return 0;
1083 }
1084
1085 /* Note cwd_l is not a strlen, it's an absolute size */
1086 intreg_t sys_getcwd(struct proc *p, char *u_cwd, size_t cwd_l)
1087 {
1088         int retval = 0;
1089         char *kfree_this;
1090         char *k_cwd = do_getcwd(&p->fs_env, &kfree_this, cwd_l);
1091         if (!k_cwd)
1092                 return -1;              /* errno set by do_getcwd */
1093         if (memcpy_to_user_errno(p, u_cwd, k_cwd, strnlen(k_cwd, cwd_l - 1) + 1))
1094                 retval = -1;
1095         kfree(kfree_this);
1096         return retval;
1097 }
1098
1099 intreg_t sys_mkdir(struct proc *p, const char *path, size_t path_l, int mode)
1100 {
1101         int retval;
1102         char *t_path = user_strdup_errno(p, path, path_l);
1103         if (!t_path)
1104                 return -1;
1105         mode &= ~p->fs_env.umask;
1106         retval = do_mkdir(t_path, mode);
1107         user_memdup_free(p, t_path);
1108         return retval;
1109 }
1110
1111 intreg_t sys_rmdir(struct proc *p, const char *path, size_t path_l)
1112 {
1113         int retval;
1114         char *t_path = user_strdup_errno(p, path, path_l);
1115         if (!t_path)
1116                 return -1;
1117         retval = do_rmdir(t_path);
1118         user_memdup_free(p, t_path);
1119         return retval;
1120 }
1121
1122 intreg_t sys_gettimeofday(struct proc *p, int *buf)
1123 {
1124         static spinlock_t gtod_lock = SPINLOCK_INITIALIZER;
1125         static int t0 = 0;
1126
1127         spin_lock(&gtod_lock);
1128         if(t0 == 0)
1129
1130 #if (defined __CONFIG_APPSERVER__)
1131         t0 = ufe(time,0,0,0,0);
1132 #else
1133         // Nanwan's birthday, bitches!!
1134         t0 = 1242129600;
1135 #endif 
1136         spin_unlock(&gtod_lock);
1137
1138         long long dt = read_tsc();
1139         int kbuf[2] = {t0+dt/system_timing.tsc_freq,
1140             (dt%system_timing.tsc_freq)*1000000/system_timing.tsc_freq};
1141
1142         return memcpy_to_user_errno(p,buf,kbuf,sizeof(kbuf));
1143 }
1144
1145 #define SIZEOF_STRUCT_TERMIOS 60
1146 intreg_t sys_tcgetattr(struct proc *p, int fd, void *termios_p)
1147 {
1148         int* kbuf = kmalloc(SIZEOF_STRUCT_TERMIOS,0);
1149         int ret = ufe(tcgetattr,fd,PADDR(kbuf),0,0);
1150         if(ret != -1 && memcpy_to_user_errno(p,termios_p,kbuf,SIZEOF_STRUCT_TERMIOS))
1151                 ret = -1;
1152         kfree(kbuf);
1153         return ret;
1154 }
1155
1156 intreg_t sys_tcsetattr(struct proc *p, int fd, int optional_actions,
1157                        const void *termios_p)
1158 {
1159         void* kbuf = user_memdup_errno(p,termios_p,SIZEOF_STRUCT_TERMIOS);
1160         if(kbuf == NULL)
1161                 return -1;
1162         int ret = ufe(tcsetattr,fd,optional_actions,PADDR(kbuf),0);
1163         user_memdup_free(p,kbuf);
1164         return ret;
1165 }
1166
1167 /* TODO: we don't have any notion of UIDs or GIDs yet, but don't let that stop a
1168  * process from thinking it can do these.  The other alternative is to have
1169  * glibc return 0 right away, though someone might want to do something with
1170  * these calls.  Someday. */
1171 intreg_t sys_setuid(struct proc *p, uid_t uid)
1172 {
1173         return 0;
1174 }
1175
1176 intreg_t sys_setgid(struct proc *p, gid_t gid)
1177 {
1178         return 0;
1179 }
1180
1181 /************** Syscall Invokation **************/
1182
1183 const static struct sys_table_entry syscall_table[] = {
1184         [SYS_null] = {(syscall_t)sys_null, "null"},
1185         [SYS_cache_buster] = {(syscall_t)sys_cache_buster, "buster"},
1186         [SYS_cache_invalidate] = {(syscall_t)sys_cache_invalidate, "wbinv"},
1187         [SYS_reboot] = {(syscall_t)reboot, "reboot!"},
1188         [SYS_cputs] = {(syscall_t)sys_cputs, "cputs"},
1189         [SYS_cgetc] = {(syscall_t)sys_cgetc, "cgetc"},
1190         [SYS_getcpuid] = {(syscall_t)sys_getcpuid, "getcpuid"},
1191         [SYS_getvcoreid] = {(syscall_t)sys_getvcoreid, "getvcoreid"},
1192         [SYS_getpid] = {(syscall_t)sys_getpid, "getpid"},
1193         [SYS_proc_create] = {(syscall_t)sys_proc_create, "proc_create"},
1194         [SYS_proc_run] = {(syscall_t)sys_proc_run, "proc_run"},
1195         [SYS_proc_destroy] = {(syscall_t)sys_proc_destroy, "proc_destroy"},
1196         [SYS_yield] = {(syscall_t)sys_proc_yield, "proc_yield"},
1197         [SYS_fork] = {(syscall_t)sys_fork, "fork"},
1198         [SYS_exec] = {(syscall_t)sys_exec, "exec"},
1199         [SYS_trywait] = {(syscall_t)sys_trywait, "trywait"},
1200         [SYS_mmap] = {(syscall_t)sys_mmap, "mmap"},
1201         [SYS_munmap] = {(syscall_t)sys_munmap, "munmap"},
1202         [SYS_mprotect] = {(syscall_t)sys_mprotect, "mprotect"},
1203         [SYS_shared_page_alloc] = {(syscall_t)sys_shared_page_alloc, "pa"},
1204         [SYS_shared_page_free] = {(syscall_t)sys_shared_page_free, "pf"},
1205         [SYS_resource_req] = {(syscall_t)resource_req, "resource_req"},
1206         [SYS_notify] = {(syscall_t)sys_notify, "notify"},
1207         [SYS_self_notify] = {(syscall_t)sys_self_notify, "self_notify"},
1208         [SYS_halt_core] = {(syscall_t)sys_halt_core, "halt_core"},
1209 #ifdef __CONFIG_SERIAL_IO__
1210         [SYS_serial_read] = {(syscall_t)sys_serial_read, "ser_read"},
1211         [SYS_serial_write] = {(syscall_t)sys_serial_write, "ser_write"},
1212 #endif
1213 #ifdef __CONFIG_NETWORKING__
1214         [SYS_eth_read] = {(syscall_t)sys_eth_read, "eth_read"},
1215         [SYS_eth_write] = {(syscall_t)sys_eth_write, "eth_write"},
1216         [SYS_eth_get_mac_addr] = {(syscall_t)sys_eth_get_mac_addr, "get_mac"},
1217         [SYS_eth_recv_check] = {(syscall_t)sys_eth_recv_check, "recv_check"},
1218 #endif
1219 #ifdef __CONFIG_ARSC_SERVER__
1220         [SYS_init_arsc] = {(syscall_t)sys_init_arsc, "init_arsc"},
1221 #endif
1222         [SYS_read] = {(syscall_t)sys_read, "read"},
1223         [SYS_write] = {(syscall_t)sys_write, "write"},
1224         [SYS_open] = {(syscall_t)sys_open, "open"},
1225         [SYS_close] = {(syscall_t)sys_close, "close"},
1226         [SYS_fstat] = {(syscall_t)sys_fstat, "fstat"},
1227         [SYS_stat] = {(syscall_t)sys_stat, "stat"},
1228         [SYS_lstat] = {(syscall_t)sys_lstat, "lstat"},
1229         [SYS_fcntl] = {(syscall_t)sys_fcntl, "fcntl"},
1230         [SYS_access] = {(syscall_t)sys_access, "access"},
1231         [SYS_umask] = {(syscall_t)sys_umask, "umask"},
1232         [SYS_chmod] = {(syscall_t)sys_chmod, "chmod"},
1233         [SYS_lseek] = {(syscall_t)sys_lseek, "lseek"},
1234         [SYS_link] = {(syscall_t)sys_link, "link"},
1235         [SYS_unlink] = {(syscall_t)sys_unlink, "unlink"},
1236         [SYS_symlink] = {(syscall_t)sys_symlink, "symlink"},
1237         [SYS_readlink] = {(syscall_t)sys_readlink, "readlink"},
1238         [SYS_chdir] = {(syscall_t)sys_chdir, "chdir"},
1239         [SYS_getcwd] = {(syscall_t)sys_getcwd, "getcwd"},
1240         [SYS_mkdir] = {(syscall_t)sys_mkdir, "mkdri"},
1241         [SYS_rmdir] = {(syscall_t)sys_rmdir, "rmdir"},
1242         [SYS_gettimeofday] = {(syscall_t)sys_gettimeofday, "gettime"},
1243         [SYS_tcgetattr] = {(syscall_t)sys_tcgetattr, "tcgetattr"},
1244         [SYS_tcsetattr] = {(syscall_t)sys_tcsetattr, "tcsetattr"},
1245         [SYS_setuid] = {(syscall_t)sys_setuid, "setuid"},
1246         [SYS_setgid] = {(syscall_t)sys_setgid, "setgid"}
1247 };
1248
1249 /* Executes the given syscall.
1250  *
1251  * Note tf is passed in, which points to the tf of the context on the kernel
1252  * stack.  If any syscall needs to block, it needs to save this info, as well as
1253  * any silly state.
1254  * 
1255  * This syscall function is used by both local syscall and arsc, and should
1256  * remain oblivious of the caller. */
1257 intreg_t syscall(struct proc *p, uintreg_t syscallno, uintreg_t a1,
1258                  uintreg_t a2, uintreg_t a3, uintreg_t a4, uintreg_t a5)
1259 {
1260         /* Initialize the return value and error code returned to 0 */
1261         set_retval(ESUCCESS);
1262         set_errno(ESUCCESS);
1263
1264         const int max_syscall = sizeof(syscall_table)/sizeof(syscall_table[0]);
1265
1266         uint32_t coreid, vcoreid;
1267         if (systrace_flags & SYSTRACE_ON) {
1268                 if ((systrace_flags & SYSTRACE_ALLPROC) || (proc_is_traced(p))) {
1269                         coreid = core_id();
1270                         vcoreid = proc_get_vcoreid(p, coreid);
1271                         if (systrace_flags & SYSTRACE_LOUD) {
1272                                 printk("[%16llu] Syscall %3d (%12s):(%08p, %08p, %08p, %08p, "
1273                                        "%08p) proc: %d core: %d vcore: %d\n", read_tsc(),
1274                                        syscallno, syscall_table[syscallno].name, a1, a2, a3,
1275                                        a4, a5, p->pid, coreid, vcoreid);
1276                         } else {
1277                                 struct systrace_record *trace;
1278                                 unsigned int idx, new_idx;
1279                                 do {
1280                                         idx = systrace_bufidx;
1281                                         new_idx = (idx + 1) % systrace_bufsize;
1282                                 } while (!atomic_comp_swap(&systrace_bufidx, idx, new_idx));
1283                                 trace = &systrace_buffer[idx];
1284                                 trace->timestamp = read_tsc();
1285                                 trace->syscallno = syscallno;
1286                                 trace->arg1 = a1;
1287                                 trace->arg2 = a2;
1288                                 trace->arg3 = a3;
1289                                 trace->arg4 = a4;
1290                                 trace->arg5 = a5;
1291                                 trace->pid = p->pid;
1292                                 trace->coreid = coreid;
1293                                 trace->vcoreid = vcoreid;
1294                         }
1295                 }
1296         }
1297         //printk("Incoming syscall on core: %d number: %d\n    a1: %x\n   "
1298         //       " a2: %x\n    a3: %x\n    a4: %x\n    a5: %x\n", core_id(),
1299         //       syscallno, a1, a2, a3, a4, a5);
1300
1301         if (syscallno > max_syscall || syscall_table[syscallno].call == NULL)
1302                 panic("Invalid syscall number %d for proc %x!", syscallno, *p);
1303
1304         return syscall_table[syscallno].call(p, a1, a2, a3, a4, a5);
1305 }
1306
1307 /* Syscall tracing */
1308 static void __init_systrace(void)
1309 {
1310         systrace_buffer = kmalloc(MAX_SYSTRACES*sizeof(struct systrace_record), 0);
1311         if (!systrace_buffer)
1312                 panic("Unable to alloc a trace buffer\n");
1313         systrace_bufidx = 0;
1314         systrace_bufsize = MAX_SYSTRACES;
1315         /* Note we never free the buffer - it's around forever.  Feel free to change
1316          * this if you want to change the size or something dynamically. */
1317 }
1318
1319 /* If you call this while it is running, it will change the mode */
1320 void systrace_start(bool silent)
1321 {
1322         static bool init = FALSE;
1323         spin_lock_irqsave(&systrace_lock);
1324         if (!init) {
1325                 __init_systrace();
1326                 init = TRUE;
1327         }
1328         systrace_flags = silent ? SYSTRACE_ON : SYSTRACE_ON | SYSTRACE_LOUD; 
1329         spin_unlock_irqsave(&systrace_lock);
1330 }
1331
1332 int systrace_reg(bool all, struct proc *p)
1333 {
1334         int retval = 0;
1335         spin_lock_irqsave(&systrace_lock);
1336         if (all) {
1337                 printk("Tracing syscalls for all processes\n");
1338                 systrace_flags |= SYSTRACE_ALLPROC;
1339                 retval = 0;
1340         } else {
1341                 for (int i = 0; i < MAX_NUM_TRACED; i++) {
1342                         if (!systrace_procs[i]) {
1343                                 printk("Tracing syscalls for process %d\n", p->pid);
1344                                 systrace_procs[i] = p;
1345                                 retval = 0;
1346                                 break;
1347                         }
1348                 }
1349         }
1350         spin_unlock_irqsave(&systrace_lock);
1351         return retval;
1352 }
1353
1354 void systrace_stop(void)
1355 {
1356         spin_lock_irqsave(&systrace_lock);
1357         systrace_flags = 0;
1358         for (int i = 0; i < MAX_NUM_TRACED; i++)
1359                 systrace_procs[i] = 0;
1360         spin_unlock_irqsave(&systrace_lock);
1361 }
1362
1363 /* If you registered a process specifically, then you need to dereg it
1364  * specifically.  Or just fully stop, which will do it for all. */
1365 int systrace_dereg(bool all, struct proc *p)
1366 {
1367         spin_lock_irqsave(&systrace_lock);
1368         if (all) {
1369                 printk("No longer tracing syscalls for all processes.\n");
1370                 systrace_flags &= ~SYSTRACE_ALLPROC;
1371         } else {
1372                 for (int i = 0; i < MAX_NUM_TRACED; i++) {
1373                         if (systrace_procs[i] == p) {
1374                                 systrace_procs[i] = 0;
1375                                 printk("No longer tracing syscalls for process %d\n", p->pid);
1376                         }
1377                 }
1378         }
1379         spin_unlock_irqsave(&systrace_lock);
1380         return 0;
1381 }
1382
1383 /* Regardless of locking, someone could be writing into the buffer */
1384 void systrace_print(bool all, struct proc *p)
1385 {
1386         spin_lock_irqsave(&systrace_lock);
1387         /* if you want to be clever, you could make this start from the earliest
1388          * timestamp and loop around.  Careful of concurrent writes. */
1389         for (int i = 0; i < systrace_bufsize; i++)
1390                 if (systrace_buffer[i].timestamp)
1391                         printk("[%16llu] Syscall %3d (%12s):(%08p, %08p, %08p, %08p, "
1392                                "%08p) proc: %d core: %d vcore: %d\n",
1393                                systrace_buffer[i].timestamp,
1394                                systrace_buffer[i].syscallno,
1395                                syscall_table[systrace_buffer[i].syscallno].name,
1396                                systrace_buffer[i].arg1,
1397                                systrace_buffer[i].arg2,
1398                                systrace_buffer[i].arg3,
1399                                systrace_buffer[i].arg4,
1400                                systrace_buffer[i].arg5,
1401                                systrace_buffer[i].pid,
1402                                systrace_buffer[i].coreid,
1403                                systrace_buffer[i].vcoreid);
1404         spin_unlock_irqsave(&systrace_lock);
1405 }
1406
1407 void systrace_clear_buffer(void)
1408 {
1409         spin_lock_irqsave(&systrace_lock);
1410         memset(systrace_buffer, 0, sizeof(struct systrace_record) * MAX_SYSTRACES);
1411         spin_unlock_irqsave(&systrace_lock);
1412 }
1413
1414 void set_retval(uint32_t retval)
1415 {
1416         struct per_cpu_info* coreinfo = &per_cpu_info[core_id()];
1417         *(coreinfo->cur_ret.returnloc) = retval;
1418 }
1419 void set_errno(uint32_t errno)
1420 {
1421         struct per_cpu_info* coreinfo = &per_cpu_info[core_id()];
1422         if (coreinfo && coreinfo->cur_ret.errno_loc)
1423                 *(coreinfo->cur_ret.errno_loc) = errno;
1424 }