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