user/vmm: add and use a load_elf function
[akaros.git] / tests / old / eth_audio.c
1 #include <ros/resource.h>
2 #include <ros/procdata.h>
3 #include <ros/event.h>
4 #include <ros/bcq.h>
5 #include <parlib/parlib.h>
6 #include <parlib/vcore.h>
7
8 #include <stdio.h> 
9 #include <sys/types.h>
10 #include <sys/stat.h>
11 #include <fcntl.h>
12 #include <parlib/arch/arch.h>
13 #include <unistd.h>
14 #include <errno.h>
15 #include <stdlib.h>
16 #include <string.h>
17 #include <sys/mman.h>
18 #include <parlib/timing.h>
19 #include <assert.h>
20 #include <parlib/event.h>
21 #include <parlib/uthread.h>
22
23 void *core0_tls = 0;
24 void *in_buf, *out_buf;
25
26 /* Test program for the audio device.  mmap()s the stuff, sets up a notif
27  * handler, and switches to multi_mode.
28  *
29  * Note: this has a lot of mhello-like MCP infrastructure.  When Lithe is
30  * working, you won't need any of this.  Just the mmap stuff and the notif
31  * handler.  Stuff specific to the ethernet audio device is marked ETH_AUD. */
32 int main() 
33
34         int retval;
35         int in_fd, out_fd;
36         /* ETHAUD mmap the input and output buffers */
37         in_fd = open("/dev/eth_audio_in", O_RDONLY);
38         out_fd = open("/dev/eth_audio_out", O_RDWR);
39         assert(in_fd != -1);
40         assert(out_fd != -1);
41         in_buf = mmap(0, PGSIZE, PROT_READ, 0, in_fd, 0);
42         if (in_buf == MAP_FAILED) {
43                 int err = errno;
44                 perror("Can't mmap the input buf:");
45         }
46         out_buf = mmap(0, PGSIZE, PROT_READ | PROT_WRITE, MAP_POPULATE, out_fd, 0);
47         if (out_buf == MAP_FAILED) {
48                 int err = errno;
49                 perror("Can't mmap the output buf:");
50         }
51         //strncpy(out_buf, "Nanwan loves you!\n", 19);
52
53 /* begin: stuff userspace needs to do before switching to multi-mode */
54         vcore_lib_init();
55
56         /* ETHAUD Turn on Free apple pie (which is the network packet) */
57         enable_kevent(EV_FREE_APPLE_PIE, 0, EVENT_IPI);
58
59         /* Need to save this somewhere that you can find it again when restarting
60          * core0 */
61         core0_tls = get_tls_desc();
62         /* Need to save our floating point state somewhere (like in the
63          * user_thread_tcb so it can be restarted too */
64
65 /* end: stuff userspace needs to do before switching to multi-mode */
66         /* ETHAUD */
67         /* Switch into _M mode */
68         vcore_request_total(1);
69
70         /* Stay alive for a minute (will take interrupts) */
71         udelay(60000000);
72
73         printf("Eth aud, finishing up!\n");
74         /* Need to do unmap it, due to some limitations in the kernel */
75         munmap(in_buf, PGSIZE);
76         munmap(out_buf, PGSIZE);
77         close(in_fd);
78         close(out_fd);
79 }
80
81 /* ETHAUD, with some debugging commands... */
82 void process_packet(void)
83 {
84         //printf("Received a packet!\n");
85         //memset(out_buf, 0, PGSIZE);
86         memcpy(out_buf, in_buf, 1280);  /* size of the payload. */
87         memset(out_buf + 1280, 0, 4);   /* 4 bytes of control info. */
88         //printf("contents of out_buf %s\n", out_buf);
89 }
90
91 void vcore_entry(void)
92 {
93         uint32_t vcoreid = vcore_id();
94         static bool first_time = TRUE;
95
96         printf("GIANT WARNING: this is ancient shit\n");
97 /* begin: stuff userspace needs to do to handle events/notifications */
98
99         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
100         struct preempt_data *vcpd;
101         vcpd = &__procdata.vcore_preempt_data[vcoreid];
102         
103         /* Ghetto way to get just an event number */
104         unsigned int ev_type = get_event_type(&vcpd->ev_mbox_public);
105
106         /* ETHAUD app: process the packet if we got a notif */
107         if (ev_type == EV_FREE_APPLE_PIE)
108                 process_packet();
109
110         if (vc->preempt_pending) {
111                 printf("Oh crap, vcore %d is being preempted!  Yielding\n", vcoreid);
112                 sys_yield(TRUE);
113                 printf("After yield on vcore %d. I wasn't being preempted.\n", vcoreid);
114         }
115                 
116         /* Lets try to restart vcore0's context.  Note this doesn't do anything to
117          * set the appropriate TLS.  On x86, this will involve changing the LDT
118          * entry for this vcore to point to the TCB of the new user-thread. */
119         if (vcoreid == 0) {
120                 handle_events(vcoreid);
121                 set_tls_desc(core0_tls);
122                 assert(__vcoreid == 0); /* in case anyone uses this */
123                 /* Load silly state (Floating point) too */
124                 pop_user_ctx(&vcpd->uthread_ctx, vcoreid);
125                 printf("should never see me!");
126         }       
127         /* unmask notifications once you can let go of the uthread_ctx and it is
128          * okay to clobber the transition stack.
129          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
130          * popping the tf of whatever user process you want (get off the x-stack) */
131         vcpd->notif_disabled = FALSE;
132         
133 /* end: stuff userspace needs to do to handle notifications */
134         /* The other vcores will hit here. */
135         while (1)
136                 cpu_relax();
137 }