_M procs start up at _start/hart_entry for vcore0
[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 <mm.h>
23 #include <trap.h>
24 #include <syscall.h>
25 #include <kmalloc.h>
26 #include <stdio.h>
27 #include <resource.h>
28 #include <frontend.h>
29 #include <colored_caches.h>
30 #include <arch/bitmask.h>
31 #include <kfs.h> // eventually replace this with vfs.h
32
33
34 #ifdef __CONFIG_NETWORKING__
35 #include <arch/nic_common.h>
36 extern int (*send_frame)(const char *CT(len) data, size_t len);
37 extern char device_mac[6];
38 #endif
39
40 /************** Utility Syscalls **************/
41
42 static int sys_null(void)
43 {
44         return 0;
45 }
46
47 // Writes 'val' to 'num_writes' entries of the well-known array in the kernel
48 // address space.  It's just #defined to be some random 4MB chunk (which ought
49 // to be boot_alloced or something).  Meant to grab exclusive access to cache
50 // lines, to simulate doing something useful.
51 static int sys_cache_buster(struct proc *p, uint32_t num_writes,
52                              uint32_t num_pages, uint32_t flags)
53 { TRUSTEDBLOCK /* zra: this is not really part of the kernel */
54         #define BUSTER_ADDR             0xd0000000  // around 512 MB deep
55         #define MAX_WRITES              1048576*8
56         #define MAX_PAGES               32
57         #define INSERT_ADDR     (UINFO + 2*PGSIZE) // should be free for these tests
58         uint32_t* buster = (uint32_t*)BUSTER_ADDR;
59         static spinlock_t buster_lock = SPINLOCK_INITIALIZER;
60         uint64_t ticks = -1;
61         page_t* a_page[MAX_PAGES];
62
63         /* Strided Accesses or Not (adjust to step by cachelines) */
64         uint32_t stride = 1;
65         if (flags & BUSTER_STRIDED) {
66                 stride = 16;
67                 num_writes *= 16;
68         }
69
70         /* Shared Accesses or Not (adjust to use per-core regions)
71          * Careful, since this gives 8MB to each core, starting around 512MB.
72          * Also, doesn't separate memory for core 0 if it's an async call.
73          */
74         if (!(flags & BUSTER_SHARED))
75                 buster = (uint32_t*)(BUSTER_ADDR + core_id() * 0x00800000);
76
77         /* Start the timer, if we're asked to print this info*/
78         if (flags & BUSTER_PRINT_TICKS)
79                 ticks = start_timing();
80
81         /* Allocate num_pages (up to MAX_PAGES), to simulate doing some more
82          * realistic work.  Note we don't write to these pages, even if we pick
83          * unshared.  Mostly due to the inconvenience of having to match up the
84          * number of pages with the number of writes.  And it's unnecessary.
85          */
86         if (num_pages) {
87                 spin_lock(&buster_lock);
88                 for (int i = 0; i < MIN(num_pages, MAX_PAGES); i++) {
89                         upage_alloc(p, &a_page[i],1);
90                         page_insert(p->env_pgdir, a_page[i], (void*)INSERT_ADDR + PGSIZE*i,
91                                     PTE_USER_RW);
92                 }
93                 spin_unlock(&buster_lock);
94         }
95
96         if (flags & BUSTER_LOCKED)
97                 spin_lock(&buster_lock);
98         for (int i = 0; i < MIN(num_writes, MAX_WRITES); i=i+stride)
99                 buster[i] = 0xdeadbeef;
100         if (flags & BUSTER_LOCKED)
101                 spin_unlock(&buster_lock);
102
103         if (num_pages) {
104                 spin_lock(&buster_lock);
105                 for (int i = 0; i < MIN(num_pages, MAX_PAGES); i++) {
106                         page_remove(p->env_pgdir, (void*)(INSERT_ADDR + PGSIZE * i));
107                         page_decref(a_page[i]);
108                 }
109                 spin_unlock(&buster_lock);
110         }
111
112         /* Print info */
113         if (flags & BUSTER_PRINT_TICKS) {
114                 ticks = stop_timing(ticks);
115                 printk("%llu,", ticks);
116         }
117         return 0;
118 }
119
120 static int sys_cache_invalidate(void)
121 {
122         #ifdef __i386__
123                 wbinvd();
124         #endif
125         return 0;
126 }
127
128 /* sys_reboot(): called directly from dispatch table. */
129
130 // Print a string to the system console.
131 // The string is exactly 'len' characters long.
132 // Destroys the environment on memory errors.
133 static ssize_t sys_cputs(env_t* e, const char *DANGEROUS s, size_t len)
134 {
135         // Check that the user has permission to read memory [s, s+len).
136         // Destroy the environment if not.
137         char *COUNT(len) _s = user_mem_assert(e, s, len, PTE_USER_RO);
138
139         // Print the string supplied by the user.
140         printk("%.*s", len, _s);
141         return (ssize_t)len;
142 }
143
144 // Read a character from the system console.
145 // Returns the character.
146 static uint16_t sys_cgetc(env_t* e)
147 {
148         uint16_t c;
149
150         // The cons_getc() primitive doesn't wait for a character,
151         // but the sys_cgetc() system call does.
152         while ((c = cons_getc()) == 0)
153                 cpu_relax();
154
155         return c;
156 }
157
158 /* Returns the id of the cpu this syscall is executed on. */
159 static uint32_t sys_getcpuid(void)
160 {
161         return core_id();
162 }
163
164 // TODO: Temporary hack until thread-local storage is implemented on i386 and
165 // this is removed from the user interface
166 static size_t sys_getvcoreid(struct proc *p)
167 {
168         return proc_get_vcoreid(p, core_id());
169 }
170
171 /************** Process management syscalls **************/
172
173 /* Returns the calling process's pid */
174 static pid_t sys_getpid(struct proc *p)
175 {
176         return p->pid;
177 }
178
179 /*
180  * Creates a process found at the user string 'path'.  Currently uses KFS.
181  * Not runnable by default, so it needs it's status to be changed so that the
182  * next call to schedule() will try to run it.
183  * TODO: once we have a decent VFS, consider splitting this up
184  * and once there's an mmap, can have most of this in process.c
185  */
186 static int sys_proc_create(struct proc *p, const char *DANGEROUS path)
187 {
188         int pid = 0;
189         char tpath[MAX_PATH_LEN];
190         /*
191          * There's a bunch of issues with reading in the path, which we'll
192          * need to sort properly in the VFS.  Main concerns are TOCTOU (copy-in),
193          * whether or not it's a big deal that the pointer could be into kernel
194          * space, and resolving both of these without knowing the length of the
195          * string. (TODO)
196          * Change this so that all syscalls with a pointer take a length.
197          *
198          * zra: I've added this user_mem_strlcpy, which I think eliminates the
199      * the TOCTOU issue. Adding a length arg to this call would allow a more
200          * efficient implementation, though, since only one call to user_mem_check
201          * would be required.
202          */
203         int ret = user_mem_strlcpy(p,tpath, path, MAX_PATH_LEN, PTE_USER_RO);
204         int kfs_inode = kfs_lookup_path(tpath);
205         if (kfs_inode < 0)
206                 return -EINVAL;
207         struct proc *new_p = kfs_proc_create(kfs_inode);
208         pid = new_p->pid;
209         proc_decref(new_p, 1); // let go of the reference created in proc_create()
210         return pid;
211 }
212
213 /* Makes process PID runnable.  Consider moving the functionality to process.c */
214 static error_t sys_proc_run(struct proc *p, unsigned pid)
215 {
216         struct proc *target = pid2proc(pid);
217         error_t retval = 0;
218
219         if (!target)
220                 return -EBADPROC;
221         // note we can get interrupted here. it's not bad.
222         spin_lock_irqsave(&p->proc_lock);
223         // make sure we have access and it's in the right state to be activated
224         if (!proc_controls(p, target)) {
225                 proc_decref(target, 1);
226                 retval = -EPERM;
227         } else if (target->state != PROC_CREATED) {
228                 proc_decref(target, 1);
229                 retval = -EINVAL;
230         } else {
231                 __proc_set_state(target, PROC_RUNNABLE_S);
232                 schedule_proc(target);
233         }
234         spin_unlock_irqsave(&p->proc_lock);
235         proc_decref(target, 1);
236         return retval;
237 }
238
239 /* Destroy proc pid.  If this is called by the dying process, it will never
240  * return.  o/w it will return 0 on success, or an error.  Errors include:
241  * - EBADPROC: if there is no such process with pid
242  * - EPERM: if caller does not control pid */
243 static error_t sys_proc_destroy(struct proc *p, pid_t pid, int exitcode)
244 {
245         error_t r;
246         struct proc *p_to_die = pid2proc(pid);
247
248         if (!p_to_die) {
249                 set_errno(current_tf, ESRCH);
250                 return -1;
251         }
252         if (!proc_controls(p, p_to_die)) {
253                 proc_decref(p_to_die, 1);
254                 set_errno(current_tf, EPERM);
255                 return -1;
256         }
257         if (p_to_die == p) {
258                 // syscall code and pid2proc both have edible references, only need 1.
259                 p->exitcode = exitcode;
260                 proc_decref(p, 1);
261                 printd("[PID %d] proc exiting gracefully (code %d)\n", p->pid,exitcode);
262         } else {
263                 panic("Destroying other processes is not supported yet.");
264                 //printk("[%d] destroying proc %d\n", p->pid, p_to_die->pid);
265         }
266         proc_destroy(p_to_die);
267         return ESUCCESS;
268 }
269
270 static int sys_proc_yield(struct proc *p)
271 {
272         proc_yield(p);
273         return 0;
274 }
275
276 static ssize_t sys_run_binary(env_t* e, void *DANGEROUS binary_buf, size_t len,
277                               procinfo_t*DANGEROUS procinfo, size_t num_colors)
278 {
279         env_t* env = proc_create(NULL,0);
280         assert(env != NULL);
281
282         // let me know if you use this.  we need to sort process creation better.
283         printk("sys_run_binary() is deprecated.  Use at your own risk.");
284         if(memcpy_from_user(e,e->procinfo,procinfo,sizeof(*procinfo)))
285                 return -1;
286         proc_init_procinfo(e);
287
288         env_load_icode(env,e,binary_buf,len);
289         __proc_set_state(env, PROC_RUNNABLE_S);
290         schedule_proc(env);
291         if(num_colors > 0) {
292                 env->cache_colors_map = cache_colors_map_alloc();
293                 for(int i=0; i<num_colors; i++)
294                         cache_color_alloc(llc_cache, env->cache_colors_map);
295         }
296         proc_decref(env, 1);
297         proc_yield(e);
298         return 0;
299 }
300
301 static ssize_t sys_fork(env_t* e)
302 {
303         // TODO: right now we only support fork for single-core processes
304         if(e->state != PROC_RUNNING_S)
305         {
306                 set_errno(current_tf,EINVAL);
307                 return -1;
308         }
309
310         env_t* env = proc_create(NULL,0);
311         assert(env != NULL);
312
313         env->heap_top = e->heap_top;
314         env->ppid = e->pid;
315         env->env_tf = *current_tf;
316
317         env->cache_colors_map = cache_colors_map_alloc();
318         for(int i=0; i < llc_cache->num_colors; i++)
319                 if(GET_BITMASK_BIT(e->cache_colors_map,i))
320                         cache_color_alloc(llc_cache, env->cache_colors_map);
321
322         int copy_page(env_t* e, pte_t* pte, void* va, void* arg)
323         {
324                 env_t* env = (env_t*)arg;
325
326                 if(PAGE_PRESENT(*pte))
327                 {
328                         page_t* pp;
329                         if(upage_alloc(env,&pp,0))
330                                 return -1;
331                         if(page_insert(env->env_pgdir,pp,va,*pte & PTE_PERM))
332                         {
333                                 page_decref(pp);
334                                 return -1;
335                         }
336
337                         pagecopy(page2kva(pp),ppn2kva(PTE2PPN(*pte)));
338                 }
339                 else // PAGE_PAGED_OUT(*pte)
340                 {
341                         pte_t* newpte = pgdir_walk(env->env_pgdir,va,1);
342                         if(!newpte)
343                                 return -1;
344
345                         struct file* file = PTE2PFAULT_INFO(*pte)->file;
346                         pfault_info_t* newpfi = pfault_info_alloc(file);
347                         if(!newpfi)
348                                 return -1;
349
350                         *newpfi = *PTE2PFAULT_INFO(*pte);
351                         *newpte = PFAULT_INFO2PTE(newpfi);
352                 }
353
354                 return 0;
355         }
356
357         // TODO: (PC) this won't work.  Needs revisiting.
358         // copy procdata and procinfo
359         memcpy(env->procdata,e->procdata,sizeof(struct procdata));
360         memcpy(env->procinfo,e->procinfo,sizeof(struct procinfo));
361         env->procinfo->pid = env->pid;
362         env->procinfo->ppid = env->ppid;
363
364         // copy all memory below procdata
365         if(env_user_mem_walk(e,0,UDATA,&copy_page,env))
366         {
367                 proc_decref(env,2);
368                 set_errno(current_tf,ENOMEM);
369                 return -1;
370         }
371
372         __proc_set_state(env, PROC_RUNNABLE_S);
373         schedule_proc(env);
374
375         // don't decref the new process.
376         // that will happen when the parent waits for it.
377
378         printd("[PID %d] fork PID %d\n",e->pid,env->pid);
379
380         return env->pid;
381 }
382
383 intreg_t sys_exec(struct proc* p, int fd, procinfo_t* pi)
384 {
385         if(p->state != PROC_RUNNING_S)
386                 return -1;
387
388         int ret = -1;
389         struct file* f = file_open_from_fd(p,fd);
390         if(f == NULL) {
391                 set_errno(current_tf, EBADF);
392                 goto out;
393         }
394
395         // TODO: don't copy procinfo from the user (PC)
396         if(memcpy_from_user(p,p->procinfo,pi,sizeof(procinfo_t))) {
397                 proc_destroy(p);
398                 goto out;
399         }
400         proc_init_procinfo(p);
401         // TODO: don't do this either (PC)
402         memset(p->procdata, 0, sizeof(procdata_t));
403
404         env_user_mem_free(p,0,USTACKTOP);
405
406         if(load_elf(p,f))
407         {
408                 proc_destroy(p);
409                 goto out;
410         }
411         file_decref(f);
412         *current_tf = p->env_tf;
413         ret = 0;
414
415         printd("[PID %d] exec fd %d\n",p->pid,fd);
416
417 out:
418         return ret;
419 }
420
421 static ssize_t sys_trywait(env_t* e, pid_t pid, int* status)
422 {
423         struct proc* p = pid2proc(pid);
424
425         // TODO: this syscall is racy, so we only support for single-core procs
426         if(e->state != PROC_RUNNING_S)
427                 return -1;
428
429         // TODO: need to use errno properly.  sadly, ROS error codes conflict..
430
431         if(p)
432         {
433                 ssize_t ret;
434
435                 if(current->pid == p->ppid)
436                 {
437                         if(p->state == PROC_DYING)
438                         {
439                                 memcpy_to_user(e,status,&p->exitcode,sizeof(int));
440                                 printd("[PID %d] waited for PID %d (code %d)\n",
441                                        e->pid,p->pid,p->exitcode);
442                                 ret = 0;
443                         }
444                         else // not dead yet
445                         {
446                                 set_errno(current_tf,0);
447                                 ret = -1;
448                         }
449                 }
450                 else // not a child of the calling process
451                 {
452                         set_errno(current_tf,1);
453                         ret = -1;
454                 }
455
456                 // if the wait succeeded, decref twice
457                 proc_decref(p,1 + (ret == 0));
458                 return ret;
459         }
460
461         set_errno(current_tf,1);
462         return -1;
463 }
464
465 /************** Memory Management Syscalls **************/
466
467 static void *sys_mmap(struct proc* p, uintreg_t a1, uintreg_t a2, uintreg_t a3,
468                       uintreg_t* a456)
469 {
470         uintreg_t _a456[3];
471         if(memcpy_from_user(p,_a456,a456,3*sizeof(uintreg_t)))
472                 sys_proc_destroy(p,p->pid,-1);
473         return mmap(p,a1,a2,a3,_a456[0],_a456[1],_a456[2]);
474 }
475
476 static intreg_t sys_mprotect(struct proc* p, void* addr, size_t len, int prot)
477 {
478         return mprotect(p, addr, len, prot);
479 }
480
481 static intreg_t sys_munmap(struct proc* p, void* addr, size_t len)
482 {
483         return munmap(p, addr, len);
484 }
485
486 static void* sys_brk(struct proc *p, void* addr) {
487         ssize_t range;
488
489         spin_lock_irqsave(&p->proc_lock);
490
491         if((addr < p->procinfo->heap_bottom) || (addr >= (void*)BRK_END))
492                 goto out;
493
494         uintptr_t real_heap_top = ROUNDUP((uintptr_t)p->heap_top,PGSIZE);
495         uintptr_t real_new_heap_top = ROUNDUP((uintptr_t)addr,PGSIZE);
496         range = real_new_heap_top - real_heap_top;
497
498         if (range > 0) {
499                 if(__do_mmap(p, real_heap_top, range, PROT_READ | PROT_WRITE,
500                              MAP_FIXED | MAP_ANONYMOUS, NULL, 0) == MAP_FAILED)
501                         goto out;
502         }
503         else if (range < 0) {
504                 if(__munmap(p, (void*)real_new_heap_top, -range))
505                         goto out;
506         }
507         p->heap_top = addr;
508
509 out:
510         spin_unlock_irqsave(&p->proc_lock);
511         return p->heap_top;
512 }
513
514 static ssize_t sys_shared_page_alloc(env_t* p1,
515                                      void**DANGEROUS _addr, pid_t p2_id,
516                                      int p1_flags, int p2_flags
517                                     )
518 {
519         //if (!VALID_USER_PERMS(p1_flags)) return -EPERM;
520         //if (!VALID_USER_PERMS(p2_flags)) return -EPERM;
521
522         void * COUNT(1) * COUNT(1) addr = user_mem_assert(p1, _addr, sizeof(void *),
523                                                       PTE_USER_RW);
524         struct proc *p2 = pid2proc(p2_id);
525         if (!p2)
526                 return -EBADPROC;
527
528         page_t* page;
529         error_t e = upage_alloc(p1, &page,1);
530         if (e < 0) {
531                 proc_decref(p2, 1);
532                 return e;
533         }
534
535         void* p2_addr = page_insert_in_range(p2->env_pgdir, page,
536                         (void*SNT)UTEXT, (void*SNT)UTOP, p2_flags);
537         if (p2_addr == NULL) {
538                 page_free(page);
539                 proc_decref(p2, 1);
540                 return -EFAIL;
541         }
542
543         void* p1_addr = page_insert_in_range(p1->env_pgdir, page,
544                         (void*SNT)UTEXT, (void*SNT)UTOP, p1_flags);
545         if(p1_addr == NULL) {
546                 page_remove(p2->env_pgdir, p2_addr);
547                 page_free(page);
548                 proc_decref(p2, 1);
549                 return -EFAIL;
550         }
551         *addr = p1_addr;
552         proc_decref(p2, 1);
553         return ESUCCESS;
554 }
555
556 static int sys_shared_page_free(env_t* p1, void*DANGEROUS addr, pid_t p2)
557 {
558         return -1;
559 }
560
561
562 /* sys_resource_req(): called directly from dispatch table. */
563
564 /* Will notify the target on the given vcore, if the caller controls the target.
565  * Will honor the target's wanted/vcoreid.  u_ne can be NULL. */
566 static int sys_notify(struct proc *p, int target_pid, unsigned int notif,
567                       struct notif_event *u_ne)
568 {
569         struct notif_event local_ne;
570         struct proc *target = pid2proc(target_pid);
571
572         if (!target) {
573                 set_errno(current_tf, EBADPROC);
574                 return -1;
575         }
576         if (!proc_controls(p, target)) {
577                 proc_decref(target, 1);
578                 set_errno(current_tf, EPERM);
579                 return -1;
580         }
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                         proc_decref(target, 1);
585                         set_errno(current_tf, EINVAL);
586                         return -1;
587                 }
588                 proc_notify(target, local_ne.ne_type, &local_ne);
589         } else {
590                 proc_notify(target, notif, 0);
591         }
592         proc_decref(target, 1);
593         return 0;
594 }
595
596 /* Will notify the calling process on the given vcore, independently of WANTED
597  * or advertised vcoreid. */
598 static int sys_self_notify(struct proc *p, uint32_t vcoreid, unsigned int notif,
599                            struct notif_event *u_ne)
600 {
601         struct notif_event local_ne;
602
603         /* if the user provided a notif_event, copy it in and use that */
604         if (u_ne) {
605                 if (memcpy_from_user(p, &local_ne, u_ne, sizeof(struct notif_event))) {
606                         set_errno(current_tf, EINVAL);
607                         return -1;
608                 }
609                 do_notify(p, vcoreid, local_ne.ne_type, &local_ne);
610         } else {
611                 do_notify(p, vcoreid, notif, 0);
612         }
613         return 0;
614 }
615
616 /************** Platform Specific Syscalls **************/
617
618 //Read a buffer over the serial port
619 static ssize_t sys_serial_read(env_t* e, char *DANGEROUS _buf, size_t len)
620 {
621         if (len == 0)
622                 return 0;
623
624         #ifdef __CONFIG_SERIAL_IO__
625             char *COUNT(len) buf = user_mem_assert(e, _buf, len, PTE_USER_RO);
626                 size_t bytes_read = 0;
627                 int c;
628                 while((c = serial_read_byte()) != -1) {
629                         buf[bytes_read++] = (uint8_t)c;
630                         if(bytes_read == len) break;
631                 }
632                 return (ssize_t)bytes_read;
633         #else
634                 return -EINVAL;
635         #endif
636 }
637
638 //Write a buffer over the serial port
639 static ssize_t sys_serial_write(env_t* e, const char *DANGEROUS buf, size_t len)
640 {
641         if (len == 0)
642                 return 0;
643         #ifdef __CONFIG_SERIAL_IO__
644                 char *COUNT(len) _buf = user_mem_assert(e, buf, len, PTE_USER_RO);
645                 for(int i =0; i<len; i++)
646                         serial_send_byte(buf[i]);
647                 return (ssize_t)len;
648         #else
649                 return -EINVAL;
650         #endif
651 }
652
653 #ifdef __CONFIG_NETWORKING__
654 // This is not a syscall we want. Its hacky. Here just for syscall stuff until get a stack.
655 static ssize_t sys_eth_read(env_t* e, char *DANGEROUS buf)
656 {
657         if (eth_up) {
658
659                 uint32_t len;
660                 char *ptr;
661
662                 spin_lock(&packet_buffers_lock);
663
664                 if (num_packet_buffers == 0) {
665                         spin_unlock(&packet_buffers_lock);
666                         return 0;
667                 }
668
669                 ptr = packet_buffers[packet_buffers_head];
670                 len = packet_buffers_sizes[packet_buffers_head];
671
672                 num_packet_buffers--;
673                 packet_buffers_head = (packet_buffers_head + 1) % MAX_PACKET_BUFFERS;
674
675                 spin_unlock(&packet_buffers_lock);
676
677                 char* _buf = user_mem_assert(e, buf, len, PTE_U);
678
679                 memcpy(_buf, ptr, len);
680
681                 kfree(ptr);
682
683                 return len;
684         }
685         else
686                 return -EINVAL;
687 }
688
689 // This is not a syscall we want. Its hacky. Here just for syscall stuff until get a stack.
690 static ssize_t sys_eth_write(env_t* e, const char *DANGEROUS buf, size_t len)
691 {
692         if (eth_up) {
693
694                 if (len == 0)
695                         return 0;
696
697                 // HACK TO BYPASS HACK
698                 int just_sent = send_frame(buf, len);
699
700                 if (just_sent < 0) {
701                         printk("Packet send fail\n");
702                         return 0;
703                 }
704
705                 return just_sent;
706
707                 // END OF RECURSIVE HACK
708 /*
709                 char *COUNT(len) _buf = user_mem_assert(e, buf, len, PTE_U);
710                 int total_sent = 0;
711                 int just_sent = 0;
712                 int cur_packet_len = 0;
713                 while (total_sent != len) {
714                         cur_packet_len = ((len - total_sent) > MTU) ? MTU : (len - total_sent);
715                         char dest_mac[6] = APPSERVER_MAC_ADDRESS;
716                         char* wrap_buffer = eth_wrap(_buf + total_sent, cur_packet_len, device_mac, dest_mac, APPSERVER_PORT);
717                         just_sent = send_frame(wrap_buffer, cur_packet_len + sizeof(struct ETH_Header));
718
719                         if (just_sent < 0)
720                                 return 0; // This should be an error code of its own
721
722                         if (wrap_buffer)
723                                 kfree(wrap_buffer);
724
725                         total_sent += cur_packet_len;
726                 }
727
728                 return (ssize_t)len;
729 */
730         }
731         else
732                 return -EINVAL;
733 }
734
735 static ssize_t sys_eth_get_mac_addr(env_t* e, char *DANGEROUS buf) 
736 {
737         if (eth_up) {
738                 for (int i = 0; i < 6; i++)
739                         buf[i] = device_mac[i];
740                 return 0;
741         }
742         else
743                 return -EINVAL;
744 }
745
746 static int sys_eth_recv_check(env_t* e) 
747 {
748         if (num_packet_buffers != 0) 
749                 return 1;
750         else
751                 return 0;
752 }
753
754 #endif // Network
755
756 // Syscalls below here are serviced by the appserver for now.
757 #define ufe(which,a0,a1,a2,a3) \
758         frontend_syscall_errno(p,APPSERVER_SYSCALL_##which,\
759                            (int)(a0),(int)(a1),(int)(a2),(int)(a3))
760
761 intreg_t sys_write(struct proc* p, int fd, const void* buf, int len)
762 {
763         int ret = 0;
764         void* kbuf = user_memdup_errno(p,buf,len);
765         if(kbuf == NULL)
766                 return -1;
767 #ifndef __CONFIG_APPSERVER__
768         /* Catch a common usage of stderr */
769         if (fd == 2) {
770                 ((char*)kbuf)[len-1] = 0;
771                 printk("[stderr]: %s\n", kbuf);
772                 ret = len;
773         } else { // but warn/panic otherwise in ufe()
774                 ret = ufe(write, fd, PADDR(kbuf), len, 0);
775         }
776 #else
777         ret = ufe(write, fd, PADDR(kbuf), len, 0);
778 #endif
779         user_memdup_free(p,kbuf);
780         return ret;
781 }
782
783 intreg_t sys_read(struct proc* p, int fd, void* buf, int len)
784 {
785         void* kbuf = kmalloc_errno(len);
786         if(kbuf == NULL)
787                 return -1;
788         int ret = ufe(read,fd,PADDR(kbuf),len,0);
789         if(ret != -1 && memcpy_to_user_errno(p,buf,kbuf,len))
790                 ret = -1;
791         user_memdup_free(p,kbuf);
792         return ret;
793 }
794
795 intreg_t sys_pwrite(struct proc* p, int fd, const void* buf, int len, int offset)
796 {
797         void* kbuf = user_memdup_errno(p,buf,len);
798         if(kbuf == NULL)
799                 return -1;
800         int ret = ufe(pwrite,fd,PADDR(kbuf),len,offset);
801         user_memdup_free(p,kbuf);
802         return ret;
803 }
804
805 intreg_t sys_pread(struct proc* p, int fd, void* buf, int len, int offset)
806 {
807         void* kbuf = kmalloc_errno(len);
808         if(kbuf == NULL)
809                 return -1;
810         int ret = ufe(pread,fd,PADDR(kbuf),len,offset);
811         if(ret != -1 && memcpy_to_user_errno(p,buf,kbuf,len))
812                 ret = -1;
813         user_memdup_free(p,kbuf);
814         return ret;
815 }
816
817 intreg_t sys_open(struct proc* p, const char* path, int oflag, int mode)
818 {
819         printd("File Open, p: %p, path: %s, oflag: %d, mode: 0x%x\n", p, path, oflag, mode);
820         char* fn = user_strdup_errno(p,path,PGSIZE);
821         if(fn == NULL) {
822                 printd("File Open, user_strdup_errno failed\n");
823                 return -1;
824         }
825         printd("File Open, About to open\n");
826         int ret = ufe(open,PADDR(fn),oflag,mode,0);
827         printd("File Open, res=%d\n", ret);
828         user_memdup_free(p,fn);
829         return ret;
830 }
831 intreg_t sys_close(struct proc* p, int fd)
832 {
833         return ufe(close,fd,0,0,0);
834 }
835
836 #define NEWLIB_STAT_SIZE 64
837 intreg_t sys_fstat(struct proc* p, int fd, void* buf)
838 {
839         int *kbuf = kmalloc(NEWLIB_STAT_SIZE, 0);
840         int ret = ufe(fstat,fd,PADDR(kbuf),0,0);
841         if(ret != -1 && memcpy_to_user_errno(p,buf,kbuf,NEWLIB_STAT_SIZE))
842                 ret = -1;
843         kfree(kbuf);
844         return ret;
845 }
846
847 intreg_t sys_stat(struct proc* p, const char* path, void* buf)
848 {
849         char* fn = user_strdup_errno(p,path,PGSIZE);
850         if(fn == NULL)
851                 return -1;
852
853         int *kbuf = kmalloc(NEWLIB_STAT_SIZE, 0);
854         int ret = ufe(stat,PADDR(fn),PADDR(kbuf),0,0);
855         if(ret != -1 && memcpy_to_user_errno(p,buf,kbuf,NEWLIB_STAT_SIZE))
856                 ret = -1;
857
858         user_memdup_free(p,fn);
859         kfree(kbuf);
860         return ret;
861 }
862
863 intreg_t sys_lstat(struct proc* p, const char* path, void* buf)
864 {
865         char* fn = user_strdup_errno(p,path,PGSIZE);
866         if(fn == NULL)
867                 return -1;
868
869         int *kbuf = kmalloc(NEWLIB_STAT_SIZE, 0);
870         int ret = ufe(lstat,PADDR(fn),PADDR(kbuf),0,0);
871         if(ret != -1 && memcpy_to_user_errno(p,buf,kbuf,NEWLIB_STAT_SIZE))
872                 ret = -1;
873
874         user_memdup_free(p,fn);
875         kfree(kbuf);
876         return ret;
877 }
878
879 intreg_t sys_fcntl(struct proc* p, int fd, int cmd, int arg)
880 {
881         return ufe(fcntl,fd,cmd,arg,0);
882 }
883
884 intreg_t sys_access(struct proc* p, const char* path, int type)
885 {
886         char* fn = user_strdup_errno(p,path,PGSIZE);
887         if(fn == NULL)
888                 return -1;
889         int ret = ufe(access,PADDR(fn),type,0,0);
890         user_memdup_free(p,fn);
891         return ret;
892 }
893
894 intreg_t sys_umask(struct proc* p, int mask)
895 {
896         return ufe(umask,mask,0,0,0);
897 }
898
899 intreg_t sys_chmod(struct proc* p, const char* path, int mode)
900 {
901         char* fn = user_strdup_errno(p,path,PGSIZE);
902         if(fn == NULL)
903                 return -1;
904         int ret = ufe(chmod,PADDR(fn),mode,0,0);
905         user_memdup_free(p,fn);
906         return ret;
907 }
908
909 intreg_t sys_lseek(struct proc* p, int fd, int offset, int whence)
910 {
911         return ufe(lseek,fd,offset,whence,0);
912 }
913
914 intreg_t sys_link(struct proc* p, const char* _old, const char* _new)
915 {
916         char* oldpath = user_strdup_errno(p,_old,PGSIZE);
917         if(oldpath == NULL)
918                 return -1;
919
920         char* newpath = user_strdup_errno(p,_new,PGSIZE);
921         if(newpath == NULL)
922         {
923                 user_memdup_free(p,oldpath);
924                 return -1;
925         }
926
927         int ret = ufe(link,PADDR(oldpath),PADDR(newpath),0,0);
928         user_memdup_free(p,oldpath);
929         user_memdup_free(p,newpath);
930         return ret;
931 }
932
933 intreg_t sys_unlink(struct proc* p, const char* path)
934 {
935         char* fn = user_strdup_errno(p,path,PGSIZE);
936         if(fn == NULL)
937                 return -1;
938         int ret = ufe(unlink,PADDR(fn),0,0,0);
939         user_memdup_free(p,fn);
940         return ret;
941 }
942
943 intreg_t sys_chdir(struct proc* p, const char* path)
944 {
945         char* fn = user_strdup_errno(p,path,PGSIZE);
946         if(fn == NULL)
947                 return -1;
948         int ret = ufe(chdir,PADDR(fn),0,0,0);
949         user_memdup_free(p,fn);
950         return ret;
951 }
952
953 intreg_t sys_getcwd(struct proc* p, char* pwd, int size)
954 {
955         void* kbuf = kmalloc_errno(size);
956         if(kbuf == NULL)
957                 return -1;
958         int ret = ufe(read,PADDR(kbuf),size,0,0);
959         if(ret != -1 && memcpy_to_user_errno(p,pwd,kbuf,strnlen(kbuf,size)))
960                 ret = -1;
961         user_memdup_free(p,kbuf);
962         return ret;
963 }
964
965 intreg_t sys_gettimeofday(struct proc* p, int* buf)
966 {
967         static spinlock_t gtod_lock = SPINLOCK_INITIALIZER;
968         static int t0 = 0;
969
970         spin_lock(&gtod_lock);
971         if(t0 == 0)
972 #ifdef __CONFIG_APPSERVER__
973                 t0 = ufe(time,0,0,0,0);
974 #else
975                 // Nanwan's birthday, bitches!!
976                 t0 = 1242129600;
977 #endif 
978         spin_unlock(&gtod_lock);
979
980         long long dt = read_tsc();
981         int kbuf[2] = {t0+dt/system_timing.tsc_freq,
982             (dt%system_timing.tsc_freq)*1000000/system_timing.tsc_freq};
983
984         return memcpy_to_user_errno(p,buf,kbuf,sizeof(kbuf));
985 }
986
987 #define SIZEOF_STRUCT_TERMIOS 60
988 intreg_t sys_tcgetattr(struct proc* p, int fd, void* termios_p)
989 {
990         int* kbuf = kmalloc(SIZEOF_STRUCT_TERMIOS,0);
991         int ret = ufe(tcgetattr,fd,PADDR(kbuf),0,0);
992         if(ret != -1 && memcpy_to_user_errno(p,termios_p,kbuf,SIZEOF_STRUCT_TERMIOS))
993                 ret = -1;
994         kfree(kbuf);
995         return ret;
996 }
997
998 intreg_t sys_tcsetattr(struct proc* p, int fd, int optional_actions, const void* termios_p)
999 {
1000         void* kbuf = user_memdup_errno(p,termios_p,SIZEOF_STRUCT_TERMIOS);
1001         if(kbuf == NULL)
1002                 return -1;
1003         int ret = ufe(tcsetattr,fd,optional_actions,PADDR(kbuf),0);
1004         user_memdup_free(p,kbuf);
1005         return ret;
1006 }
1007 /************** Syscall Invokation **************/
1008
1009 /* Executes the given syscall.
1010  *
1011  * Note tf is passed in, which points to the tf of the context on the kernel
1012  * stack.  If any syscall needs to block, it needs to save this info, as well as
1013  * any silly state.
1014  *
1015  * TODO: Build a dispatch table instead of switching on the syscallno
1016  * Dispatches to the correct kernel function, passing the arguments.
1017  */
1018 intreg_t syscall(struct proc *p, uintreg_t syscallno, uintreg_t a1,
1019                  uintreg_t a2, uintreg_t a3, uintreg_t a4, uintreg_t a5)
1020 {
1021         // Initialize the return value and error code returned to 0
1022         proc_set_syscall_retval(current_tf, 0);
1023         set_errno(current_tf,0);
1024
1025         typedef intreg_t (*syscall_t)(struct proc*,uintreg_t,uintreg_t,
1026                                       uintreg_t,uintreg_t,uintreg_t);
1027
1028         const static syscall_t syscall_table[] = {
1029                 [SYS_null] = (syscall_t)sys_null,
1030                 [SYS_cache_buster] = (syscall_t)sys_cache_buster,
1031                 [SYS_cache_invalidate] = (syscall_t)sys_cache_invalidate,
1032                 [SYS_reboot] = (syscall_t)reboot,
1033                 [SYS_cputs] = (syscall_t)sys_cputs,
1034                 [SYS_cgetc] = (syscall_t)sys_cgetc,
1035                 [SYS_getcpuid] = (syscall_t)sys_getcpuid,
1036                 [SYS_getvcoreid] = (syscall_t)sys_getvcoreid,
1037                 [SYS_getpid] = (syscall_t)sys_getpid,
1038                 [SYS_proc_create] = (syscall_t)sys_proc_create,
1039                 [SYS_proc_run] = (syscall_t)sys_proc_run,
1040                 [SYS_proc_destroy] = (syscall_t)sys_proc_destroy,
1041                 [SYS_yield] = (syscall_t)sys_proc_yield,
1042                 [SYS_run_binary] = (syscall_t)sys_run_binary,
1043                 [SYS_fork] = (syscall_t)sys_fork,
1044                 [SYS_exec] = (syscall_t)sys_exec,
1045                 [SYS_trywait] = (syscall_t)sys_trywait,
1046                 [SYS_mmap] = (syscall_t)sys_mmap,
1047                 [SYS_munmap] = (syscall_t)sys_munmap,
1048                 [SYS_mprotect] = (syscall_t)sys_mprotect,
1049                 [SYS_brk] = (syscall_t)sys_brk,
1050                 [SYS_shared_page_alloc] = (syscall_t)sys_shared_page_alloc,
1051                 [SYS_shared_page_free] = (syscall_t)sys_shared_page_free,
1052                 [SYS_resource_req] = (syscall_t)resource_req,
1053                 [SYS_notify] = (syscall_t)sys_notify,
1054                 [SYS_self_notify] = (syscall_t)sys_self_notify,
1055         #ifdef __CONFIG_SERIAL_IO__
1056                 [SYS_serial_read] = (syscall_t)sys_serial_read,
1057                 [SYS_serial_write] = (syscall_t)sys_serial_write,
1058         #endif
1059         #ifdef __CONFIG_NETWORKING__
1060                 [SYS_eth_read] = (syscall_t)sys_eth_read,
1061                 [SYS_eth_write] = (syscall_t)sys_eth_write,
1062                 [SYS_eth_get_mac_addr] = (syscall_t)sys_eth_get_mac_addr,
1063                 [SYS_eth_recv_check] = (syscall_t)sys_eth_recv_check,
1064         #endif
1065                 // Syscalls serviced by the appserver for now.
1066                 [SYS_read] = (syscall_t)sys_read,
1067                 [SYS_write] = (syscall_t)sys_write,
1068                 [SYS_open] = (syscall_t)sys_open,
1069                 [SYS_close] = (syscall_t)sys_close,
1070                 [SYS_fstat] = (syscall_t)sys_fstat,
1071                 [SYS_stat] = (syscall_t)sys_stat,
1072                 [SYS_lstat] = (syscall_t)sys_lstat,
1073                 [SYS_fcntl] = (syscall_t)sys_fcntl,
1074                 [SYS_access] = (syscall_t)sys_access,
1075                 [SYS_umask] = (syscall_t)sys_umask,
1076                 [SYS_chmod] = (syscall_t)sys_chmod,
1077                 [SYS_lseek] = (syscall_t)sys_lseek,
1078                 [SYS_link] = (syscall_t)sys_link,
1079                 [SYS_unlink] = (syscall_t)sys_unlink,
1080                 [SYS_chdir] = (syscall_t)sys_chdir,
1081                 [SYS_getcwd] = (syscall_t)sys_getcwd,
1082                 [SYS_gettimeofday] = (syscall_t)sys_gettimeofday,
1083                 [SYS_tcgetattr] = (syscall_t)sys_tcgetattr,
1084                 [SYS_tcsetattr] = (syscall_t)sys_tcsetattr
1085         };
1086
1087         const int max_syscall = sizeof(syscall_table)/sizeof(syscall_table[0]);
1088
1089         //printk("Incoming syscall on core: %d number: %d\n    a1: %x\n   "
1090         //       " a2: %x\n    a3: %x\n    a4: %x\n    a5: %x\n", core_id(),
1091         //       syscallno, a1, a2, a3, a4, a5);
1092
1093         if(syscallno > max_syscall || syscall_table[syscallno] == NULL)
1094                 panic("Invalid syscall number %d for proc %x!", syscallno, *p);
1095
1096         return syscall_table[syscallno](p,a1,a2,a3,a4,a5);
1097 }
1098
1099 intreg_t syscall_async(struct proc *p, syscall_req_t *call)
1100 {
1101         return syscall(p, call->num, call->args[0], call->args[1],
1102                        call->args[2], call->args[3], call->args[4]);
1103 }
1104
1105 /* You should already have a refcnt'd ref to p before calling this */
1106 intreg_t process_generic_syscalls(struct proc *p, size_t max)
1107 {
1108         size_t count = 0;
1109         syscall_back_ring_t* sysbr = &p->syscallbackring;
1110
1111         /* make sure the proc is still alive, and keep it from dying from under us
1112          * incref will return ESUCCESS on success.  This might need some thought
1113          * regarding when the incref should have happened (like by whoever passed us
1114          * the *p). */
1115         // TODO: ought to be unnecessary, if you called this right, kept here for
1116         // now in case anyone actually uses the ARSCs.
1117         proc_incref(p, 1);
1118
1119         // max is the most we'll process.  max = 0 means do as many as possible
1120         while (RING_HAS_UNCONSUMED_REQUESTS(sysbr) && ((!max)||(count < max)) ) {
1121                 if (!count) {
1122                         // ASSUME: one queue per process
1123                         // only switch cr3 for the very first request for this queue
1124                         // need to switch to the right context, so we can handle the user pointer
1125                         // that points to a data payload of the syscall
1126                         lcr3(p->env_cr3);
1127                 }
1128                 count++;
1129                 //printk("DEBUG PRE: sring->req_prod: %d, sring->rsp_prod: %d\n",
1130                 //         sysbr->sring->req_prod, sysbr->sring->rsp_prod);
1131                 // might want to think about 0-ing this out, if we aren't
1132                 // going to explicitly fill in all fields
1133                 syscall_rsp_t rsp;
1134                 // this assumes we get our answer immediately for the syscall.
1135                 syscall_req_t* req = RING_GET_REQUEST(sysbr, ++(sysbr->req_cons));
1136                 rsp.retval = syscall_async(p, req);
1137                 // write response into the slot it came from
1138                 memcpy(req, &rsp, sizeof(syscall_rsp_t));
1139                 // update our counter for what we've produced (assumes we went in order!)
1140                 (sysbr->rsp_prod_pvt)++;
1141                 RING_PUSH_RESPONSES(sysbr);
1142                 //printk("DEBUG POST: sring->req_prod: %d, sring->rsp_prod: %d\n",
1143                 //         sysbr->sring->req_prod, sysbr->sring->rsp_prod);
1144         }
1145         // load sane page tables (and don't rely on decref to do it for you).
1146         lcr3(boot_cr3);
1147         proc_decref(p, 1);
1148         return (intreg_t)count;
1149 }
1150