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