Userspace saving/restoring of TLS
[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 <stdio.h>
9 #include <hart.h>
10 #include <timing.h>
11 #include <rassert.h>
12
13 hart_barrier_t b;
14
15 __thread int temp;
16 void *core0_tls = 0;
17
18 int main(int argc, char** argv)
19 {
20         uint32_t vcoreid;
21         int retval;
22
23         hart_barrier_init(&b,hart_max_harts()-1);
24
25 /* begin: stuff userspace needs to do before switching to multi-mode */
26         if (hart_init())
27                 printf("Harts failed, we're fucked!\n");
28
29         /* tell the kernel where and how we want to receive notifications */
30         struct notif_method *nm;
31         for (int i = 1; i < MAX_NR_NOTIF; i++) {
32                 nm = &__procdata.notif_methods[i];
33                 nm->flags |= NOTIF_WANTED | NOTIF_MSG | NOTIF_IPI;
34                 nm->vcoreid = i % 2; // vcore0 or 1, keepin' it fresh.
35         }
36
37         /* Need to save this somewhere that you can find it again when restarting
38          * core0 */
39         core0_tls = get_tls_desc(0);
40
41         /* don't forget to enable notifs on vcore0 at some point */
42         struct preempt_data *vcpd;
43         vcpd = &__procdata.vcore_preempt_data[0];
44         vcpd->notif_enabled = TRUE;
45         
46 /* end: stuff userspace needs to do before switching to multi-mode */
47
48         if ((vcoreid = hart_self())) {
49                 printf("Should never see me! (from vcore %d)\n", vcoreid);
50         } else { // core 0
51                 temp = 0xdeadbeef;
52                 printf("Hello from vcore %d with temp addr = %p and temp = %p\n",
53                        vcoreid, &temp, temp);
54                 printf("Multi-Goodbye, world, from PID: %d!\n", sys_getpid());
55                 //retval = sys_resource_req(RES_CORES, 2, 0);
56                 //retval = hart_request(hart_max_harts()-2);
57                 retval = hart_request(2); // doesn't do what you think.  this gives 3.
58                 //debug("retval = %d\n", retval);
59         }
60
61 #if 0
62         /* test notifying my vcore2 */
63         udelay(5000000);
64         printf("Vcore 0 self-notifying vcore 2 with notif 4!\n");
65         struct notif_event ne;
66         ne.ne_type = 4;
67         sys_self_notify(2, 4, &ne);
68         udelay(5000000);
69         printf("Vcore 0 notifying itself with notif 3!\n");
70         ne.ne_type = 3;
71         sys_notify(sys_getpid(), 3, &ne);
72         udelay(1000000);
73 #endif
74
75         /* test loop for restarting a notif_tf */
76         if (vcoreid == 0) {
77                 int ctr = 0;
78                 while(1) {
79                         printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
80                         udelay(5000000);
81                 }
82         }
83
84         printf("Vcore %d Done!\n", vcoreid);
85         hart_barrier_wait(&b,hart_self());
86
87         printf("All Cores Done!\n", vcoreid);
88         while(1); // manually kill from the monitor
89         return 0;
90 }
91
92 void hart_entry(void)
93 {
94         uint32_t vcoreid = hart_self();
95
96         temp = 0xcafebabe;
97 /* begin: stuff userspace needs to do to handle notifications */
98
99         struct preempt_data *vcpd;
100         vcpd = &__procdata.vcore_preempt_data[vcoreid];
101         
102         /* here is how you receive a notif_event */
103         struct notif_event ne = {0};
104         bcq_dequeue(&vcpd->notif_evts, &ne, NR_PERCORE_EVENTS);
105         printf("the queue is on vcore %d and has a ne with type %d\n", vcoreid,
106                ne.ne_type);
107         /* it might be in bitmask form too: */
108         //printf("and the bitmask looks like: ");
109         //PRINT_BITMASK(__procdata.vcore_preempt_data[vcoreid].notif_bmask, MAX_NR_NOTIF);
110         /* can see how many messages had to be sent as bits */
111         printf("Number of event overflows: %d\n", vcpd->event_overflows);
112
113         /* Lets try to restart vcore0's context.  Note this doesn't do anything to
114          * set the appropriate TLS.  On x86, this will involve changing the LDT
115          * entry for this vcore to point to the TCB of the new user-thread. */
116         if (vcoreid == 0) {
117                 printf("restarting vcore0 from userspace\n");
118                 set_tls_desc(core0_tls, 0);
119                 pop_ros_tf(&vcpd->notif_tf, &vcpd->notif_enabled);
120                 panic("should never see me!");
121         }       
122         /* unmask notifications once you can let go of the notif_tf and it is okay
123          * to clobber the transition stack.
124          * Check Documentation/processes.txt: 4.2.4.  In real code, you should be
125          * popping the tf of whatever user process you want (get off the x-stack) */
126         vcpd->notif_enabled = TRUE;
127         
128 /* end: stuff userspace needs to do to handle notifications */
129
130         printf("Hello from hart_entry in vcore %d with temp addr %p and temp %p\n",
131                vcoreid, &temp, temp);
132         hart_barrier_wait(&b,hart_self());
133         while(1);
134 }