temporary undoing of renaming

1 files changed, 179 insertions, 0 deletions

diff --git a/pk/pk.c b/pk/pk.c
new file mode 100644
index 0000000..7260601
--- /dev/null
+++ b/pk/pk.c
@@ -0,0 +1,179 @@
+#include "pcr.h"
+#include "pk.h"
+#include "file.h"
+#include "frontend.h"
+#include <stdarg.h>
+#include <stdint.h>
+#include <stdbool.h>
+#include <string.h>
+
+static void vsprintk(char* out, const char* s, va_list vl)
+{
+  bool format = false;
+  bool longarg = false;
+  for( ; *s; s++)
+  {
+    if(format)
+    {
+      switch(*s)
+      {
+        case 'l':
+          longarg = true;
+          break;
+        case 'x':
+        {
+          long n = longarg ? va_arg(vl,long) : va_arg(vl,int);
+          for(int i = 2*(longarg ? sizeof(long) : sizeof(int))-1; i >= 0; i--)
+          {
+            int d = (n >> (4*i)) & 0xF;
+            *out++ = (d < 10 ? '0'+d : 'a'+d-10);
+          }
+          longarg = false;
+          format = false;
+          break;
+        }
+        case 'd':
+        {
+          long n = longarg ? va_arg(vl,long) : va_arg(vl,int);
+          if(n < 0)
+          {
+            n = -n;
+            *out++ = '-';
+          }
+          long digits = 1;
+          for(long nn = n ; nn /= 10; digits++);
+          for(int i = digits-1; i >= 0; i--)
+          {
+            out[i] = '0' + n%10;
+            n /= 10;
+          }
+          out += digits;
+          longarg = false;
+          format = false;
+          break;
+        }
+        case 's':
+        {
+          const char* s2 = va_arg(vl,const char*);
+          while(*s2)
+            *out++ = *s2++;
+          longarg = false;
+          format = false;
+          break;
+        }
+        case 'c':
+        {
+          *out++ = (char)va_arg(vl,int);
+          longarg = false;
+          format = false;
+          break;
+        }
+        default:
+          panic("bad fmt");
+      }
+    }
+    else if(*s == '%')
+      format = true;
+    else
+      *out++ = *s;
+  }
+  *out++ = '\0';
+}
+
+void printk(const char* s, ...)
+{
+  va_list vl;
+  va_start(vl,s);
+
+  char out[1024]; // XXX
+  vsprintk(out,s,vl);
+  file_write(stderr,out,strlen(out));
+
+  va_end(vl);
+}
+
+void sprintk(char* out, const char* s, ...)
+{
+  va_list vl;
+  va_start(vl,s);
+
+  vsprintk(out,s,vl);
+
+  va_end(vl);
+}
+
+void dump_tf(trapframe_t* tf)
+{
+  static const char* regnames[] = {
+    "z ", "ra", "v0", "v1", "a0", "a1", "a2", "a3",
+    "a4", "a5", "a6", "a7", "t0", "t1", "t2", "t3",
+    "t4", "t5", "t6", "t7", "s0", "s1", "s2", "s3",
+    "s4", "s5", "s6", "s7", "s8", "fp", "sp", "tp"
+  };
+
+  tf->gpr[0] = 0;
+
+  for(int i = 0; i < 32; i+=4)
+  {
+    for(int j = 0; j < 4; j++)
+      printk("%s %lx%c",regnames[i+j],tf->gpr[i+j],j < 3 ? ' ' : '\n');
+  }
+  printk("sr %lx pc %lx va %lx insn       %x\n",tf->sr,tf->epc,tf->badvaddr,
+         (uint32_t)tf->insn);
+}
+
+void init_tf(trapframe_t* tf, long pc, long sp, int user64)
+{
+  memset(tf,0,sizeof(*tf));
+  if(sizeof(void*) != 8)
+    kassert(!user64);
+  tf->sr = (mfpcr(PCR_SR) & (SR_IM | SR_SX)) | SR_S | SR_EC;
+  if(user64)
+    tf->sr |= SR_UX;
+  tf->gpr[30] = sp;
+  tf->epc = pc;
+}
+
+static void bss_init()
+{
+  // front-end server zeroes the bss automagically
+}
+
+struct args
+{
+  uint64_t argc;
+  uint64_t argv[];
+};
+
+static struct args* mainvars_init(long loc)
+{
+  sysret_t r = frontend_syscall(SYS_getmainvars, loc, USER_MAINVARS_SIZE, 0, 0);
+  kassert(r.result == 0);
+  return (struct args*)loc;
+}
+
+static void jump_usrstart(const char* fn, long sp)
+{
+  trapframe_t tf;
+
+  int user64;
+  long start = load_elf(fn, &user64);
+  asm volatile("cflush; fence");
+
+  init_tf(&tf, start, sp, user64);
+  pop_tf(&tf);
+}
+
+void boot()
+{
+  bss_init();
+  file_init();
+
+  long stack_top = (mfpcr(PCR_MEMSIZE) << MEMSIZE_SHIFT);
+  if(stack_top >= 0x80000000)
+    stack_top = 0x80000000;
+  stack_top -= USER_MAINVARS_SIZE;
+
+  struct args* args = mainvars_init(stack_top);
+  jump_usrstart((char*)(long)args->argv[0], stack_top);
+}