2014-08-28 16:56:48 +08:00
|
|
|
#include <generated/csr.h>
|
|
|
|
|
2014-09-25 12:55:50 +08:00
|
|
|
#include "exceptions.h"
|
2014-08-28 16:56:48 +08:00
|
|
|
#include "rtio.h"
|
|
|
|
|
2014-10-14 12:47:04 +08:00
|
|
|
long long int previous_fud_end_time;
|
|
|
|
|
2014-08-28 16:56:48 +08:00
|
|
|
void rtio_init(void)
|
|
|
|
{
|
2014-10-14 12:47:04 +08:00
|
|
|
previous_fud_end_time = 0;
|
2014-11-30 00:13:54 +08:00
|
|
|
rtio_reset_write(1);
|
|
|
|
rtio_reset_write(0);
|
2014-08-28 16:56:48 +08:00
|
|
|
}
|
|
|
|
|
2014-09-14 23:30:33 +08:00
|
|
|
void rtio_oe(int channel, int oe)
|
|
|
|
{
|
|
|
|
rtio_chan_sel_write(channel);
|
|
|
|
rtio_oe_write(oe);
|
|
|
|
}
|
|
|
|
|
2014-08-28 16:56:48 +08:00
|
|
|
void rtio_set(long long int timestamp, int channel, int value)
|
|
|
|
{
|
2014-09-05 12:03:22 +08:00
|
|
|
rtio_chan_sel_write(channel);
|
|
|
|
rtio_o_timestamp_write(timestamp);
|
|
|
|
rtio_o_value_write(value);
|
|
|
|
while(!rtio_o_writable_read());
|
|
|
|
rtio_o_we_write(1);
|
2014-10-21 23:14:01 +08:00
|
|
|
if(rtio_o_underflow_read()) {
|
2014-11-30 00:13:54 +08:00
|
|
|
rtio_o_underflow_reset_write(1);
|
2014-09-25 12:55:50 +08:00
|
|
|
exception_raise(EID_RTIO_UNDERFLOW);
|
2014-10-10 20:12:22 +08:00
|
|
|
}
|
2014-08-28 16:56:48 +08:00
|
|
|
}
|
|
|
|
|
2014-09-11 23:14:45 +08:00
|
|
|
void rtio_replace(long long int timestamp, int channel, int value)
|
|
|
|
{
|
|
|
|
rtio_chan_sel_write(channel);
|
|
|
|
rtio_o_timestamp_write(timestamp);
|
|
|
|
rtio_o_value_write(value);
|
|
|
|
rtio_o_replace_write(1);
|
2014-10-21 23:14:01 +08:00
|
|
|
if(rtio_o_underflow_read()) {
|
2014-11-30 00:13:54 +08:00
|
|
|
rtio_o_underflow_reset_write(1);
|
2014-09-26 17:24:45 +08:00
|
|
|
exception_raise(EID_RTIO_UNDERFLOW);
|
2014-10-10 20:12:22 +08:00
|
|
|
}
|
2014-09-11 23:14:45 +08:00
|
|
|
}
|
|
|
|
|
2014-11-21 04:32:56 +08:00
|
|
|
long long int rtio_get_counter(void)
|
|
|
|
{
|
|
|
|
rtio_counter_update_write(1);
|
|
|
|
return rtio_counter_read();
|
|
|
|
}
|
|
|
|
|
2014-11-30 00:13:54 +08:00
|
|
|
long long int rtio_get(int channel, long long int time_limit)
|
2014-09-14 23:30:33 +08:00
|
|
|
{
|
|
|
|
long long int r;
|
|
|
|
|
|
|
|
rtio_chan_sel_write(channel);
|
2014-11-30 00:13:54 +08:00
|
|
|
while(rtio_i_readable_read() || (rtio_get_counter() < time_limit)) {
|
2014-10-21 23:41:02 +08:00
|
|
|
if(rtio_i_overflow_read()) {
|
2014-11-30 00:13:54 +08:00
|
|
|
rtio_i_overflow_reset_write(1);
|
2014-10-21 23:41:02 +08:00
|
|
|
exception_raise(EID_RTIO_OVERFLOW);
|
|
|
|
}
|
2014-09-14 23:30:33 +08:00
|
|
|
if(rtio_i_readable_read()) {
|
2014-10-14 15:54:10 +08:00
|
|
|
r = rtio_i_timestamp_read();
|
2014-09-14 23:30:33 +08:00
|
|
|
rtio_i_re_write(1);
|
|
|
|
return r;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return -1;
|
|
|
|
}
|
2014-10-14 12:47:04 +08:00
|
|
|
|
2014-10-21 23:14:01 +08:00
|
|
|
int rtio_pileup_count(int channel)
|
|
|
|
{
|
|
|
|
int r;
|
|
|
|
|
|
|
|
rtio_chan_sel_write(channel);
|
|
|
|
r = rtio_i_pileup_count_read();
|
|
|
|
rtio_i_pileup_reset_write(1);
|
|
|
|
return r;
|
|
|
|
}
|
|
|
|
|
2014-10-14 12:47:04 +08:00
|
|
|
#define RTIO_FUD_CHANNEL 4
|
|
|
|
|
|
|
|
void rtio_fud_sync(void)
|
|
|
|
{
|
2014-11-30 00:13:54 +08:00
|
|
|
while(rtio_get_counter() < previous_fud_end_time);
|
2014-10-14 12:47:04 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
void rtio_fud(long long int fud_time)
|
|
|
|
{
|
|
|
|
long long int fud_end_time;
|
|
|
|
|
|
|
|
rtio_chan_sel_write(RTIO_FUD_CHANNEL);
|
|
|
|
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);
|
2014-10-21 23:14:01 +08:00
|
|
|
if(rtio_o_underflow_read()) {
|
2014-11-30 00:13:54 +08:00
|
|
|
rtio_o_underflow_reset_write(1);
|
2014-10-14 12:47:04 +08:00
|
|
|
exception_raise(EID_RTIO_UNDERFLOW);
|
|
|
|
}
|
|
|
|
}
|