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