Revamped event interfaces (XCC)
[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
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         /* ETHAUD Turn on Free apple pie (which is the network packet) */
56         struct event_queue *ev_q = malloc(sizeof(struct event_queue));
57         ev_q->ev_mbox = &__procdata.vcore_preempt_data[0].ev_mbox;
58         ev_q->ev_flags = EVENT_IPI;
59         ev_q->ev_vcore = 0;     
60         ev_q->ev_handler = 0;
61         __procdata.kernel_evts[EV_FREE_APPLE_PIE] = ev_q;
62
63         /* Need to save this somewhere that you can find it again when restarting
64          * core0 */
65         core0_tls = get_tls_desc(0);
66         /* Need to save our floating point state somewhere (like in the
67          * user_thread_tcb so it can be restarted too */
68
69         /* don't forget to enable notifs on vcore0 at some point */
70         struct preempt_data *vcpd;
71         vcpd = &__procdata.vcore_preempt_data[0];
72         vcpd->notif_enabled = TRUE;
73         
74 /* end: stuff userspace needs to do before switching to multi-mode */
75         /* ETHAUD */
76         /* Switch into _M mode */
77         retval = vcore_request(1);
78
79         /* Stay alive for a minute (will take interrupts) */
80         udelay(60000000);
81
82         printf("Eth aud, finishing up!\n");
83         /* Need to do unmap it, due to some limitations in the kernel */
84         munmap(in_buf, PGSIZE);
85         munmap(out_buf, PGSIZE);
86         close(in_fd);
87         close(out_fd);
88 }
89
90 /* ETHAUD, with some debugging commands... */
91 void process_packet(void)
92 {
93         //printf("Received a packet!\n");
94         //memset(out_buf, 0, PGSIZE);
95         memcpy(out_buf, in_buf, 1280);  /* size of the payload. */
96         memset(out_buf + 1280, 0, 4);   /* 4 bytes of control info. */
97         //printf("contents of out_buf %s\n", out_buf);
98 }
99
100 void vcore_entry(void)
101 {
102         uint32_t vcoreid = vcore_id();
103         static bool first_time = TRUE;
104
105 /* begin: stuff userspace needs to do to handle events/notifications */
106
107         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
108         struct preempt_data *vcpd;
109         vcpd = &__procdata.vcore_preempt_data[vcoreid];
110         
111         /* here is how you receive an event message (ought to check overflow) */
112         struct event_msg ev_msg = {0};
113         bcq_dequeue(&vcpd->ev_mbox.ev_msgs, &ev_msg, NR_BCQ_EVENTS);
114
115         /* ETHAUD app: process the packet if we got a notif */
116         if (ev_msg.ev_type == EV_FREE_APPLE_PIE)
117                 process_packet();
118
119         if (vc->preempt_pending) {
120                 printf("Oh crap, vcore %d is being preempted!  Yielding\n", vcoreid);
121                 sys_yield(TRUE);
122                 printf("After yield on vcore %d. I wasn't being preempted.\n", vcoreid);
123         }
124                 
125         /* Lets try to restart vcore0's context.  Note this doesn't do anything to
126          * set the appropriate TLS.  On x86, this will involve changing the LDT
127          * entry for this vcore to point to the TCB of the new user-thread. */
128         if (vcoreid == 0) {
129                 vcpd->notif_pending = 0;
130                 /* Do one last check for notifs after clearing pending */
131                 set_tls_desc(core0_tls, 0);
132                 /* Load silly state (Floating point) too */
133                 pop_ros_tf(&vcpd->notif_tf, vcoreid);
134                 printf("should never see me!");
135         }       
136         /* unmask notifications once you can let go of the notif_tf and it is okay
137          * to clobber the transition stack.
138          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
139          * popping the tf of whatever user process you want (get off the x-stack) */
140         vcpd->notif_enabled = TRUE;
141         
142 /* end: stuff userspace needs to do to handle notifications */
143         /* The other vcores will hit here. */
144         while (1)
145                 cpu_relax();
146 }