forked from M-Labs/artiq
88 lines
1.3 KiB
C
88 lines
1.3 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)
|
||
|
{
|
||
|
int r, i;
|
||
|
|
||
|
r = 0;
|
||
|
for(i=0;i<4;i++) {
|
||
|
r <<= 8;
|
||
|
r |= 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;
|
||
|
}
|
||
|
|
||
|
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(kbuf, length, kcode, sizeof(kcode));
|
||
|
flush_cpu_icache();
|
||
|
for(i=0;i<20;i++) {
|
||
|
printf("=== %2d ===\n", i);
|
||
|
readchar();
|
||
|
k(i);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|