Fixed sparc compiling
[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         /* When we remove/change this, also get rid of page_insert_in_range() */
528         printk("[kernel] the current shared page alloc is deprecated.\n");
529         //if (!VALID_USER_PERMS(p1_flags)) return -EPERM;
530         //if (!VALID_USER_PERMS(p2_flags)) return -EPERM;
531
532         void * COUNT(1) * COUNT(1) addr = user_mem_assert(p1, _addr, sizeof(void *),
533                                                       PTE_USER_RW);
534         struct proc *p2 = pid2proc(p2_id);
535         if (!p2)
536                 return -EBADPROC;
537
538         page_t* page;
539         error_t e = upage_alloc(p1, &page,1);
540         if (e < 0) {
541                 kref_put(&p2->kref);
542                 return e;
543         }
544
545         void* p2_addr = page_insert_in_range(p2->env_pgdir, page,
546                         (void*SNT)UTEXT, (void*SNT)UTOP, p2_flags);
547         if (p2_addr == NULL) {
548                 page_free(page);
549                 kref_put(&p2->kref);
550                 return -EFAIL;
551         }
552
553         void* p1_addr = page_insert_in_range(p1->env_pgdir, page,
554                         (void*SNT)UTEXT, (void*SNT)UTOP, p1_flags);
555         if(p1_addr == NULL) {
556                 page_remove(p2->env_pgdir, p2_addr);
557                 page_free(page);
558                 kref_put(&p2->kref);
559                 return -EFAIL;
560         }
561         *addr = p1_addr;
562         kref_put(&p2->kref);
563         return ESUCCESS;
564 }
565
566 static int sys_shared_page_free(env_t* p1, void*DANGEROUS addr, pid_t p2)
567 {
568         return -1;
569 }
570
571
572 /* sys_resource_req(): called directly from dispatch table. */
573
574 /* Will notify the target on the given vcore, if the caller controls the target.
575  * Will honor the target's wanted/vcoreid.  u_ne can be NULL. */
576 static int sys_notify(struct proc *p, int target_pid, unsigned int notif,
577                       struct notif_event *u_ne)
578 {
579         struct notif_event local_ne;
580         struct proc *target = pid2proc(target_pid);
581
582         if (!target) {
583                 set_errno(EBADPROC);
584                 return -1;
585         }
586         if (!proc_controls(p, target)) {
587                 kref_put(&target->kref);
588                 set_errno(EPERM);
589                 return -1;
590         }
591         /* if the user provided a notif_event, copy it in and use that */
592         if (u_ne) {
593                 if (memcpy_from_user(p, &local_ne, u_ne, sizeof(struct notif_event))) {
594                         kref_put(&target->kref);
595                         set_errno(EINVAL);
596                         return -1;
597                 }
598                 proc_notify(target, local_ne.ne_type, &local_ne);
599         } else {
600                 proc_notify(target, notif, 0);
601         }
602         kref_put(&target->kref);
603         return 0;
604 }
605
606 /* Will notify the calling process on the given vcore, independently of WANTED
607  * or advertised vcoreid.  If you change the parameters, change pop_ros_tf() */
608 static int sys_self_notify(struct proc *p, uint32_t vcoreid, unsigned int notif,
609                            struct notif_event *u_ne)
610 {
611         struct notif_event local_ne;
612
613         printd("[kernel] received self notify for vcoreid %d, notif %d, ne %08p\n",
614                vcoreid, notif, u_ne);
615         /* if the user provided a notif_event, copy it in and use that */
616         if (u_ne) {
617                 if (memcpy_from_user(p, &local_ne, u_ne, sizeof(struct notif_event))) {
618                         set_errno(EINVAL);
619                         return -1;
620                 }
621                 do_notify(p, vcoreid, local_ne.ne_type, &local_ne);
622         } else {
623                 do_notify(p, vcoreid, notif, 0);
624         }
625         return 0;
626 }
627
628 /* This will set a local timer for usec, then shut down the core */
629 static int sys_halt_core(struct proc *p, unsigned int usec)
630 {
631         /* TODO: ought to check and see if a timer was already active, etc, esp so
632          * userspace can't turn off timers.  also note we will also call whatever
633          * timer_interrupt() will do, though all we care about is just
634          * self_ipi/interrupting. */
635         set_core_timer(usec);
636         cpu_halt();
637
638         return 0;
639 }
640
641 /************** Platform Specific Syscalls **************/
642
643 //Read a buffer over the serial port
644 static ssize_t sys_serial_read(env_t* e, char *DANGEROUS _buf, size_t len)
645 {
646         printk("[kernel] serial reading is deprecated.\n");
647         if (len == 0)
648                 return 0;
649
650         #ifdef __CONFIG_SERIAL_IO__
651             char *COUNT(len) buf = user_mem_assert(e, _buf, len, PTE_USER_RO);
652                 size_t bytes_read = 0;
653                 int c;
654                 while((c = serial_read_byte()) != -1) {
655                         buf[bytes_read++] = (uint8_t)c;
656                         if(bytes_read == len) break;
657                 }
658                 return (ssize_t)bytes_read;
659         #else
660                 return -EINVAL;
661         #endif
662 }
663
664 //Write a buffer over the serial port
665 static ssize_t sys_serial_write(env_t* e, const char *DANGEROUS buf, size_t len)
666 {
667         printk("[kernel] serial writing is deprecated.\n");
668         if (len == 0)
669                 return 0;
670         #ifdef __CONFIG_SERIAL_IO__
671                 char *COUNT(len) _buf = user_mem_assert(e, buf, len, PTE_USER_RO);
672                 for(int i =0; i<len; i++)
673                         serial_send_byte(buf[i]);
674                 return (ssize_t)len;
675         #else
676                 return -EINVAL;
677         #endif
678 }
679
680 #ifdef __CONFIG_NETWORKING__
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_read(env_t* e, char *DANGEROUS buf)
683 {
684         if (eth_up) {
685
686                 uint32_t len;
687                 char *ptr;
688
689                 spin_lock(&packet_buffers_lock);
690
691                 if (num_packet_buffers == 0) {
692                         spin_unlock(&packet_buffers_lock);
693                         return 0;
694                 }
695
696                 ptr = packet_buffers[packet_buffers_head];
697                 len = packet_buffers_sizes[packet_buffers_head];
698
699                 num_packet_buffers--;
700                 packet_buffers_head = (packet_buffers_head + 1) % MAX_PACKET_BUFFERS;
701
702                 spin_unlock(&packet_buffers_lock);
703
704                 char* _buf = user_mem_assert(e, buf, len, PTE_U);
705
706                 memcpy(_buf, ptr, len);
707
708                 kfree(ptr);
709
710                 return len;
711         }
712         else
713                 return -EINVAL;
714 }
715
716 // This is not a syscall we want. Its hacky. Here just for syscall stuff until get a stack.
717 static ssize_t sys_eth_write(env_t* e, const char *DANGEROUS buf, size_t len)
718 {
719         if (eth_up) {
720
721                 if (len == 0)
722                         return 0;
723
724                 // HACK TO BYPASS HACK
725                 int just_sent = send_frame(buf, len);
726
727                 if (just_sent < 0) {
728                         printk("Packet send fail\n");
729                         return 0;
730                 }
731
732                 return just_sent;
733
734                 // END OF RECURSIVE HACK
735 /*
736                 char *COUNT(len) _buf = user_mem_assert(e, buf, len, PTE_U);
737                 int total_sent = 0;
738                 int just_sent = 0;
739                 int cur_packet_len = 0;
740                 while (total_sent != len) {
741                         cur_packet_len = ((len - total_sent) > MTU) ? MTU : (len - total_sent);
742                         char dest_mac[6] = APPSERVER_MAC_ADDRESS;
743                         char* wrap_buffer = eth_wrap(_buf + total_sent, cur_packet_len, device_mac, dest_mac, APPSERVER_PORT);
744                         just_sent = send_frame(wrap_buffer, cur_packet_len + sizeof(struct ETH_Header));
745
746                         if (just_sent < 0)
747                                 return 0; // This should be an error code of its own
748
749                         if (wrap_buffer)
750                                 kfree(wrap_buffer);
751
752                         total_sent += cur_packet_len;
753                 }
754
755                 return (ssize_t)len;
756 */
757         }
758         else
759                 return -EINVAL;
760 }
761
762 static ssize_t sys_eth_get_mac_addr(env_t* e, char *DANGEROUS buf) 
763 {
764         if (eth_up) {
765                 for (int i = 0; i < 6; i++)
766                         buf[i] = device_mac[i];
767                 return 0;
768         }
769         else
770                 return -EINVAL;
771 }
772
773 static int sys_eth_recv_check(env_t* e) 
774 {
775         if (num_packet_buffers != 0) 
776                 return 1;
777         else
778                 return 0;
779 }
780
781 #endif // Network
782
783 static intreg_t sys_read(struct proc *p, int fd, void *buf, int len)
784 {
785         ssize_t ret;
786         struct file *file = get_file_from_fd(&p->open_files, fd);
787         if (!file) {
788                 set_errno(EBADF);
789                 return -1;
790         }
791         if (!file->f_op->read) {
792                 kref_put(&file->f_kref);
793                 set_errno(EINVAL);
794                 return -1;
795         }
796         /* TODO: (UMEM) currently, read() handles user memcpy issues, but we
797          * probably should user_mem_check and pin the region here, so read doesn't
798          * worry about it */
799         ret = file->f_op->read(file, buf, len, &file->f_pos);
800         kref_put(&file->f_kref);
801         return ret;
802 }
803
804 static intreg_t sys_write(struct proc *p, int fd, const void *buf, int len)
805 {
806         ssize_t ret;
807         struct file *file = get_file_from_fd(&p->open_files, fd);
808         if (!file) {
809                 set_errno(EBADF);
810                 return -1;
811         }
812         if (!file->f_op->write) {
813                 kref_put(&file->f_kref);
814                 set_errno(EINVAL);
815                 return -1;
816         }
817         /* TODO: (UMEM) */
818         ret = file->f_op->write(file, buf, len, &file->f_pos);
819         kref_put(&file->f_kref);
820         return ret;
821 }
822
823 /* Checks args/reads in the path, opens the file, and inserts it into the
824  * process's open file list. 
825  *
826  * TODO: take the path length */
827 static intreg_t sys_open(struct proc *p, const char *path, size_t path_l,
828                          int oflag, int mode)
829 {
830         int fd = 0;
831         struct file *file;
832
833         printd("File %s Open attempt\n", path);
834         char *t_path = user_strdup_errno(p, path, path_l);
835         if (!t_path)
836                 return -1;
837         mode &= ~p->fs_env.umask;
838         file = do_file_open(t_path, oflag, mode);
839         user_memdup_free(p, t_path);
840         if (!file)
841                 return -1;
842         fd = insert_file(&p->open_files, file, 0);      /* stores the ref to file */
843         kref_put(&file->f_kref);
844         if (fd < 0) {
845                 warn("File insertion failed");
846                 return -1;
847         }
848         printd("File %s Open, res=%d\n", path, fd);
849         return fd;
850 }
851
852 static intreg_t sys_close(struct proc *p, int fd)
853 {
854         struct file *file = put_file_from_fd(&p->open_files, fd);
855         if (!file) {
856                 set_errno(EBADF);
857                 return -1;
858         }
859         return 0;
860 }
861
862 /* kept around til we remove the last ufe */
863 #define ufe(which,a0,a1,a2,a3) \
864         frontend_syscall_errno(p,APPSERVER_SYSCALL_##which,\
865                            (int)(a0),(int)(a1),(int)(a2),(int)(a3))
866
867 static intreg_t sys_fstat(struct proc *p, int fd, struct kstat *u_stat)
868 {
869         struct kstat *kbuf;
870         struct file *file = get_file_from_fd(&p->open_files, fd);
871         if (!file) {
872                 set_errno(EBADF);
873                 return -1;
874         }
875         kbuf = kmalloc(sizeof(struct kstat), 0);
876         if (!kbuf) {
877                 kref_put(&file->f_kref);
878                 set_errno(ENOMEM);
879                 return -1;
880         }
881         stat_inode(file->f_dentry->d_inode, kbuf);
882         kref_put(&file->f_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 /* sys_stat() and sys_lstat() do nearly the same thing, differing in how they
894  * treat a symlink for the final item, which (probably) will be controlled by
895  * the lookup flags */
896 static intreg_t stat_helper(struct proc *p, const char *path, size_t path_l,
897                             struct kstat *u_stat, int flags)
898 {
899         struct kstat *kbuf;
900         struct dentry *path_d;
901         char *t_path = user_strdup_errno(p, path, path_l);
902         if (!t_path)
903                 return -1;
904         path_d = lookup_dentry(t_path, flags);
905         user_memdup_free(p, t_path);
906         if (!path_d)
907                 return -1;
908         kbuf = kmalloc(sizeof(struct kstat), 0);
909         if (!kbuf) {
910                 set_errno(ENOMEM);
911                 kref_put(&path_d->d_kref);
912                 return -1;
913         }
914         stat_inode(path_d->d_inode, kbuf);
915         kref_put(&path_d->d_kref);
916         /* TODO: UMEM: pin the memory, copy directly, and skip the kernel buffer */
917         if (memcpy_to_user_errno(p, u_stat, kbuf, sizeof(struct kstat))) {
918                 kfree(kbuf);
919                 set_errno(EINVAL);
920                 return -1;
921         }
922         kfree(kbuf);
923         return 0;
924 }
925
926 /* Follow a final symlink */
927 static intreg_t sys_stat(struct proc *p, const char *path, size_t path_l,
928                          struct kstat *u_stat)
929 {
930         return stat_helper(p, path, path_l, u_stat, LOOKUP_FOLLOW);
931 }
932
933 /* Don't follow a final symlink */
934 static intreg_t sys_lstat(struct proc *p, const char *path, size_t path_l,
935                           struct kstat *u_stat)
936 {
937         return stat_helper(p, path, path_l, u_stat, 0);
938 }
939
940 intreg_t sys_fcntl(struct proc *p, int fd, int cmd, int arg)
941 {
942         int retval = 0;
943         struct file *file = get_file_from_fd(&p->open_files, fd);
944         if (!file) {
945                 set_errno(EBADF);
946                 return -1;
947         }
948         switch (cmd) {
949                 case (F_DUPFD):
950                         retval = insert_file(&p->open_files, file, arg);
951                         if (retval < 0) {
952                                 set_errno(-retval);
953                                 retval = -1;
954                         }
955                         break;
956                 case (F_GETFD):
957                         /* GET and SETFD just care about CLOEXEC.  We don't have a separate
958                          * flag variable for the FD (we might need to, technically). */
959                         if (file->f_flags & O_CLOEXEC)
960                                 retval = FD_CLOEXEC;
961                         break;
962                 case (F_SETFD):
963                         if (arg == FD_CLOEXEC)
964                                 file->f_flags |= O_CLOEXEC;
965                         break;
966                 case (F_GETFL):
967                         retval = file->f_flags;
968                         break;
969                 case (F_SETFL):
970                         /* only allowed to set certain flags. */
971                         arg &= O_FCNTL_FLAGS;
972                         file->f_flags = (file->f_flags & ~O_FCNTL_FLAGS) | arg;
973                         break;
974                 default:
975                         warn("Unsupported fcntl cmd %d\n", cmd);
976         }
977         kref_put(&file->f_kref);
978         return retval;
979 }
980
981 static intreg_t sys_access(struct proc *p, const char *path, size_t path_l,
982                            int mode)
983 {
984         int retval;
985         char *t_path = user_strdup_errno(p, path, path_l);
986         if (!t_path)
987                 return -1;
988         retval = do_access(t_path, mode);
989         user_memdup_free(p, t_path);
990         printd("Access for path: %s retval: %d\n", path, retval);
991         if (retval < 0) {
992                 set_errno(-retval);
993                 return -1;
994         }
995         return retval;
996 }
997
998 intreg_t sys_umask(struct proc *p, int mask)
999 {
1000         int old_mask = p->fs_env.umask;
1001         p->fs_env.umask = mask & S_PMASK;
1002         return old_mask;
1003 }
1004
1005 intreg_t sys_chmod(struct proc *p, const char *path, size_t path_l, int mode)
1006 {
1007         int retval;
1008         char *t_path = user_strdup_errno(p, path, path_l);
1009         if (!t_path)
1010                 return -1;
1011         retval = do_chmod(t_path, mode);
1012         user_memdup_free(p, t_path);
1013         if (retval < 0) {
1014                 set_errno(-retval);
1015                 return -1;
1016         }
1017         return retval;
1018 }
1019
1020 static intreg_t sys_lseek(struct proc *p, int fd, off_t offset, int whence)
1021 {
1022         off_t ret;
1023         struct file *file = get_file_from_fd(&p->open_files, fd);
1024         if (!file) {
1025                 set_errno(EBADF);
1026                 return -1;
1027         }
1028         ret = file->f_op->llseek(file, offset, whence);
1029         kref_put(&file->f_kref);
1030         return ret;
1031 }
1032
1033 intreg_t sys_link(struct proc *p, char *old_path, size_t old_l,
1034                   char *new_path, size_t new_l)
1035 {
1036         int ret;
1037         char *t_oldpath = user_strdup_errno(p, old_path, old_l);
1038         if (t_oldpath == NULL)
1039                 return -1;
1040         char *t_newpath = user_strdup_errno(p, new_path, new_l);
1041         if (t_newpath == NULL) {
1042                 user_memdup_free(p, t_oldpath);
1043                 return -1;
1044         }
1045         ret = do_link(t_oldpath, t_newpath);
1046         user_memdup_free(p, t_oldpath);
1047         user_memdup_free(p, t_newpath);
1048         return ret;
1049 }
1050
1051 intreg_t sys_unlink(struct proc *p, const char *path, size_t path_l)
1052 {
1053         int retval;
1054         char *t_path = user_strdup_errno(p, path, path_l);
1055         if (!t_path)
1056                 return -1;
1057         retval = do_unlink(t_path);
1058         user_memdup_free(p, t_path);
1059         return retval;
1060 }
1061
1062 intreg_t sys_symlink(struct proc *p, char *old_path, size_t old_l,
1063                      char *new_path, size_t new_l)
1064 {
1065         int ret;
1066         char *t_oldpath = user_strdup_errno(p, old_path, old_l);
1067         if (t_oldpath == NULL)
1068                 return -1;
1069         char *t_newpath = user_strdup_errno(p, new_path, new_l);
1070         if (t_newpath == NULL) {
1071                 user_memdup_free(p, t_oldpath);
1072                 return -1;
1073         }
1074         ret = do_symlink(new_path, old_path, S_IRWXU | S_IRWXG | S_IRWXO);
1075         user_memdup_free(p, t_oldpath);
1076         user_memdup_free(p, t_newpath);
1077         return ret;
1078 }
1079
1080 intreg_t sys_readlink(struct proc *p, char *path, size_t path_l,
1081                       char *u_buf, size_t buf_l)
1082 {
1083         char *symname;
1084         ssize_t copy_amt;
1085         struct dentry *path_d;
1086         char *t_path = user_strdup_errno(p, path, path_l);
1087         if (t_path == NULL)
1088                 return -1;
1089         path_d = lookup_dentry(t_path, 0);
1090         user_memdup_free(p, t_path);
1091         if (!path_d)
1092                 return -1;
1093         symname = path_d->d_inode->i_op->readlink(path_d);
1094         copy_amt = strnlen(symname, buf_l - 1) + 1;
1095         if (memcpy_to_user_errno(p, u_buf, symname, copy_amt)) {
1096                 kref_put(&path_d->d_kref);
1097                 set_errno(EINVAL);
1098                 return -1;
1099         }
1100         kref_put(&path_d->d_kref);
1101         printd("READLINK returning %s\n", u_buf);
1102         return copy_amt;
1103 }
1104
1105 intreg_t sys_chdir(struct proc *p, const char *path, size_t path_l)
1106 {
1107         int retval;
1108         char *t_path = user_strdup_errno(p, path, path_l);
1109         if (!t_path)
1110                 return -1;
1111         retval = do_chdir(&p->fs_env, t_path);
1112         user_memdup_free(p, t_path);
1113         if (retval) {
1114                 set_errno(-retval);
1115                 return -1;
1116         }
1117         return 0;
1118 }
1119
1120 /* Note cwd_l is not a strlen, it's an absolute size */
1121 intreg_t sys_getcwd(struct proc *p, char *u_cwd, size_t cwd_l)
1122 {
1123         int retval = 0;
1124         char *kfree_this;
1125         char *k_cwd = do_getcwd(&p->fs_env, &kfree_this, cwd_l);
1126         if (!k_cwd)
1127                 return -1;              /* errno set by do_getcwd */
1128         if (memcpy_to_user_errno(p, u_cwd, k_cwd, strnlen(k_cwd, cwd_l - 1) + 1))
1129                 retval = -1;
1130         kfree(kfree_this);
1131         return retval;
1132 }
1133
1134 intreg_t sys_mkdir(struct proc *p, const char *path, size_t path_l, int mode)
1135 {
1136         int retval;
1137         char *t_path = user_strdup_errno(p, path, path_l);
1138         if (!t_path)
1139                 return -1;
1140         mode &= ~p->fs_env.umask;
1141         retval = do_mkdir(t_path, mode);
1142         user_memdup_free(p, t_path);
1143         return retval;
1144 }
1145
1146 intreg_t sys_rmdir(struct proc *p, const char *path, size_t path_l)
1147 {
1148         int retval;
1149         char *t_path = user_strdup_errno(p, path, path_l);
1150         if (!t_path)
1151                 return -1;
1152         retval = do_rmdir(t_path);
1153         user_memdup_free(p, t_path);
1154         return retval;
1155 }
1156
1157 intreg_t sys_gettimeofday(struct proc *p, int *buf)
1158 {
1159         static spinlock_t gtod_lock = SPINLOCK_INITIALIZER;
1160         static int t0 = 0;
1161
1162         spin_lock(&gtod_lock);
1163         if(t0 == 0)
1164
1165 #if (defined __CONFIG_APPSERVER__)
1166         t0 = ufe(time,0,0,0,0);
1167 #else
1168         // Nanwan's birthday, bitches!!
1169         t0 = 1242129600;
1170 #endif 
1171         spin_unlock(&gtod_lock);
1172
1173         long long dt = read_tsc();
1174         int kbuf[2] = {t0+dt/system_timing.tsc_freq,
1175             (dt%system_timing.tsc_freq)*1000000/system_timing.tsc_freq};
1176
1177         return memcpy_to_user_errno(p,buf,kbuf,sizeof(kbuf));
1178 }
1179
1180 #define SIZEOF_STRUCT_TERMIOS 60
1181 intreg_t sys_tcgetattr(struct proc *p, int fd, void *termios_p)
1182 {
1183         int* kbuf = kmalloc(SIZEOF_STRUCT_TERMIOS,0);
1184         int ret = ufe(tcgetattr,fd,PADDR(kbuf),0,0);
1185         if(ret != -1 && memcpy_to_user_errno(p,termios_p,kbuf,SIZEOF_STRUCT_TERMIOS))
1186                 ret = -1;
1187         kfree(kbuf);
1188         return ret;
1189 }
1190
1191 intreg_t sys_tcsetattr(struct proc *p, int fd, int optional_actions,
1192                        const void *termios_p)
1193 {
1194         void* kbuf = user_memdup_errno(p,termios_p,SIZEOF_STRUCT_TERMIOS);
1195         if(kbuf == NULL)
1196                 return -1;
1197         int ret = ufe(tcsetattr,fd,optional_actions,PADDR(kbuf),0);
1198         user_memdup_free(p,kbuf);
1199         return ret;
1200 }
1201
1202 /* TODO: we don't have any notion of UIDs or GIDs yet, but don't let that stop a
1203  * process from thinking it can do these.  The other alternative is to have
1204  * glibc return 0 right away, though someone might want to do something with
1205  * these calls.  Someday. */
1206 intreg_t sys_setuid(struct proc *p, uid_t uid)
1207 {
1208         return 0;
1209 }
1210
1211 intreg_t sys_setgid(struct proc *p, gid_t gid)
1212 {
1213         return 0;
1214 }
1215
1216 /************** Syscall Invokation **************/
1217
1218 const static struct sys_table_entry syscall_table[] = {
1219         [SYS_null] = {(syscall_t)sys_null, "null"},
1220         [SYS_cache_buster] = {(syscall_t)sys_cache_buster, "buster"},
1221         [SYS_cache_invalidate] = {(syscall_t)sys_cache_invalidate, "wbinv"},
1222         [SYS_reboot] = {(syscall_t)reboot, "reboot!"},
1223         [SYS_cputs] = {(syscall_t)sys_cputs, "cputs"},
1224         [SYS_cgetc] = {(syscall_t)sys_cgetc, "cgetc"},
1225         [SYS_getcpuid] = {(syscall_t)sys_getcpuid, "getcpuid"},
1226         [SYS_getvcoreid] = {(syscall_t)sys_getvcoreid, "getvcoreid"},
1227         [SYS_getpid] = {(syscall_t)sys_getpid, "getpid"},
1228         [SYS_proc_create] = {(syscall_t)sys_proc_create, "proc_create"},
1229         [SYS_proc_run] = {(syscall_t)sys_proc_run, "proc_run"},
1230         [SYS_proc_destroy] = {(syscall_t)sys_proc_destroy, "proc_destroy"},
1231         [SYS_yield] = {(syscall_t)sys_proc_yield, "proc_yield"},
1232         [SYS_fork] = {(syscall_t)sys_fork, "fork"},
1233         [SYS_exec] = {(syscall_t)sys_exec, "exec"},
1234         [SYS_trywait] = {(syscall_t)sys_trywait, "trywait"},
1235         [SYS_mmap] = {(syscall_t)sys_mmap, "mmap"},
1236         [SYS_munmap] = {(syscall_t)sys_munmap, "munmap"},
1237         [SYS_mprotect] = {(syscall_t)sys_mprotect, "mprotect"},
1238         [SYS_shared_page_alloc] = {(syscall_t)sys_shared_page_alloc, "pa"},
1239         [SYS_shared_page_free] = {(syscall_t)sys_shared_page_free, "pf"},
1240         [SYS_resource_req] = {(syscall_t)resource_req, "resource_req"},
1241         [SYS_notify] = {(syscall_t)sys_notify, "notify"},
1242         [SYS_self_notify] = {(syscall_t)sys_self_notify, "self_notify"},
1243         [SYS_halt_core] = {(syscall_t)sys_halt_core, "halt_core"},
1244 #ifdef __CONFIG_SERIAL_IO__
1245         [SYS_serial_read] = {(syscall_t)sys_serial_read, "ser_read"},
1246         [SYS_serial_write] = {(syscall_t)sys_serial_write, "ser_write"},
1247 #endif
1248 #ifdef __CONFIG_NETWORKING__
1249         [SYS_eth_read] = {(syscall_t)sys_eth_read, "eth_read"},
1250         [SYS_eth_write] = {(syscall_t)sys_eth_write, "eth_write"},
1251         [SYS_eth_get_mac_addr] = {(syscall_t)sys_eth_get_mac_addr, "get_mac"},
1252         [SYS_eth_recv_check] = {(syscall_t)sys_eth_recv_check, "recv_check"},
1253 #endif
1254 #ifdef __CONFIG_ARSC_SERVER__
1255         [SYS_init_arsc] = {(syscall_t)sys_init_arsc, "init_arsc"},
1256 #endif
1257         [SYS_read] = {(syscall_t)sys_read, "read"},
1258         [SYS_write] = {(syscall_t)sys_write, "write"},
1259         [SYS_open] = {(syscall_t)sys_open, "open"},
1260         [SYS_close] = {(syscall_t)sys_close, "close"},
1261         [SYS_fstat] = {(syscall_t)sys_fstat, "fstat"},
1262         [SYS_stat] = {(syscall_t)sys_stat, "stat"},
1263         [SYS_lstat] = {(syscall_t)sys_lstat, "lstat"},
1264         [SYS_fcntl] = {(syscall_t)sys_fcntl, "fcntl"},
1265         [SYS_access] = {(syscall_t)sys_access, "access"},
1266         [SYS_umask] = {(syscall_t)sys_umask, "umask"},
1267         [SYS_chmod] = {(syscall_t)sys_chmod, "chmod"},
1268         [SYS_lseek] = {(syscall_t)sys_lseek, "lseek"},
1269         [SYS_link] = {(syscall_t)sys_link, "link"},
1270         [SYS_unlink] = {(syscall_t)sys_unlink, "unlink"},
1271         [SYS_symlink] = {(syscall_t)sys_symlink, "symlink"},
1272         [SYS_readlink] = {(syscall_t)sys_readlink, "readlink"},
1273         [SYS_chdir] = {(syscall_t)sys_chdir, "chdir"},
1274         [SYS_getcwd] = {(syscall_t)sys_getcwd, "getcwd"},
1275         [SYS_mkdir] = {(syscall_t)sys_mkdir, "mkdri"},
1276         [SYS_rmdir] = {(syscall_t)sys_rmdir, "rmdir"},
1277         [SYS_gettimeofday] = {(syscall_t)sys_gettimeofday, "gettime"},
1278         [SYS_tcgetattr] = {(syscall_t)sys_tcgetattr, "tcgetattr"},
1279         [SYS_tcsetattr] = {(syscall_t)sys_tcsetattr, "tcsetattr"},
1280         [SYS_setuid] = {(syscall_t)sys_setuid, "setuid"},
1281         [SYS_setgid] = {(syscall_t)sys_setgid, "setgid"}
1282 };
1283
1284 /* Executes the given syscall.
1285  *
1286  * Note tf is passed in, which points to the tf of the context on the kernel
1287  * stack.  If any syscall needs to block, it needs to save this info, as well as
1288  * any silly state.
1289  * 
1290  * This syscall function is used by both local syscall and arsc, and should
1291  * remain oblivious of the caller. */
1292 intreg_t syscall(struct proc *p, uintreg_t syscallno, uintreg_t a1,
1293                  uintreg_t a2, uintreg_t a3, uintreg_t a4, uintreg_t a5)
1294 {
1295         /* Initialize the return value and error code returned to 0 */
1296         set_retval(ESUCCESS);
1297         set_errno(ESUCCESS);
1298
1299         const int max_syscall = sizeof(syscall_table)/sizeof(syscall_table[0]);
1300
1301         uint32_t coreid, vcoreid;
1302         if (systrace_flags & SYSTRACE_ON) {
1303                 if ((systrace_flags & SYSTRACE_ALLPROC) || (proc_is_traced(p))) {
1304                         coreid = core_id();
1305                         vcoreid = proc_get_vcoreid(p, coreid);
1306                         if (systrace_flags & SYSTRACE_LOUD) {
1307                                 printk("[%16llu] Syscall %3d (%12s):(%08p, %08p, %08p, %08p, "
1308                                        "%08p) proc: %d core: %d vcore: %d\n", read_tsc(),
1309                                        syscallno, syscall_table[syscallno].name, a1, a2, a3,
1310                                        a4, a5, p->pid, coreid, vcoreid);
1311                         } else {
1312                                 struct systrace_record *trace;
1313                                 unsigned int idx, new_idx;
1314                                 do {
1315                                         idx = systrace_bufidx;
1316                                         new_idx = (idx + 1) % systrace_bufsize;
1317                                 } while (!atomic_comp_swap(&systrace_bufidx, idx, new_idx));
1318                                 trace = &systrace_buffer[idx];
1319                                 trace->timestamp = read_tsc();
1320                                 trace->syscallno = syscallno;
1321                                 trace->arg1 = a1;
1322                                 trace->arg2 = a2;
1323                                 trace->arg3 = a3;
1324                                 trace->arg4 = a4;
1325                                 trace->arg5 = a5;
1326                                 trace->pid = p->pid;
1327                                 trace->coreid = coreid;
1328                                 trace->vcoreid = vcoreid;
1329                         }
1330                 }
1331         }
1332         //printk("Incoming syscall on core: %d number: %d\n    a1: %x\n   "
1333         //       " a2: %x\n    a3: %x\n    a4: %x\n    a5: %x\n", core_id(),
1334         //       syscallno, a1, a2, a3, a4, a5);
1335
1336         if (syscallno > max_syscall || syscall_table[syscallno].call == NULL)
1337                 panic("Invalid syscall number %d for proc %x!", syscallno, *p);
1338
1339         return syscall_table[syscallno].call(p, a1, a2, a3, a4, a5);
1340 }
1341
1342 /* Syscall tracing */
1343 static void __init_systrace(void)
1344 {
1345         systrace_buffer = kmalloc(MAX_SYSTRACES*sizeof(struct systrace_record), 0);
1346         if (!systrace_buffer)
1347                 panic("Unable to alloc a trace buffer\n");
1348         systrace_bufidx = 0;
1349         systrace_bufsize = MAX_SYSTRACES;
1350         /* Note we never free the buffer - it's around forever.  Feel free to change
1351          * this if you want to change the size or something dynamically. */
1352 }
1353
1354 /* If you call this while it is running, it will change the mode */
1355 void systrace_start(bool silent)
1356 {
1357         static bool init = FALSE;
1358         spin_lock_irqsave(&systrace_lock);
1359         if (!init) {
1360                 __init_systrace();
1361                 init = TRUE;
1362         }
1363         systrace_flags = silent ? SYSTRACE_ON : SYSTRACE_ON | SYSTRACE_LOUD; 
1364         spin_unlock_irqsave(&systrace_lock);
1365 }
1366
1367 int systrace_reg(bool all, struct proc *p)
1368 {
1369         int retval = 0;
1370         spin_lock_irqsave(&systrace_lock);
1371         if (all) {
1372                 printk("Tracing syscalls for all processes\n");
1373                 systrace_flags |= SYSTRACE_ALLPROC;
1374                 retval = 0;
1375         } else {
1376                 for (int i = 0; i < MAX_NUM_TRACED; i++) {
1377                         if (!systrace_procs[i]) {
1378                                 printk("Tracing syscalls for process %d\n", p->pid);
1379                                 systrace_procs[i] = p;
1380                                 retval = 0;
1381                                 break;
1382                         }
1383                 }
1384         }
1385         spin_unlock_irqsave(&systrace_lock);
1386         return retval;
1387 }
1388
1389 void systrace_stop(void)
1390 {
1391         spin_lock_irqsave(&systrace_lock);
1392         systrace_flags = 0;
1393         for (int i = 0; i < MAX_NUM_TRACED; i++)
1394                 systrace_procs[i] = 0;
1395         spin_unlock_irqsave(&systrace_lock);
1396 }
1397
1398 /* If you registered a process specifically, then you need to dereg it
1399  * specifically.  Or just fully stop, which will do it for all. */
1400 int systrace_dereg(bool all, struct proc *p)
1401 {
1402         spin_lock_irqsave(&systrace_lock);
1403         if (all) {
1404                 printk("No longer tracing syscalls for all processes.\n");
1405                 systrace_flags &= ~SYSTRACE_ALLPROC;
1406         } else {
1407                 for (int i = 0; i < MAX_NUM_TRACED; i++) {
1408                         if (systrace_procs[i] == p) {
1409                                 systrace_procs[i] = 0;
1410                                 printk("No longer tracing syscalls for process %d\n", p->pid);
1411                         }
1412                 }
1413         }
1414         spin_unlock_irqsave(&systrace_lock);
1415         return 0;
1416 }
1417
1418 /* Regardless of locking, someone could be writing into the buffer */
1419 void systrace_print(bool all, struct proc *p)
1420 {
1421         spin_lock_irqsave(&systrace_lock);
1422         /* if you want to be clever, you could make this start from the earliest
1423          * timestamp and loop around.  Careful of concurrent writes. */
1424         for (int i = 0; i < systrace_bufsize; i++)
1425                 if (systrace_buffer[i].timestamp)
1426                         printk("[%16llu] Syscall %3d (%12s):(%08p, %08p, %08p, %08p, "
1427                                "%08p) proc: %d core: %d vcore: %d\n",
1428                                systrace_buffer[i].timestamp,
1429                                systrace_buffer[i].syscallno,
1430                                syscall_table[systrace_buffer[i].syscallno].name,
1431                                systrace_buffer[i].arg1,
1432                                systrace_buffer[i].arg2,
1433                                systrace_buffer[i].arg3,
1434                                systrace_buffer[i].arg4,
1435                                systrace_buffer[i].arg5,
1436                                systrace_buffer[i].pid,
1437                                systrace_buffer[i].coreid,
1438                                systrace_buffer[i].vcoreid);
1439         spin_unlock_irqsave(&systrace_lock);
1440 }
1441
1442 void systrace_clear_buffer(void)
1443 {
1444         spin_lock_irqsave(&systrace_lock);
1445         memset(systrace_buffer, 0, sizeof(struct systrace_record) * MAX_SYSTRACES);
1446         spin_unlock_irqsave(&systrace_lock);
1447 }
1448
1449 void set_retval(uint32_t retval)
1450 {
1451         struct per_cpu_info* coreinfo = &per_cpu_info[core_id()];
1452         *(coreinfo->cur_ret.returnloc) = retval;
1453 }
1454 void set_errno(uint32_t errno)
1455 {
1456         struct per_cpu_info* coreinfo = &per_cpu_info[core_id()];
1457         if (coreinfo && coreinfo->cur_ret.errno_loc)
1458                 *(coreinfo->cur_ret.errno_loc) = errno;
1459 }