UCQ debug code
[akaros.git] / tests / msr_get_singlecore.c
1 /* tests/msr_get_singlecore.c
2  *
3  * Like msr_get_cores.c, but it only gets one core. */
4
5
6 #include <parlib.h>
7 #include <ros/mman.h>
8 #include <ros/resource.h>
9 #include <ros/procdata.h>
10 #include <ros/bcq.h>
11 #include <arch/arch.h>
12 #include <stdio.h>
13 #include <vcore.h>
14 #include <mcs.h>
15 #include <timing.h>
16 #include <rassert.h>
17 #include <uthread.h>
18
19 #ifdef __sparc_v8__
20 # define udelay(x) udelay((x)/2000)
21 #endif
22
23 mcs_barrier_t b;
24
25 void *core0_tls = 0;
26 uint64_t begin = 0, end = 0;
27 volatile bool core1_up = FALSE;
28
29 int main(int argc, char** argv)
30 {
31         uint32_t vcoreid = vcore_id();
32         int retval = 0;
33
34         mcs_barrier_init(&b, max_vcores());
35
36 /* begin: stuff userspace needs to do before switching to multi-mode */
37         if (vcore_init())
38                 printf("vcore_init() failed, we're fucked!\n");
39         #if 0
40         /* tell the kernel where and how we want to receive notifications */
41         struct notif_method *nm;
42         for (int i = 0; i < MAX_NR_NOTIF; i++) {
43                 nm = &__procdata.notif_methods[i];
44                 nm->flags |= NOTIF_WANTED | NOTIF_MSG | NOTIF_IPI;
45                 nm->vcoreid = i % 2; // vcore0 or 1, keepin' it fresh.
46         }
47         #endif
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 /* end: stuff userspace needs to do before switching to multi-mode */
54
55         /* get into multi mode */
56         retval = vcore_request(1);
57         if (retval)
58                 printf("Fucked!\n");
59
60         printf("Proc %d requesting another vcore\n", getpid());
61         begin = read_tsc();
62         retval = vcore_request(1);
63         if (retval)
64                 printf("Fucked!\n");
65         while (!core1_up)
66                 cpu_relax;
67         end = read_tsc();
68         printf("Took %llu usec (%llu nsec) to receive 1 core (cold).\n",
69                udiff(begin, end), ndiff(begin, end));
70         printf("[T]:002:%llu:%llu:1:C.\n",
71                udiff(begin, end), ndiff(begin, end));
72         core1_up = FALSE;
73         udelay(2000000);
74         printf("Proc %d requesting the vcore again\n", getpid());
75         begin = read_tsc();
76         retval = vcore_request(1);
77         if (retval)
78                 printf("Fucked!\n");
79         while (!core1_up)
80                 cpu_relax();
81         end = read_tsc();
82         printf("Took %llu usec (%llu nsec) to receive 1 core (warm).\n",
83                udiff(begin, end), ndiff(begin, end));
84         printf("[T]:002:%llu:%llu:1:W.\n",
85                udiff(begin, end), ndiff(begin, end));
86         return 0;
87 }
88
89 void vcore_entry(void)
90 {
91         uint32_t vcoreid = vcore_id();
92
93 /* begin: stuff userspace needs to do to handle notifications */
94         struct vcore *vc = &__procinfo.vcoremap[vcoreid];
95         struct preempt_data *vcpd;
96         vcpd = &__procdata.vcore_preempt_data[vcoreid];
97         
98         /* Lets try to restart vcore0's context.  Note this doesn't do anything to
99          * set the appropriate TLS.  On x86, this will involve changing the LDT
100          * entry for this vcore to point to the TCB of the new user-thread. */
101         if (vcoreid == 0) {
102                 clear_notif_pending(vcoreid);
103                 set_tls_desc(core0_tls, 0);
104                 /* Load silly state (Floating point) too */
105                 pop_ros_tf(&vcpd->notif_tf, vcoreid);
106                 panic("should never see me!");
107         }       
108 /* end: stuff userspace needs to do to handle notifications */
109
110         /* all other vcores are down here */
111         core1_up = TRUE;
112
113         while (core1_up)
114                 cpu_relax();
115         printf("Proc %d's vcore %d is yielding\n", getpid(), vcoreid);
116         sys_yield(0);
117
118         while(1);
119 }
120