Fix for not having a cr3 loaded at all times
[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 #include <event.h>
14
15 #ifdef __sparc_v8__
16 # define udelay(x) udelay((x)/2000)
17 #endif
18
19 mcs_barrier_t b;
20
21 __thread int temp;
22 void *core0_tls = 0;
23
24 struct event_queue *indirect_q;
25 static void handle_generic(struct event_msg *ev_msg, bool overflow);
26
27 int main(int argc, char** argv)
28 {
29         uint32_t vcoreid;
30         int retval;
31
32         mcs_barrier_init(&b, max_vcores());
33
34         /* prep indirect ev_q.  Note we grab a big one */
35         indirect_q = get_big_event_q();
36         indirect_q->ev_flags = EVENT_IPI;
37         indirect_q->ev_vcore = 1;                       /* IPI core 1 */
38         indirect_q->ev_handler = 0;
39         printf("Registering %08p for event type %d\n", indirect_q,
40                EV_FREE_APPLE_PIE);
41         register_kevent_q(indirect_q, EV_FREE_APPLE_PIE);
42
43 /* begin: stuff userspace needs to do before switching to multi-mode */
44         /* handle events: just want to print out what we get.  This is just a
45          * quick set of handlers, not a registration for a kevent. */
46         for (int i = 0; i < MAX_NR_EVENT; i++)
47                 ev_handlers[i] = handle_generic;
48         /* Want to use the default ev_ev (which we just overwrote) */
49         ev_handlers[EV_EVENT] = handle_ev_ev;
50         /* vcore_init() done in vcore_request() now. */
51         /* Set up event reception.  For example, this will allow us to receive an
52          * event and IPI for USER_IPIs on vcore 0.  Check event.c for more stuff.
53          * Note you don't have to register for USER_IPIs to receive ones you send
54          * yourself with sys_self_notify(). */
55         enable_kevent(EV_USER_IPI, 0, TRUE);
56
57         /* Need to save this somewhere that you can find it again when restarting
58          * core0 */
59         core0_tls = get_tls_desc(0);
60         /* Need to save our floating point state somewhere (like in the
61          * user_thread_tcb so it can be restarted too */
62
63         /* don't forget to enable notifs on vcore0 at some point */
64         enable_notifs(0);
65         
66 /* end: stuff userspace needs to do before switching to multi-mode */
67
68         if ((vcoreid = vcore_id())) {
69                 printf("Should never see me! (from vcore %d)\n", vcoreid);
70         } else { // core 0
71                 temp = 0xdeadbeef;
72                 printf("Hello from vcore %d with temp addr = %p and temp = %p\n",
73                        vcoreid, &temp, temp);
74                 printf("Multi-Goodbye, world, from PID: %d!\n", sys_getpid());
75                 //retval = sys_resource_req(RES_CORES, 2, 0);
76                 printf("Requesting %d vcores\n",max_vcores());
77                 retval = vcore_request(max_vcores());
78                 //retval = vcore_request(5);
79                 printf("This is vcore0, right after vcore_request, retval=%d\n", retval);
80         }
81
82         /* test notifying my vcore2 */
83         udelay(5000000);
84         printf("Vcore 0 self-notifying vcore 2 with notif 4!\n");
85         struct event_msg msg;
86         msg.ev_type = 4;
87         sys_self_notify(2, 4, &msg);
88         udelay(5000000);
89         printf("Vcore 0 notifying itself with notif 3!\n");
90         msg.ev_type = 3;
91         sys_notify(sys_getpid(), 3, &msg);
92         udelay(1000000);
93
94         /* test loop for restarting a notif_tf */
95         if (vcoreid == 0) {
96                 int ctr = 0;
97                 while(1) {
98                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
99                         udelay(5000000);
100                         //exit(0);
101                 }
102         }
103
104         printf("Vcore %d Done!\n", vcoreid);
105         //mcs_barrier_wait(&b,vcore_id());
106
107         printf("All Cores Done!\n", vcoreid);
108         while(1); // manually kill from the monitor
109         return 0;
110 }
111
112 static void handle_generic(struct event_msg *ev_msg, bool overflow)
113 {
114         printf("Got event type %d on vcore %d, with%s overflow\n", ev_msg->ev_type,
115                vcore_id(), overflow ? "" : "out");
116 }
117
118 void vcore_entry(void)
119 {
120         uint32_t vcoreid = vcore_id();
121         static bool first_time = TRUE;
122
123         temp = 0xcafebabe;
124 /* begin: stuff userspace needs to do to handle notifications */
125
126         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
127         struct preempt_data *vcpd;
128         vcpd = &__procdata.vcore_preempt_data[vcoreid];
129         
130         /* here is how you receive an event */
131         handle_events(vcoreid);
132
133         /* how we tell a preemption is pending (regardless of notif/events) */
134         if (vc->preempt_pending) {
135                 printf("Oh crap, vcore %d is being preempted!  Yielding\n", vcoreid);
136                 sys_yield(TRUE);
137                 printf("After yield on vcore %d. I wasn't being preempted.\n", vcoreid);
138         }
139                 
140         /* Lets try to restart vcore0's context.  Note this doesn't do anything to
141          * set the appropriate TLS.  On x86, this will involve changing the LDT
142          * entry for this vcore to point to the TCB of the new user-thread. */
143         if (vcoreid == 0) {
144                 /* // test for preempting a notif_handler.  do it from the monitor
145                 int ctr = 0;
146                 while(ctr < 3) {
147                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
148                         udelay(5000000);
149                 } */
150                 printf("restarting vcore0 from userspace\n");
151                 vcpd->notif_pending = 0;
152                 /* Do one last check for notifs after clearing pending */
153                 /* // testing for missing a notif
154                 if (first_time) {
155                         first_time = FALSE;
156                         printf("setting pending, trying to renotify etc\n");
157                         vcpd->notif_pending = 1;
158                 } */
159                 set_tls_desc(core0_tls, 0);
160                 /* Load silly state (Floating point) too */
161                 pop_ros_tf(&vcpd->notif_tf, vcoreid);
162                 panic("should never see me!");
163         }       
164         /* unmask notifications once you can let go of the notif_tf and it is okay
165          * to clobber the transition stack.
166          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
167          * popping the tf of whatever user process you want (get off the x-stack) */
168         enable_notifs(vcoreid);
169         
170 /* end: stuff userspace needs to do to handle notifications */
171
172         printf("Hello from vcore_entry in vcore %d with temp addr %p and temp %p\n",
173                vcoreid, &temp, temp);
174         vcore_request(1);
175         //mcs_barrier_wait(&b,vcore_id());
176         udelay(vcoreid * 10000000);
177         //exit(0);
178         while(1);
179 }