Pthread fix to let the _S thread yield
[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/notification.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 mcs_barrier_t b;
15
16 __thread int temp;
17 void *core0_tls = 0;
18
19 int main(int argc, char** argv)
20 {
21         uint32_t vcoreid;
22         int retval;
23
24         mcs_barrier_init(&b, max_vcores());
25
26 /* begin: stuff userspace needs to do before switching to multi-mode */
27         if (vcore_init())
28                 printf("vcore_init() failed, we're fucked!\n");
29
30         /* tell the kernel where and how we want to receive notifications */
31         struct notif_method *nm;
32         for (int i = 0; i < MAX_NR_NOTIF; i++) {
33                 nm = &__procdata.notif_methods[i];
34                 nm->flags |= NOTIF_WANTED | NOTIF_MSG | NOTIF_IPI;
35                 nm->vcoreid = i % 2; // vcore0 or 1, keepin' it fresh.
36         }
37
38         /* Need to save this somewhere that you can find it again when restarting
39          * core0 */
40         core0_tls = get_tls_desc(0);
41         /* Need to save our floating point state somewhere (like in the
42          * user_thread_tcb so it can be restarted too */
43
44         /* don't forget to enable notifs on vcore0 at some point */
45         struct preempt_data *vcpd;
46         vcpd = &__procdata.vcore_preempt_data[0];
47         vcpd->notif_enabled = TRUE;
48         
49 /* end: stuff userspace needs to do before switching to multi-mode */
50
51         if ((vcoreid = vcore_id())) {
52                 printf("Should never see me! (from vcore %d)\n", vcoreid);
53         } else { // core 0
54                 temp = 0xdeadbeef;
55                 printf("Hello from vcore %d with temp addr = %p and temp = %p\n",
56                        vcoreid, &temp, temp);
57                 printf("Multi-Goodbye, world, from PID: %d!\n", sys_getpid());
58                 //retval = sys_resource_req(RES_CORES, 2, 0);
59                 printf("Requesting %d vcores\n",max_vcores());
60                 retval = vcore_request(max_vcores());
61                 //retval = vcore_request(3);
62                 printf("This is vcore0, right after vcore_request, retval=%d\n", retval);
63         }
64
65 #if 0
66         /* test notifying my vcore2 */
67         udelay(5000000);
68         printf("Vcore 0 self-notifying vcore 2 with notif 4!\n");
69         struct notif_event ne;
70         ne.ne_type = 4;
71         sys_self_notify(2, 4, &ne);
72         udelay(5000000);
73         printf("Vcore 0 notifying itself with notif 3!\n");
74         ne.ne_type = 3;
75         sys_notify(sys_getpid(), 3, &ne);
76         udelay(1000000);
77 #endif
78
79         /* test loop for restarting a notif_tf */
80         if (vcoreid == 0) {
81                 int ctr = 0;
82                 while(1) {
83                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
84                         udelay(5000000);
85                 }
86         }
87
88         printf("Vcore %d Done!\n", vcoreid);
89         mcs_barrier_wait(&b,vcore_id());
90
91         printf("All Cores Done!\n", vcoreid);
92         while(1); // manually kill from the monitor
93         return 0;
94 }
95
96 void vcore_entry(void)
97 {
98         uint32_t vcoreid = vcore_id();
99         static bool first_time = TRUE;
100
101         temp = 0xcafebabe;
102 /* begin: stuff userspace needs to do to handle notifications */
103
104         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
105         struct preempt_data *vcpd;
106         vcpd = &__procdata.vcore_preempt_data[vcoreid];
107         
108         /* here is how you receive a notif_event */
109         struct notif_event ne = {0};
110         bcq_dequeue(&vcpd->notif_evts, &ne, NR_PERCORE_EVENTS);
111         printf("the queue is on vcore %d and has a ne with type %d\n", vcoreid,
112                ne.ne_type);
113         /* it might be in bitmask form too: */
114         //printf("and the bitmask looks like: ");
115         //PRINT_BITMASK(__procdata.vcore_preempt_data[vcoreid].notif_bmask, MAX_NR_NOTIF);
116         /* can see how many messages had to be sent as bits */
117         printf("Number of event overflows: %d\n", vcpd->event_overflows);
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                 /* // test for preempting a notif_handler.  do it from the monitor
130                 int ctr = 0;
131                 while(ctr < 3) {
132                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
133                         udelay(5000000);
134                 } */
135                 printf("restarting vcore0 from userspace\n");
136                 vcpd->notif_pending = 0;
137                 /* Do one last check for notifs after clearing pending */
138                 /* // testing for missing a notif
139                 if (first_time) {
140                         first_time = FALSE;
141                         printf("setting pending, trying to renotify etc\n");
142                         vcpd->notif_pending = 1;
143                 } */
144                 set_tls_desc(core0_tls, 0);
145                 /* Load silly state (Floating point) too */
146                 pop_ros_tf(&vcpd->notif_tf, vcoreid);
147                 panic("should never see me!");
148         }       
149         /* unmask notifications once you can let go of the notif_tf and it is okay
150          * to clobber the transition stack.
151          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
152          * popping the tf of whatever user process you want (get off the x-stack) */
153         vcpd->notif_enabled = TRUE;
154         
155 /* end: stuff userspace needs to do to handle notifications */
156
157         printf("Hello from vcore_entry in vcore %d with temp addr %p and temp %p\n",
158                vcoreid, &temp, temp);
159         mcs_barrier_wait(&b,vcore_id());
160         while(1);
161 }