765a7bf1e44b4c1979b4cef1d1e1862cf3ca5020
[akaros.git] / tests / mhello.c
1 #include <parlib.h>
2 #include <ros/mman.h>
3 #include <ros/resource.h>
4 #include <ros/procdata.h>
5 #include <ros/event.h>
6 #include <ros/bcq.h>
7 #include <arch/arch.h>
8 #include <rstdio.h>
9 #include <vcore.h>
10 #include <mcs.h>
11 #include <timing.h>
12 #include <rassert.h>
13
14 #ifdef __sparc_v8__
15 # define udelay(x) udelay((x)/2000)
16 #endif
17
18 mcs_barrier_t b;
19
20 __thread int temp;
21 void *core0_tls = 0;
22
23 struct event_queue_big *indirect_q;
24
25 int main(int argc, char** argv)
26 {
27         uint32_t vcoreid;
28         int retval;
29
30         mcs_barrier_init(&b, max_vcores());
31
32         /* prep indirect ev_q (TODO PIN).  Note we grab a big one */
33         indirect_q = malloc(sizeof(struct event_queue_big));
34         indirect_q->ev_mbox = &indirect_q->ev_imbox;
35         indirect_q->ev_flags = EVENT_IPI;
36         indirect_q->ev_vcore = 1;                       /* IPI core 1 */
37         indirect_q->ev_handler = 0;
38         printf("Registering %08p for event type %d\n", indirect_q,
39                EV_FREE_APPLE_PIE);
40         __procdata.kernel_evts[EV_FREE_APPLE_PIE] = (struct event_queue*)indirect_q;
41
42 /* begin: stuff userspace needs to do before switching to multi-mode */
43         if (vcore_init())
44                 printf("vcore_init() failed, we're fucked!\n");
45
46         /* Tell the kernel where and how we want to receive events.  This is just an
47          * example of what to do to have a notification turned on.  We're turning on
48          * USER_IPIs, posting events to vcore 0's vcpd, and telling the kernel to
49          * send to vcore 0.
50          * TODO: (PIN) this ev_q needs to be pinned */
51         struct event_queue *ev_q = malloc(sizeof(struct event_queue));
52         ev_q->ev_mbox = &__procdata.vcore_preempt_data[0].ev_mbox;
53         ev_q->ev_flags = EVENT_IPI;     /* we want an IPI */
54         ev_q->ev_vcore = 0;                     /* IPI core 0 */
55         ev_q->ev_handler = 0;
56         /* Now tell the kernel about it */
57         __procdata.kernel_evts[EV_USER_IPI] = ev_q;
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
72         if ((vcoreid = vcore_id())) {
73                 printf("Should never see me! (from vcore %d)\n", vcoreid);
74         } else { // core 0
75                 temp = 0xdeadbeef;
76                 printf("Hello from vcore %d with temp addr = %p and temp = %p\n",
77                        vcoreid, &temp, temp);
78                 printf("Multi-Goodbye, world, from PID: %d!\n", sys_getpid());
79                 //retval = sys_resource_req(RES_CORES, 2, 0);
80                 printf("Requesting %d vcores\n",max_vcores());
81                 retval = vcore_request(max_vcores());
82                 //retval = vcore_request(5);
83                 printf("This is vcore0, right after vcore_request, retval=%d\n", retval);
84         }
85
86         /* test notifying my vcore2 */
87         udelay(5000000);
88         printf("Vcore 0 self-notifying vcore 2 with notif 4!\n");
89         struct event_msg msg;
90         msg.ev_type = 4;
91         sys_self_notify(2, 4, &msg);
92         udelay(5000000);
93         printf("Vcore 0 notifying itself with notif 3!\n");
94         msg.ev_type = 3;
95         sys_notify(sys_getpid(), 3, &msg);
96         udelay(1000000);
97
98         /* test loop for restarting a notif_tf */
99         if (vcoreid == 0) {
100                 int ctr = 0;
101                 while(1) {
102                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
103                         udelay(5000000);
104                         //exit(0);
105                 }
106         }
107
108         printf("Vcore %d Done!\n", vcoreid);
109         //mcs_barrier_wait(&b,vcore_id());
110
111         printf("All Cores Done!\n", vcoreid);
112         while(1); // manually kill from the monitor
113         return 0;
114 }
115
116 void vcore_entry(void)
117 {
118         uint32_t vcoreid = vcore_id();
119         static bool first_time = TRUE;
120
121         temp = 0xcafebabe;
122 /* begin: stuff userspace needs to do to handle notifications */
123
124         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
125         struct preempt_data *vcpd;
126         vcpd = &__procdata.vcore_preempt_data[vcoreid];
127         
128         /* here is how you receive an event (ought to check for overflow, etc) */
129         struct event_msg ev_msg = {0};
130         bcq_dequeue(&vcpd->ev_mbox.ev_msgs, &ev_msg, NR_BCQ_EVENTS);
131         printf("the queue is on vcore %d and has a ne with type %d\n", vcoreid,
132                ev_msg.ev_type);
133         /* it might be in bitmask form too: */
134         //printf("and the bitmask looks like: ");
135         //PRINT_BITMASK(__procdata.vcore_preempt_data[vcoreid].notif_bmask, MAX_NR_NOTIF);
136         /* can see how many messages had to be sent as bits */
137         printf("Number of event overflows: %d\n", vcpd->ev_mbox.ev_overflows);
138
139         /* How we handle indirection events: */
140         struct event_queue_big *ev_q;
141         struct event_msg indir_msg = {0};
142         if (ev_msg.ev_type == EV_EVENT) {
143                 ev_q = ev_msg.ev_arg3;  /* convention */
144                 printf("Detected EV_EVENT, ev_q is %08p (%08p)\n", ev_q, indirect_q);
145                 bcq_dequeue(&ev_q->ev_mbox->ev_msgs, &indir_msg, NR_BCQ_EVENTS);
146                 printf("Message of type: %d (%d)\n", indir_msg.ev_type,
147                        EV_FREE_APPLE_PIE);
148         }
149         /* how we tell a preemption is pending (regardless of notif/events) */
150         if (vc->preempt_pending) {
151                 printf("Oh crap, vcore %d is being preempted!  Yielding\n", vcoreid);
152                 sys_yield(TRUE);
153                 printf("After yield on vcore %d. I wasn't being preempted.\n", vcoreid);
154         }
155                 
156         /* Lets try to restart vcore0's context.  Note this doesn't do anything to
157          * set the appropriate TLS.  On x86, this will involve changing the LDT
158          * entry for this vcore to point to the TCB of the new user-thread. */
159         if (vcoreid == 0) {
160                 /* // test for preempting a notif_handler.  do it from the monitor
161                 int ctr = 0;
162                 while(ctr < 3) {
163                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
164                         udelay(5000000);
165                 } */
166                 printf("restarting vcore0 from userspace\n");
167                 vcpd->notif_pending = 0;
168                 /* Do one last check for notifs after clearing pending */
169                 /* // testing for missing a notif
170                 if (first_time) {
171                         first_time = FALSE;
172                         printf("setting pending, trying to renotify etc\n");
173                         vcpd->notif_pending = 1;
174                 } */
175                 set_tls_desc(core0_tls, 0);
176                 /* Load silly state (Floating point) too */
177                 pop_ros_tf(&vcpd->notif_tf, vcoreid);
178                 panic("should never see me!");
179         }       
180         /* unmask notifications once you can let go of the notif_tf and it is okay
181          * to clobber the transition stack.
182          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
183          * popping the tf of whatever user process you want (get off the x-stack) */
184         vcpd->notif_enabled = TRUE;
185         
186 /* end: stuff userspace needs to do to handle notifications */
187
188         printf("Hello from vcore_entry in vcore %d with temp addr %p and temp %p\n",
189                vcoreid, &temp, temp);
190         vcore_request(1);
191         //mcs_barrier_wait(&b,vcore_id());
192         udelay(vcoreid * 10000000);
193         //exit(0);
194         while(1);
195 }