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