2020-04-11 20:19:39 +08:00
|
|
|
#![no_std]
|
|
|
|
#![no_main]
|
2023-02-22 11:02:43 +08:00
|
|
|
#![recursion_limit = "1024"] // for futures_util::select!
|
2020-07-02 13:10:11 +08:00
|
|
|
#![feature(alloc_error_handler)]
|
2020-07-25 12:12:56 +08:00
|
|
|
#![feature(const_btree_new)]
|
2023-09-04 16:04:42 +08:00
|
|
|
#![feature(panic_info_message)]
|
2020-04-11 20:19:39 +08:00
|
|
|
|
2023-01-09 12:35:56 +08:00
|
|
|
#[macro_use]
|
2020-04-11 20:19:39 +08:00
|
|
|
extern crate alloc;
|
|
|
|
|
2023-10-25 11:45:13 +08:00
|
|
|
#[cfg(all(feature = "target_kasli_soc", has_drtio))]
|
2023-08-28 16:08:10 +08:00
|
|
|
use core::cell::RefCell;
|
|
|
|
|
2023-09-05 16:21:39 +08:00
|
|
|
use ksupport;
|
2023-09-04 16:04:42 +08:00
|
|
|
use libasync::task;
|
2023-10-11 17:56:30 +08:00
|
|
|
#[cfg(has_drtio_eem)]
|
|
|
|
use libboard_artiq::drtio_eem;
|
2023-10-25 11:45:13 +08:00
|
|
|
#[cfg(all(feature = "target_kasli_soc", has_drtio))]
|
2023-02-22 11:02:43 +08:00
|
|
|
use libboard_artiq::io_expander;
|
|
|
|
use libboard_artiq::{identifier_read, logger, pl};
|
|
|
|
use libboard_zynq::{gic, mpcore, timer::GlobalTimer};
|
|
|
|
use libconfig::Config;
|
|
|
|
use libcortex_a9::l2c::enable_l2_cache;
|
2024-03-07 12:47:16 +08:00
|
|
|
use libsupport_zynq::{exception_vectors, ram};
|
2023-09-04 16:04:42 +08:00
|
|
|
use log::{info, warn};
|
2022-06-20 17:41:08 +08:00
|
|
|
|
2023-02-22 11:02:43 +08:00
|
|
|
mod analyzer;
|
2020-04-13 13:48:08 +08:00
|
|
|
mod comms;
|
2023-09-04 16:04:42 +08:00
|
|
|
|
2023-02-22 11:02:43 +08:00
|
|
|
mod mgmt;
|
|
|
|
mod moninj;
|
|
|
|
mod panic;
|
|
|
|
mod proto_async;
|
2023-09-04 16:04:42 +08:00
|
|
|
mod rpc_async;
|
2021-11-29 11:17:59 +08:00
|
|
|
mod rtio_clocking;
|
2023-03-27 15:47:54 +08:00
|
|
|
mod rtio_dma;
|
2023-03-27 15:53:32 +08:00
|
|
|
mod rtio_mgt;
|
2023-08-31 17:36:01 +08:00
|
|
|
#[cfg(has_drtio)]
|
|
|
|
mod subkernel;
|
2020-07-08 19:58:13 +08:00
|
|
|
|
2024-03-07 12:47:16 +08:00
|
|
|
// linker symbols
|
|
|
|
extern "C" {
|
|
|
|
static __exceptions_start: u32;
|
|
|
|
}
|
|
|
|
|
2023-10-25 11:45:13 +08:00
|
|
|
#[cfg(all(feature = "target_kasli_soc", has_drtio))]
|
2023-08-28 16:08:10 +08:00
|
|
|
async fn io_expanders_service(
|
|
|
|
i2c_bus: RefCell<&mut libboard_zynq::i2c::I2c>,
|
|
|
|
io_expander0: RefCell<io_expander::IoExpander>,
|
|
|
|
io_expander1: RefCell<io_expander::IoExpander>,
|
|
|
|
) {
|
|
|
|
loop {
|
|
|
|
task::r#yield().await;
|
|
|
|
io_expander0
|
|
|
|
.borrow_mut()
|
|
|
|
.service(&mut i2c_bus.borrow_mut())
|
|
|
|
.expect("I2C I/O expander #0 service failed");
|
|
|
|
io_expander1
|
|
|
|
.borrow_mut()
|
|
|
|
.service(&mut i2c_bus.borrow_mut())
|
|
|
|
.expect("I2C I/O expander #1 service failed");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-10-12 16:44:36 +08:00
|
|
|
#[cfg(has_grabber)]
|
|
|
|
mod grabber {
|
|
|
|
use libasync::delay;
|
|
|
|
use libboard_artiq::grabber;
|
|
|
|
use libboard_zynq::time::Milliseconds;
|
2023-10-18 11:56:38 +08:00
|
|
|
|
2023-10-18 11:24:43 +08:00
|
|
|
use crate::GlobalTimer;
|
|
|
|
pub async fn grabber_thread(timer: GlobalTimer) {
|
2023-10-12 16:44:36 +08:00
|
|
|
let mut countdown = timer.countdown();
|
|
|
|
loop {
|
|
|
|
grabber::tick();
|
|
|
|
delay(&mut countdown, Milliseconds(200)).await;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-02-22 11:02:43 +08:00
|
|
|
static mut LOG_BUFFER: [u8; 1 << 17] = [0; 1 << 17];
|
2020-07-13 14:59:56 +08:00
|
|
|
|
2020-07-08 19:58:13 +08:00
|
|
|
#[no_mangle]
|
|
|
|
pub fn main_core0() {
|
2024-03-07 12:47:16 +08:00
|
|
|
unsafe {
|
|
|
|
exception_vectors::set_vector_table(&__exceptions_start as *const u32 as u32);
|
|
|
|
}
|
2021-01-26 12:38:09 +08:00
|
|
|
enable_l2_cache(0x8);
|
2020-07-23 05:58:55 +08:00
|
|
|
let mut timer = GlobalTimer::start();
|
2020-07-13 14:59:56 +08:00
|
|
|
|
2023-02-22 11:02:43 +08:00
|
|
|
let buffer_logger = unsafe { logger::BufferLogger::new(&mut LOG_BUFFER[..]) };
|
2020-09-01 17:11:21 +08:00
|
|
|
buffer_logger.set_uart_log_level(log::LevelFilter::Info);
|
2020-07-13 14:59:56 +08:00
|
|
|
buffer_logger.register();
|
2020-09-01 17:11:21 +08:00
|
|
|
log::set_max_level(log::LevelFilter::Info);
|
2020-07-13 14:59:56 +08:00
|
|
|
|
2020-07-08 19:58:13 +08:00
|
|
|
info!("NAR3/Zynq7000 starting...");
|
|
|
|
|
2020-08-04 10:15:57 +08:00
|
|
|
ram::init_alloc_core0();
|
2020-08-18 01:17:15 +08:00
|
|
|
gic::InterruptController::gic(mpcore::RegisterBlock::mpcore()).enable_interrupts();
|
2020-07-08 19:58:13 +08:00
|
|
|
|
2022-10-21 12:08:11 +08:00
|
|
|
info!("gateware ident: {}", identifier_read(&mut [0; 64]));
|
2020-09-06 00:11:19 +08:00
|
|
|
|
2023-09-05 16:21:39 +08:00
|
|
|
ksupport::i2c::init();
|
2023-10-25 11:45:13 +08:00
|
|
|
#[cfg(all(feature = "target_kasli_soc", has_drtio))]
|
2023-02-15 17:44:01 +08:00
|
|
|
{
|
2023-10-25 11:52:04 +08:00
|
|
|
let i2c_bus = unsafe { (ksupport::i2c::I2C_BUS).as_mut().unwrap() };
|
|
|
|
let mut io_expander0 = io_expander::IoExpander::new(i2c_bus, 0).unwrap();
|
|
|
|
let mut io_expander1 = io_expander::IoExpander::new(i2c_bus, 1).unwrap();
|
2023-08-28 16:08:10 +08:00
|
|
|
io_expander0
|
|
|
|
.init(i2c_bus)
|
|
|
|
.expect("I2C I/O expander #0 initialization failed");
|
|
|
|
io_expander1
|
|
|
|
.init(i2c_bus)
|
|
|
|
.expect("I2C I/O expander #1 initialization failed");
|
2023-09-06 10:53:26 +08:00
|
|
|
// Drive TX_DISABLE to false on SFP0..3
|
2023-08-28 16:08:10 +08:00
|
|
|
io_expander0.set(0, 1, false);
|
|
|
|
io_expander1.set(0, 1, false);
|
|
|
|
io_expander0.set(1, 1, false);
|
|
|
|
io_expander1.set(1, 1, false);
|
|
|
|
io_expander0.service(i2c_bus).unwrap();
|
|
|
|
io_expander1.service(i2c_bus).unwrap();
|
2023-10-25 11:52:04 +08:00
|
|
|
task::spawn(io_expanders_service(
|
|
|
|
RefCell::new(i2c_bus),
|
|
|
|
RefCell::new(io_expander0),
|
|
|
|
RefCell::new(io_expander1),
|
|
|
|
));
|
2023-02-15 17:44:01 +08:00
|
|
|
}
|
|
|
|
|
2020-09-01 14:43:16 +08:00
|
|
|
let cfg = match Config::new() {
|
2020-07-08 19:24:26 +08:00
|
|
|
Ok(cfg) => cfg,
|
|
|
|
Err(err) => {
|
|
|
|
warn!("config initialization failed: {}", err);
|
2020-09-01 14:43:16 +08:00
|
|
|
Config::new_dummy()
|
2020-07-08 19:24:26 +08:00
|
|
|
}
|
|
|
|
};
|
2023-02-22 11:02:43 +08:00
|
|
|
|
2021-11-29 11:17:59 +08:00
|
|
|
rtio_clocking::init(&mut timer, &cfg);
|
2021-10-06 13:05:45 +08:00
|
|
|
|
2023-10-10 10:47:24 +08:00
|
|
|
#[cfg(has_drtio_eem)]
|
|
|
|
drtio_eem::init(&mut timer, &cfg);
|
|
|
|
|
2023-10-12 16:44:36 +08:00
|
|
|
#[cfg(has_grabber)]
|
|
|
|
task::spawn(grabber::grabber_thread(timer));
|
|
|
|
|
2023-09-05 16:21:39 +08:00
|
|
|
task::spawn(ksupport::report_async_rtio_errors());
|
2020-07-08 19:58:13 +08:00
|
|
|
|
2023-02-15 18:14:05 +08:00
|
|
|
comms::main(timer, cfg);
|
2020-04-11 20:19:39 +08:00
|
|
|
}
|