8186aab73569beb0f4963f20bc174f65181a5b18
[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 #include <uthread.h>
22
23 void *core0_tls = 0;
24 void *in_buf, *out_buf;
25
26 void ghetto_vcore_entry(void);
27 struct schedule_ops ghetto_sched_ops = {
28         0, /* init, */
29         ghetto_vcore_entry,
30         0, /* thread_create, */
31         0, /* thread_runnable, */
32         0, /* thread_yield, */
33         0, /* thread_exit, */
34         0, /* preempt_pending, */
35         0, /* spawn_thread, */
36 };
37 struct schedule_ops *sched_ops = &ghetto_sched_ops;
38 /* Test program for the audio device.  mmap()s the stuff, sets up a notif
39  * handler, and switches to multi_mode.
40  *
41  * Note: this has a lot of mhello-like MCP infrastructure.  When Lithe is
42  * working, you won't need any of this.  Just the mmap stuff and the notif
43  * handler.  Stuff specific to the ethernet audio device is marked ETH_AUD. */
44 int main() 
45
46         int retval;
47         int in_fd, out_fd;
48         /* ETHAUD mmap the input and output buffers */
49         in_fd = open("/dev/eth_audio_in", O_RDONLY);
50         out_fd = open("/dev/eth_audio_out", O_RDWR);
51         assert(in_fd != -1);
52         assert(out_fd != -1);
53         in_buf = mmap(0, PGSIZE, PROT_READ, 0, in_fd, 0);
54         if (in_buf == MAP_FAILED) {
55                 int err = errno;
56                 perror("Can't mmap the input buf:");
57         }
58         out_buf = mmap(0, PGSIZE, PROT_READ | PROT_WRITE, MAP_POPULATE, out_fd, 0);
59         if (out_buf == MAP_FAILED) {
60                 int err = errno;
61                 perror("Can't mmap the output buf:");
62         }
63         //strncpy(out_buf, "Nanwan loves you!\n", 19);
64
65 /* begin: stuff userspace needs to do before switching to multi-mode */
66         if (vcore_init())
67                 printf("vcore_init() failed, we're fucked!\n");
68
69         /* ETHAUD Turn on Free apple pie (which is the network packet) */
70         enable_kevent(EV_FREE_APPLE_PIE, 0, EVENT_IPI);
71
72         /* Need to save this somewhere that you can find it again when restarting
73          * core0 */
74         core0_tls = get_tls_desc(0);
75         /* Need to save our floating point state somewhere (like in the
76          * user_thread_tcb so it can be restarted too */
77
78         /* don't forget to enable notifs on vcore0 at some point */
79         struct preempt_data *vcpd;
80         vcpd = &__procdata.vcore_preempt_data[0];
81         vcpd->notif_enabled = TRUE;
82         
83 /* end: stuff userspace needs to do before switching to multi-mode */
84         /* ETHAUD */
85         /* Switch into _M mode */
86         retval = vcore_request(1);
87
88         /* Stay alive for a minute (will take interrupts) */
89         udelay(60000000);
90
91         printf("Eth aud, finishing up!\n");
92         /* Need to do unmap it, due to some limitations in the kernel */
93         munmap(in_buf, PGSIZE);
94         munmap(out_buf, PGSIZE);
95         close(in_fd);
96         close(out_fd);
97 }
98
99 /* ETHAUD, with some debugging commands... */
100 void process_packet(void)
101 {
102         //printf("Received a packet!\n");
103         //memset(out_buf, 0, PGSIZE);
104         memcpy(out_buf, in_buf, 1280);  /* size of the payload. */
105         memset(out_buf + 1280, 0, 4);   /* 4 bytes of control info. */
106         //printf("contents of out_buf %s\n", out_buf);
107 }
108
109 void ghetto_vcore_entry(void)
110 {
111         uint32_t vcoreid = vcore_id();
112         static bool first_time = TRUE;
113
114         printf("GIANT WARNING: this is ancient shit\n");
115 /* begin: stuff userspace needs to do to handle events/notifications */
116
117         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
118         struct preempt_data *vcpd;
119         vcpd = &__procdata.vcore_preempt_data[vcoreid];
120         
121         /* Ghetto way to get just an event number */
122         unsigned int ev_type = get_event_type(&vcpd->ev_mbox);
123
124         /* ETHAUD app: process the packet if we got a notif */
125         if (ev_type == EV_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                 clear_notif_pending(vcoreid);
139                 set_tls_desc(core0_tls, 0);
140                 /* Load silly state (Floating point) too */
141                 pop_ros_tf(&vcpd->notif_tf, vcoreid);
142                 printf("should never see me!");
143         }       
144         /* unmask notifications once you can let go of the notif_tf and it is okay
145          * to clobber the transition stack.
146          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
147          * popping the tf of whatever user process you want (get off the x-stack) */
148         vcpd->notif_enabled = TRUE;
149         
150 /* end: stuff userspace needs to do to handle notifications */
151         /* The other vcores will hit here. */
152         while (1)
153                 cpu_relax();
154 }