Skip to content

Commit

Permalink
runtime: support test mode on AMP
Browse files Browse the repository at this point in the history
sbourdeauducq committed Apr 16, 2015
1 parent 546996f commit 6a5f58e
Showing 7 changed files with 311 additions and 69 deletions.
2 changes: 1 addition & 1 deletion soc/runtime/Makefile
Original file line number Diff line number Diff line change
@@ -9,7 +9,7 @@ UNIPROCESSOR := $(shell printf "\#include <generated/csr.h>\nCSR_KERNEL_CPU_BASE

ifeq ($(UNIPROCESSOR),0)
OBJECTS += mailbox.o kernelcpu.o ksupport_data.o
OBJECTS_KSUPPORT += mailbox.o ksupport.o
OBJECTS_KSUPPORT += mailbox.o bridge.o ksupport.o
CFLAGS += -DARTIQ_AMP
SERVICE_TABLE_INPUT = ksupport.elf
else
79 changes: 79 additions & 0 deletions soc/runtime/bridge.c
Original file line number Diff line number Diff line change
@@ -0,0 +1,79 @@
#include "mailbox.h"
#include "messages.h"
#include "rtio.h"
#include "dds.h"
#include "bridge.h"

static void send_ready(void)
{
struct msg_base msg;

msg.type = MESSAGE_TYPE_BRG_READY;
mailbox_send_and_wait(&msg);
}

void bridge_main(void)
{
struct msg_base *umsg;

send_ready();
while(1) {
umsg = mailbox_wait_and_receive();
switch(umsg->type) {
case MESSAGE_TYPE_BRG_TTL_OUT: {
struct msg_brg_ttl_out *msg;

msg = (struct msg_brg_ttl_out *)umsg;
rtio_init();
rtio_set_oe(rtio_get_counter() + 8000, msg->channel, 1);
rtio_set_o(rtio_get_counter() + 8000, msg->channel, msg->value);
mailbox_acknowledge();
break;
}
case MESSAGE_TYPE_BRG_DDS_SEL: {
struct msg_brg_dds_sel *msg;

msg = (struct msg_brg_dds_sel *)umsg;
DDS_WRITE(DDS_GPIO, msg->channel);
mailbox_acknowledge();
break;
}
case MESSAGE_TYPE_BRG_DDS_RESET: {
unsigned int g;

g = DDS_READ(DDS_GPIO);
DDS_WRITE(DDS_GPIO, g | (1 << 7));
DDS_WRITE(DDS_GPIO, g);

mailbox_acknowledge();
break;
}
case MESSAGE_TYPE_BRG_DDS_READ_REQUEST: {
struct msg_brg_dds_read_request *msg;
struct msg_brg_dds_read_reply rmsg;

msg = (struct msg_brg_dds_read_request *)umsg;
rmsg.type = MESSAGE_TYPE_BRG_DDS_READ_REPLY;
rmsg.data = DDS_READ(msg->address);
mailbox_send_and_wait(&rmsg);
break;
}
case MESSAGE_TYPE_BRG_DDS_WRITE: {
struct msg_brg_dds_write *msg;

msg = (struct msg_brg_dds_write *)umsg;
DDS_WRITE(msg->address, msg->data);
mailbox_acknowledge();
break;
}
case MESSAGE_TYPE_BRG_DDS_FUD:
rtio_init();
rtio_fud(rtio_get_counter() + 8000);
mailbox_acknowledge();
break;
default:
mailbox_acknowledge();
break;
}
}
}
6 changes: 6 additions & 0 deletions soc/runtime/bridge.h
Original file line number Diff line number Diff line change
@@ -0,0 +1,6 @@
#ifndef __BRIDGE_H
#define __BRIDGE_H

void bridge_main(void);

#endif /* __BRIDGE_H */
44 changes: 24 additions & 20 deletions soc/runtime/ksupport.c
Original file line number Diff line number Diff line change
@@ -1,6 +1,7 @@
#include <stdarg.h>

#include "exceptions.h"
#include "bridge.h"
#include "mailbox.h"
#include "messages.h"
#include "rtio.h"
@@ -31,26 +32,29 @@ int main(void)
kernel_function k;
void *jb;

jb = exception_push();
if(exception_setjmp(jb)) {
struct msg_exception msg;

msg.type = MESSAGE_TYPE_EXCEPTION;
msg.eid = exception_getid(msg.eparams);
mailbox_send_and_wait(&msg);
} else {
struct msg_finished msg;

k = mailbox_receive();
if(!k)
exception_raise(EID_INTERNAL_ERROR);
dds_init();
rtio_init();
k();
exception_pop(1);

msg.type = MESSAGE_TYPE_FINISHED;
mailbox_send_and_wait(&msg);
k = mailbox_receive();

if(k == NULL)
bridge_main();
else {
jb = exception_push();
if(exception_setjmp(jb)) {
struct msg_exception msg;

msg.type = MESSAGE_TYPE_EXCEPTION;
msg.eid = exception_getid(msg.eparams);
mailbox_send_and_wait(&msg);
} else {
struct msg_base msg;

dds_init();
rtio_init();
k();
exception_pop(1);

msg.type = MESSAGE_TYPE_FINISHED;
mailbox_send_and_wait(&msg);
}
}
while(1);
}
4 changes: 2 additions & 2 deletions soc/runtime/main.c
Original file line number Diff line number Diff line change
@@ -70,7 +70,7 @@ static int load_object(void *buffer, int length)


#ifdef ARTIQ_AMP
static int process_msg(struct msg_unknown *umsg, int *eid, long long int *eparams)
static int process_msg(struct msg_base *umsg, int *eid, long long int *eparams)
{
int i;

@@ -129,7 +129,7 @@ static int run_kernel(const char *kernel_name, int *eid, long long int *eparams)
#ifdef ARTIQ_AMP
kernelcpu_start(k);
while(1) {
struct msg_unknown *umsg;
struct msg_base *umsg;

umsg = mailbox_receive();
r = KERNEL_RUN_INVALID_STATUS;
46 changes: 41 additions & 5 deletions soc/runtime/messages.h
Original file line number Diff line number Diff line change
@@ -8,17 +8,24 @@ enum {
MESSAGE_TYPE_EXCEPTION,
MESSAGE_TYPE_RPC_REQUEST,
MESSAGE_TYPE_RPC_REPLY,
MESSAGE_TYPE_LOG
};
MESSAGE_TYPE_LOG,

struct msg_unknown {
int type;
MESSAGE_TYPE_BRG_READY,
MESSAGE_TYPE_BRG_TTL_OUT,
MESSAGE_TYPE_BRG_DDS_SEL,
MESSAGE_TYPE_BRG_DDS_RESET,
MESSAGE_TYPE_BRG_DDS_READ_REQUEST,
MESSAGE_TYPE_BRG_DDS_READ_REPLY,
MESSAGE_TYPE_BRG_DDS_WRITE,
MESSAGE_TYPE_BRG_DDS_FUD,
};

struct msg_finished {
struct msg_base {
int type;
};

/* kernel messages */

struct msg_exception {
int type;
int eid;
@@ -43,4 +50,33 @@ struct msg_log {
va_list args;
};

/* bridge messages */

struct msg_brg_ttl_out {
int type;
int channel;
int value;
};

struct msg_brg_dds_sel {
int type;
int channel;
};

struct msg_brg_dds_read_request {
int type;
unsigned int address;
};

struct msg_brg_dds_read_reply {
int type;
unsigned int data;
};

struct msg_brg_dds_write {
int type;
unsigned int address;
unsigned int data;
};

#endif /* __MESSAGES_H */
199 changes: 158 additions & 41 deletions soc/runtime/test_mode.c
Original file line number Diff line number Diff line change
@@ -13,14 +13,136 @@

#ifdef ARTIQ_AMP

#warning TODO
#include "kernelcpu.h"
#include "mailbox.h"
#include "messages.h"

void test_main(void)
static void amp_bridge_init(void)
{
struct msg_base *umsg;

kernelcpu_start(NULL);

while(1) {
umsg = mailbox_wait_and_receive();
if(umsg->type == MESSAGE_TYPE_BRG_READY) {
printf("AMP bridge ready\n");
mailbox_acknowledge();
break;
} else {
printf("Warning: unexpected message %d from AMP bridge\n", umsg->type);
mailbox_acknowledge();
}
}
}

static void p_ttlout(int n, int value)
{
struct msg_brg_ttl_out msg;

msg.type = MESSAGE_TYPE_BRG_TTL_OUT;
msg.channel = n;
msg.value = value;
mailbox_send_and_wait(&msg);
}

static void p_ddssel(int channel)
{
struct msg_brg_dds_sel msg;

msg.type = MESSAGE_TYPE_BRG_DDS_SEL;
msg.channel = channel;
mailbox_send_and_wait(&msg);
}

static void p_ddsreset(void)
{
struct msg_base msg;

msg.type = MESSAGE_TYPE_BRG_DDS_RESET;
mailbox_send_and_wait(&msg);
}

static unsigned int p_ddsread(unsigned int address)
{
struct msg_brg_dds_read_request msg;
struct msg_brg_dds_read_reply *rmsg;
unsigned int r;

msg.type = MESSAGE_TYPE_BRG_DDS_READ_REQUEST;
msg.address = address;
mailbox_send(&msg);
while(1) {
rmsg = mailbox_wait_and_receive();
if(rmsg->type == MESSAGE_TYPE_BRG_DDS_READ_REPLY) {
r = rmsg->data;
mailbox_acknowledge();
return r;
} else {
printf("Warning: unexpected message %d from AMP bridge\n", rmsg->type);
mailbox_acknowledge();
}
}
}

static void p_ddswrite(unsigned int address, unsigned int data)
{
struct msg_brg_dds_write msg;

msg.type = MESSAGE_TYPE_BRG_DDS_WRITE;
msg.address = address;
msg.data = data;
mailbox_send_and_wait(&msg);
}

static void p_ddsfud(void)
{
struct msg_base msg;

msg.type = MESSAGE_TYPE_BRG_DDS_FUD;
mailbox_send_and_wait(&msg);
}

#else /* ARTIQ_AMP */

static void p_ttlout(int n, int value)
{
rtio_init();
rtio_set_oe(rtio_get_counter() + 8000, n2, 1);
rtio_set_o(rtio_get_counter() + 8000, n2, value2);
}

static void p_ddssel(int channel)
{
DDS_WRITE(DDS_GPIO, n2);
}

static void p_ddsreset(void)
{
unsigned int g;

g = DDS_READ(DDS_GPIO);
DDS_WRITE(DDS_GPIO, g | (1 << 7));
DDS_WRITE(DDS_GPIO, g);
}

static unsigned int p_ddsread(unsigned int address)
{
return DDS_READ(address);
}

static void p_ddswrite(unsigned int address, unsigned int data)
{
DDS_WRITE(address, data);
}

static void p_ddsfud(void)
{
printf("Not implemented yet for AMP systems\n");
rtio_init();
rtio_fud(rtio_get_counter() + 8000);
}

#else
#endif /* ARTIQ_AMP */

static void leds(char *value)
{
@@ -81,9 +203,7 @@ static void ttlout(char *n, char *value)
return;
}

rtio_init();
rtio_set_oe(rtio_get_counter() + 8000, n2, 1);
rtio_set_o(rtio_get_counter() + 8000, n2, value2);
p_ttlout(n2, value2);
}

static void ddssel(char *n)
@@ -102,7 +222,7 @@ static void ddssel(char *n)
return;
}

DDS_WRITE(DDS_GPIO, n2);
p_ddssel(n2);
}

static void ddsw(char *addr, char *value)
@@ -126,7 +246,7 @@ static void ddsw(char *addr, char *value)
return;
}

DDS_WRITE(addr2, value2);
p_ddswrite(addr2, value2);
}

