dma: request RTIO control

This commit is contained in:
Sebastien Bourdeauducq 2017-03-01 18:59:45 +08:00
parent 553b8046ff
commit 0b4922e0f4
1 changed files with 14 additions and 0 deletions

View File

@ -301,6 +301,18 @@ extern fn dma_erase(name: CSlice<u8>) {
send(&DmaEraseRequest(name)); send(&DmaEraseRequest(name));
} }
unsafe fn rtio_arb_dma() {
csr::rtio::arb_req_write(0);
csr::rtio_dma::arb_req_write(1);
while csr::rtio_dma::arb_gnt_read() == 0 {}
}
unsafe fn rtio_arb_regular() {
csr::rtio_dma::arb_req_write(0);
csr::rtio::arb_req_write(1);
while csr::rtio::arb_gnt_read() == 0 {}
}
extern fn dma_playback(timestamp: i64, name: CSlice<u8>) { extern fn dma_playback(timestamp: i64, name: CSlice<u8>) {
let name = str::from_utf8(name.as_ref()).unwrap(); let name = str::from_utf8(name.as_ref()).unwrap();
@ -312,8 +324,10 @@ extern fn dma_playback(timestamp: i64, name: CSlice<u8>) {
csr::rtio_dma::base_address_write(data.as_ptr() as u64); csr::rtio_dma::base_address_write(data.as_ptr() as u64);
csr::rtio_dma::time_offset_write(timestamp as u64); csr::rtio_dma::time_offset_write(timestamp as u64);
rtio_arb_dma();
csr::rtio_dma::enable_write(1); csr::rtio_dma::enable_write(1);
while csr::rtio_dma::enable_read() != 0 {} while csr::rtio_dma::enable_read() != 0 {}
rtio_arb_regular();
let status = csr::rtio_dma::error_status_read(); let status = csr::rtio_dma::error_status_read();
let timestamp = csr::rtio_dma::error_timestamp_read(); let timestamp = csr::rtio_dma::error_timestamp_read();