Added struct proc pointer to base of the executable args block
[akaros.git] / kern / arch / riscv / env.c
index 366b6fc..2b7d32d 100644 (file)
@@ -4,22 +4,10 @@
 #include <arch/arch.h>
 #include <pmap.h>
 
-void
-env_push_ancillary_state(env_t* e)
+void save_fp_state(ancillary_state_t* silly)
 {
-       if(e->scp_ctx.hw_tf.sr & SR_EF)
-               save_fp_state(&e->env_ancillary_state);
-}
-
-void
-save_fp_state(ancillary_state_t* silly)
-{
-       /* TODO: save FP state! */
-       return; // don't save FP state for now
-       uintptr_t sr = mfpcr(PCR_SR);
-       mtpcr(PCR_SR, sr | SR_EF);
-
-       asm("mffsr %0" : "=r"(silly->fsr));
+       uintptr_t sr = enable_fp();
+       uint32_t fsr = read_fsr();
 
        asm("fsd f0,%0" : "=m"(silly->fpr[0]));
        asm("fsd f1,%0" : "=m"(silly->fpr[1]));
@@ -54,24 +42,14 @@ save_fp_state(ancillary_state_t* silly)
        asm("fsd f30,%0" : "=m"(silly->fpr[30]));
        asm("fsd f31,%0" : "=m"(silly->fpr[31]));
 
+       silly->fsr = fsr;
        mtpcr(PCR_SR, sr);
 }
 
-void
-env_pop_ancillary_state(env_t* e)
-{ 
-       if(e->scp_ctx.hw_tf.sr & SR_EF)
-               restore_fp_state(&e->env_ancillary_state);
-}
-
-void
-restore_fp_state(ancillary_state_t* silly)
+void restore_fp_state(ancillary_state_t* silly)
 {
-       return; // don't restore FP state for now
-       uintptr_t sr = mfpcr(PCR_SR);
-       mtpcr(PCR_SR, sr | SR_EF);
-
-       asm("mtfsr %0" : : "r"(silly->fsr));
+       uintptr_t sr = enable_fp();
+       uint32_t fsr = silly->fsr;
 
        asm("fld f0,%0" : : "m"(silly->fpr[0]));
        asm("fld f1,%0" : : "m"(silly->fpr[1]));
@@ -106,12 +84,25 @@ restore_fp_state(ancillary_state_t* silly)
        asm("fld f30,%0" : : "m"(silly->fpr[30]));
        asm("fld f31,%0" : : "m"(silly->fpr[31]));
 
+       write_fsr(fsr);
        mtpcr(PCR_SR, sr);
 }
 
 void init_fp_state(void)
 {
-       /* TODO: implement me! */
+       uintptr_t sr = enable_fp();
+
+       asm("fcvt.d.w f0, x0; fcvt.d.w f1 ,x0; fcvt.d.w f2, x0; fcvt.d.w f3, x0;");
+       asm("fcvt.d.w f4, x0; fcvt.d.w f5, x0; fcvt.d.w f6, x0; fcvt.d.w f7, x0;");
+       asm("fcvt.d.w f8, x0; fcvt.d.w f9, x0; fcvt.d.w f10,x0; fcvt.d.w f11,x0;");
+       asm("fcvt.d.w f12,x0; fcvt.d.w f13,x0; fcvt.d.w f14,x0; fcvt.d.w f15,x0;");
+       asm("fcvt.d.w f16,x0; fcvt.d.w f17,x0; fcvt.d.w f18,x0; fcvt.d.w f19,x0;");
+       asm("fcvt.d.w f20,x0; fcvt.d.w f21,x0; fcvt.d.w f22,x0; fcvt.d.w f23,x0;");
+       asm("fcvt.d.w f24,x0; fcvt.d.w f25,x0; fcvt.d.w f26,x0; fcvt.d.w f27,x0;");
+       asm("fcvt.d.w f28,x0; fcvt.d.w f29,x0; fcvt.d.w f30,x0; fcvt.d.w f31,x0;");
+       asm("mtfsr x0");
+
+       mtpcr(PCR_SR, sr);
 }
 
 static int
@@ -144,7 +135,7 @@ user_mem_walk_recursive(env_t* e, uintptr_t start, size_t len,
                        if(pt_callback != NULL && (ret = pt_callback(e, pte, (void*)pgaddr, arg)))
                                goto out;
                }
-               else if(callback != NULL && !PAGE_UNMAPPED(*pte))
+               else if(callback != NULL)
                        if((ret = callback(e, pte, (void*)pgaddr, arg)))
                                goto out;
        }
@@ -166,6 +157,8 @@ env_pagetable_free(env_t* e)
 {
        int pt_free(env_t* e, pte_t* pte, void* va, void* arg)
        {
+               if (!PAGE_PRESENT(pte))
+                       return 0;
                page_decref(pa2page(PTD_ADDR(*pte)));
                return 0;
        }