forked from M-Labs/artiq
1
0
Fork 0
artiq/soc/runtime/main.c

98 lines
1.5 KiB
C

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <irq.h>
#include <uart.h>
#include <console.h>
#include <system.h>
#include <generated/csr.h>
#include "elf_loader.h"
static void receive_sync(void)
{
char c;
int recognized;
recognized = 0;
while(1) {
c = readchar();
if(c == 0x5a) {
recognized++;
if(recognized == 4)
return;
} else
recognized = 0;
}
}
static int receive_length(void)
{
unsigned int r;
int i;
r = 0;
for(i=0;i<4;i++) {
r <<= 8;
r |= (unsigned char)readchar();
}
return r;
}
static int download_kernel(void *buffer, int maxlength)
{
int length;
int i;
unsigned char *_buffer = buffer;
receive_sync();
length = receive_length();
if(length > maxlength)
return -1;
for(i=0;i<length;i++)
_buffer[i] = readchar();
return length;
}
static void printint(int x)
{
printf("%d\n", x);
}
static const struct symbol syscalls[] = {
{"__syscall_printint", printint},
{NULL, NULL}
};
typedef void (*kernel_function)(int);
int main(void)
{
unsigned char kbuf[256*1024];
unsigned char kcode[256*1024];
kernel_function k = (kernel_function)kcode;
int i;
int length;
irq_setmask(0);
irq_setie(1);
uart_init();
puts("ARTIQ runtime built "__DATE__" "__TIME__"\n");
while(1) {
length = download_kernel(kbuf, sizeof(kbuf));
if(length > 0) {
load_elf(syscalls, kbuf, length, kcode, sizeof(kcode));
flush_cpu_icache();
for(i=0;i<40;i++) {
printf("%2d: ", i);
k(i);
}
}
}
return 0;
}