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