forked from M-Labs/artiq
soc/runtime: fix RTIO sequence error detection on FUD
This commit is contained in:
parent
594b3dda74
commit
7d48ef263a
|
@ -2,7 +2,7 @@
|
|||
#include <hw/common.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include "exceptions.h"
|
||||
#include "rtio.h"
|
||||
#include "dds.h"
|
||||
|
||||
#define DDS_FTW0 0x0a
|
||||
|
@ -17,53 +17,6 @@
|
|||
#define DDS_WRITE(addr, data) \
|
||||
MMPTR(0xb0000000 + (addr)*4) = data
|
||||
|
||||
#define RTIO_FUD_CHANNEL 4
|
||||
|
||||
static void fud_sync(void)
|
||||
{
|
||||
rtio_chan_sel_write(RTIO_FUD_CHANNEL);
|
||||
while(rtio_o_level_read() != 0);
|
||||
}
|
||||
|
||||
static void fud(long long int fud_time)
|
||||
{
|
||||
int r;
|
||||
long long int fud_end_time;
|
||||
static long long int previous_fud_end_time;
|
||||
|
||||
r = rtio_reset_counter_read();
|
||||
if(r)
|
||||
previous_fud_end_time = 0;
|
||||
rtio_reset_counter_write(0);
|
||||
|
||||
rtio_chan_sel_write(RTIO_FUD_CHANNEL);
|
||||
if(fud_time < 0) {
|
||||
rtio_counter_update_write(1);
|
||||
fud_time = rtio_counter_read() + 4000;
|
||||
}
|
||||
fud_end_time = fud_time + 3*8;
|
||||
if(fud_time < previous_fud_end_time)
|
||||
exception_raise(EID_RTIO_SEQUENCE_ERROR);
|
||||
previous_fud_end_time = fud_end_time;
|
||||
|
||||
rtio_o_timestamp_write(fud_time);
|
||||
rtio_o_value_write(1);
|
||||
rtio_o_we_write(1);
|
||||
rtio_o_timestamp_write(fud_end_time);
|
||||
rtio_o_value_write(0);
|
||||
rtio_o_we_write(1);
|
||||
if(rtio_o_error_read()) {
|
||||
rtio_reset_logic_write(1);
|
||||
rtio_reset_logic_write(0);
|
||||
exception_raise(EID_RTIO_UNDERFLOW);
|
||||
}
|
||||
|
||||
if(r) {
|
||||
fud_sync();
|
||||
rtio_reset_counter_write(1);
|
||||
}
|
||||
}
|
||||
|
||||
void dds_init(void)
|
||||
{
|
||||
int i;
|
||||
|
@ -75,18 +28,18 @@ void dds_init(void)
|
|||
DDS_WRITE(0x01, 0x00);
|
||||
DDS_WRITE(0x02, 0x00);
|
||||
DDS_WRITE(0x03, 0x00);
|
||||
fud(-1);
|
||||
fud_sync();
|
||||
rtio_fud(-1);
|
||||
rtio_fud_sync();
|
||||
}
|
||||
}
|
||||
|
||||
void dds_program(int channel, int ftw, long long int fud_time)
|
||||
{
|
||||
fud_sync();
|
||||
rtio_fud_sync();
|
||||
DDS_WRITE(DDS_GPIO, channel);
|
||||
DDS_WRITE(DDS_FTW0, ftw & 0xff);
|
||||
DDS_WRITE(DDS_FTW1, (ftw >> 8) & 0xff);
|
||||
DDS_WRITE(DDS_FTW2, (ftw >> 16) & 0xff);
|
||||
DDS_WRITE(DDS_FTW3, (ftw >> 24) & 0xff);
|
||||
fud(fud_time);
|
||||
rtio_fud(fud_time);
|
||||
}
|
||||
|
|
|
@ -3,8 +3,11 @@
|
|||
#include "exceptions.h"
|
||||
#include "rtio.h"
|
||||
|
||||
long long int previous_fud_end_time;
|
||||
|
||||
void rtio_init(void)
|
||||
{
|
||||
previous_fud_end_time = 0;
|
||||
rtio_reset_counter_write(1);
|
||||
rtio_reset_logic_write(1);
|
||||
rtio_reset_logic_write(0);
|
||||
|
@ -64,3 +67,38 @@ long long int rtio_get(int channel)
|
|||
}
|
||||
return -1;
|
||||
}
|
||||
|
||||
#define RTIO_FUD_CHANNEL 4
|
||||
|
||||
void rtio_fud_sync(void)
|
||||
{
|
||||
rtio_sync(RTIO_FUD_CHANNEL);
|
||||
}
|
||||
|
||||
void rtio_fud(long long int fud_time)
|
||||
{
|
||||
long long int fud_end_time;
|
||||
|
||||
rtio_reset_counter_write(0);
|
||||
rtio_chan_sel_write(RTIO_FUD_CHANNEL);
|
||||
if(fud_time < 0) {
|
||||
rtio_counter_update_write(1);
|
||||
fud_time = rtio_counter_read() + 4000;
|
||||
}
|
||||
fud_end_time = fud_time + 3*8;
|
||||
if(fud_time < previous_fud_end_time)
|
||||
exception_raise(EID_RTIO_SEQUENCE_ERROR);
|
||||
previous_fud_end_time = fud_end_time;
|
||||
|
||||
rtio_o_timestamp_write(fud_time);
|
||||
rtio_o_value_write(1);
|
||||
rtio_o_we_write(1);
|
||||
rtio_o_timestamp_write(fud_end_time);
|
||||
rtio_o_value_write(0);
|
||||
rtio_o_we_write(1);
|
||||
if(rtio_o_error_read()) {
|
||||
rtio_reset_logic_write(1);
|
||||
rtio_reset_logic_write(0);
|
||||
exception_raise(EID_RTIO_UNDERFLOW);
|
||||
}
|
||||
}
|
||||
|
|
|
@ -8,4 +8,7 @@ void rtio_replace(long long int timestamp, int channel, int value);
|
|||
void rtio_sync(int channel);
|
||||
long long int rtio_get(int channel);
|
||||
|
||||
void rtio_fud_sync(void);
|
||||
void rtio_fud(long long int fud_time);
|
||||
|
||||
#endif /* __RTIO_H */
|
||||
|
|
Loading…
Reference in New Issue