MPC TLB shootdowns
[akaros.git] / tests / mhello.c
index 029a059..55edd22 100644 (file)
@@ -5,34 +5,42 @@
 #include <ros/notification.h>
 #include <ros/bcq.h>
 #include <arch/arch.h>
-#include <stdio.h>
-#include <hart.h>
+#include <rstdio.h>
+#include <vcore.h>
+#include <mcs.h>
 #include <timing.h>
 #include <rassert.h>
 
-hart_barrier_t b;
+mcs_barrier_t b;
 
 __thread int temp;
+void *core0_tls = 0;
 
 int main(int argc, char** argv)
 {
        uint32_t vcoreid;
        int retval;
 
-       hart_barrier_init(&b,hart_max_harts()-1);
+       mcs_barrier_init(&b, max_vcores());
 
 /* begin: stuff userspace needs to do before switching to multi-mode */
-       if (hart_init())
-               printf("Harts failed, we're fucked!\n");
+       if (vcore_init())
+               printf("vcore_init() failed, we're fucked!\n");
 
        /* tell the kernel where and how we want to receive notifications */
        struct notif_method *nm;
-       for (int i = 1; i < MAX_NR_NOTIF; i++) {
+       for (int i = 0; i < MAX_NR_NOTIF; i++) {
                nm = &__procdata.notif_methods[i];
                nm->flags |= NOTIF_WANTED | NOTIF_MSG | NOTIF_IPI;
                nm->vcoreid = i % 2; // vcore0 or 1, keepin' it fresh.
        }
 
+       /* Need to save this somewhere that you can find it again when restarting
+        * core0 */
+       core0_tls = get_tls_desc(0);
+       /* Need to save our floating point state somewhere (like in the
+        * user_thread_tcb so it can be restarted too */
+
        /* don't forget to enable notifs on vcore0 at some point */
        struct preempt_data *vcpd;
        vcpd = &__procdata.vcore_preempt_data[0];
@@ -40,7 +48,7 @@ int main(int argc, char** argv)
        
 /* end: stuff userspace needs to do before switching to multi-mode */
 
-       if ((vcoreid = hart_self())) {
+       if ((vcoreid = vcore_id())) {
                printf("Should never see me! (from vcore %d)\n", vcoreid);
        } else { // core 0
                temp = 0xdeadbeef;
@@ -48,33 +56,53 @@ int main(int argc, char** argv)
                       vcoreid, &temp, temp);
                printf("Multi-Goodbye, world, from PID: %d!\n", sys_getpid());
                //retval = sys_resource_req(RES_CORES, 2, 0);
-               //retval = hart_request(hart_max_harts()-2);
-               retval = hart_request(2); // doesn't do what you think.  this gives 3.
-               //debug("retval = %d\n", retval);
+               printf("Requesting %d vcores\n",max_vcores());
+               retval = vcore_request(max_vcores());
+               //retval = vcore_request(5);
+               printf("This is vcore0, right after vcore_request, retval=%d\n", retval);
        }
-       printf("Vcore %d Done!\n", vcoreid);
+
+#if 0
+       /* test notifying my vcore2 */
+       udelay(5000000);
+       printf("Vcore 0 self-notifying vcore 2 with notif 4!\n");
+       struct notif_event ne;
+       ne.ne_type = 4;
+       sys_self_notify(2, 4, &ne);
+       udelay(5000000);
+       printf("Vcore 0 notifying itself with notif 3!\n");
+       ne.ne_type = 3;
+       sys_notify(sys_getpid(), 3, &ne);
+       udelay(1000000);
+#endif
+
        /* test loop for restarting a notif_tf */
        if (vcoreid == 0) {
                int ctr = 0;
                while(1) {
-                       printf("Vcore %d Spinning (%d)!\n", vcoreid, ctr++);
+                       printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
                        udelay(5000000);
+                       //exit(0);
                }
        }
 
-       hart_barrier_wait(&b,hart_self());
+       printf("Vcore %d Done!\n", vcoreid);
+       //mcs_barrier_wait(&b,vcore_id());
 
        printf("All Cores Done!\n", vcoreid);
        while(1); // manually kill from the monitor
        return 0;
 }
 
-void hart_entry(void)
+void vcore_entry(void)
 {
-       uint32_t vcoreid = hart_self();
+       uint32_t vcoreid = vcore_id();
+       static bool first_time = TRUE;
 
+       temp = 0xcafebabe;
 /* begin: stuff userspace needs to do to handle notifications */
 
+       struct vcore *vc = &__procinfo.vcoremap[vcoreid];
        struct preempt_data *vcpd;
        vcpd = &__procdata.vcore_preempt_data[vcoreid];
        
@@ -89,12 +117,34 @@ void hart_entry(void)
        /* can see how many messages had to be sent as bits */
        printf("Number of event overflows: %d\n", vcpd->event_overflows);
 
+       if (vc->preempt_pending) {
+               printf("Oh crap, vcore %d is being preempted!  Yielding\n", vcoreid);
+               sys_yield(TRUE);
+               printf("After yield on vcore %d. I wasn't being preempted.\n", vcoreid);
+       }
+               
        /* Lets try to restart vcore0's context.  Note this doesn't do anything to
         * set the appropriate TLS.  On x86, this will involve changing the LDT
         * entry for this vcore to point to the TCB of the new user-thread. */
        if (vcoreid == 0) {
+               /* // test for preempting a notif_handler.  do it from the monitor
+               int ctr = 0;
+               while(ctr < 3) {
+                       printf("Vcore %d Spinning (%d), temp = %08x!\n", vcoreid, ctr++, temp);
+                       udelay(5000000);
+               } */
                printf("restarting vcore0 from userspace\n");
-               pop_ros_tf(&vcpd->notif_tf, &vcpd->notif_enabled);
+               vcpd->notif_pending = 0;
+               /* Do one last check for notifs after clearing pending */
+               /* // testing for missing a notif
+               if (first_time) {
+                       first_time = FALSE;
+                       printf("setting pending, trying to renotify etc\n");
+                       vcpd->notif_pending = 1;
+               } */
+               set_tls_desc(core0_tls, 0);
+               /* Load silly state (Floating point) too */
+               pop_ros_tf(&vcpd->notif_tf, vcoreid);
                panic("should never see me!");
        }       
        /* unmask notifications once you can let go of the notif_tf and it is okay
@@ -105,9 +155,11 @@ void hart_entry(void)
        
 /* end: stuff userspace needs to do to handle notifications */
 
-       temp = 0xcafebabe;
-       printf("Hello from hart_entry in vcore %d with temp addr %p and temp %p\n",
+       printf("Hello from vcore_entry in vcore %d with temp addr %p and temp %p\n",
               vcoreid, &temp, temp);
-       hart_barrier_wait(&b,hart_self());
+       vcore_request(1);
+       //mcs_barrier_wait(&b,vcore_id());
+       udelay(vcoreid * 10000000);
+       exit(0);
        while(1);
 }