runtime: reset local DRTIO state

This commit is contained in:
Sebastien Bourdeauducq 2016-12-12 17:30:41 +08:00
parent 9a048c2b3a
commit 1c74249638
1 changed files with 19 additions and 7 deletions

View File

@ -42,7 +42,7 @@ mod drtio {
use board::csr;
use sched::{Scheduler, Waiter, Spawner};
pub fn init(scheduler: &Scheduler) {
pub fn startup(scheduler: &Scheduler) {
scheduler.spawner().spawn(4096, link_thread);
scheduler.spawner().spawn(4096, error_thread);
}
@ -64,7 +64,7 @@ mod drtio {
unsafe {
csr::drtio::chan_sel_override_write(channel);
csr::drtio::chan_sel_override_en_write(1);
csr::drtio::o_reset_channel_status_write(1);
csr::drtio::o_get_fifo_space_write(1);
while csr::drtio::o_wait_read() == 1 {}
@ -74,6 +74,18 @@ mod drtio {
}
}
pub fn init() {
if link_is_up() {
unsafe {
csr::drtio::reset_write(1);
while csr::drtio::o_wait_read() == 1 {}
}
for channel in 0..16 {
init_channel(channel);
}
}
}
pub fn link_thread(waiter: Waiter, _spawner: Spawner) {
loop {
waiter.until(link_is_up).unwrap();
@ -84,9 +96,7 @@ mod drtio {
sync_tsc();
info!("TSC synced");
for channel in 0..16 {
init_channel(channel);
}
init();
info!("link initialization completed");
waiter.until(|| !link_is_up()).unwrap();
@ -121,7 +131,8 @@ mod drtio {
mod drtio {
use sched::Scheduler;
pub fn init(_scheduler: &Scheduler) {}
pub fn startup(_scheduler: &Scheduler) {}
pub fn init() {}
}
pub fn startup(scheduler: &Scheduler) {
@ -150,7 +161,7 @@ pub fn startup(scheduler: &Scheduler) {
warn!("fix clocking and reset the device");
}
drtio::init(scheduler);
drtio::startup(scheduler);
init_core()
}
@ -158,4 +169,5 @@ pub fn init_core() {
unsafe {
csr::rtio_core::reset_write(1);
}
drtio::init()
}