static void ddsr(char *addr)
@@ -145,13 +265,12 @@ static void ddsr(char *addr)
return;
}

printf("0x%02x\n", DDS_READ(addr2));
printf("0x%02x\n", p_ddsread(addr2));
}

static void ddsfud(void)
{
rtio_init();
rtio_fud(rtio_get_counter() + 8000);
p_ddsfud();
}

static void ddsftw(char *n, char *ftw)
@@ -175,31 +294,27 @@ static void ddsftw(char *n, char *ftw)
return;
}

DDS_WRITE(DDS_GPIO, n2);
DDS_WRITE(DDS_FTW0, ftw2 & 0xff);
DDS_WRITE(DDS_FTW1, (ftw2 >> 8) & 0xff);
DDS_WRITE(DDS_FTW2, (ftw2 >> 16) & 0xff);
DDS_WRITE(DDS_FTW3, (ftw2 >> 24) & 0xff);
ddsfud();
p_ddssel(n2);
p_ddswrite(DDS_FTW0, ftw2 & 0xff);
p_ddswrite(DDS_FTW1, (ftw2 >> 8) & 0xff);
p_ddswrite(DDS_FTW2, (ftw2 >> 16) & 0xff);
p_ddswrite(DDS_FTW3, (ftw2 >> 24) & 0xff);
p_ddsfud();
}

static void ddsreset(void)
{
unsigned int g;

g = DDS_READ(DDS_GPIO);
DDS_WRITE(DDS_GPIO, g | (1 << 7));
DDS_WRITE(DDS_GPIO, g);
p_ddsreset();
}

static void ddsinit(void)
{
ddsreset();
DDS_WRITE(0x00, 0x78);
DDS_WRITE(0x01, 0x00);
DDS_WRITE(0x02, 0x00);
DDS_WRITE(0x03, 0x00);
ddsfud();
p_ddsreset();
p_ddswrite(0x00, 0x78);
p_ddswrite(0x01, 0x00);
p_ddswrite(0x02, 0x00);
p_ddswrite(0x03, 0x00);
p_ddsfud();
}

static void ddstest_one(unsigned int i)
@@ -211,20 +326,20 @@ static void ddstest_one(unsigned int i)
};
unsigned int f, g, j;

DDS_WRITE(DDS_GPIO, i);
p_ddssel(i);
ddsinit();

for(j=0; j<12; j++) {
f = v[j];
DDS_WRITE(0x0a, f & 0xff);
DDS_WRITE(0x0b, (f >> 8) & 0xff);
DDS_WRITE(0x0c, (f >> 16) & 0xff);
DDS_WRITE(0x0d, (f >> 24) & 0xff);
ddsfud();
g = DDS_READ(0x0a);
g |= DDS_READ(0x0b) << 8;
g |= DDS_READ(0x0c) << 16;
g |= DDS_READ(0x0d) << 24;
p_ddswrite(0x0a, f & 0xff);
p_ddswrite(0x0b, (f >> 8) & 0xff);
p_ddswrite(0x0c, (f >> 16) & 0xff);
p_ddswrite(0x0d, (f >> 24) & 0xff);
p_ddsfud();
g = p_ddsread(0x0a);
g |= p_ddsread(0x0b) << 8;
g |= p_ddsread(0x0c) << 16;
g |= p_ddsread(0x0d) << 24;
if(g != f)
printf("readback fail on DDS %d, 0x%08x != 0x%08x\n", i, g, f);
}
@@ -346,11 +461,13 @@ void test_main(void)
{
char buffer[64];

#ifdef ARTIQ_AMP
amp_bridge_init();
#endif

while(1) {
putsnonl("\e[1mtest>\e[0m ");
readstr(buffer, 64);
do_command(buffer);
}
}

#endif /* ARTIQ_AMP */

0 comments on commit 6a5f58e

Please sign in to comment.