wrpll: simple ADPLL test

pull/1405/head
Sebastien Bourdeauducq 2019-12-31 12:12:03 +08:00
parent bb04b082a7
commit 3f32d78c0e
2 changed files with 20 additions and 0 deletions

View File

@ -262,6 +262,13 @@ mod si549 {
Ok(())
}
pub fn adpll(dcxo: i2c::Dcxo, adpll: i32) -> Result<(), &'static str> {
write(dcxo, 231, adpll as u8)?;
write(dcxo, 232, (adpll >> 8) as u8)?;
write(dcxo, 233, (adpll >> 16) as u8)?;
Ok(())
}
}
fn get_frequencies() -> (u32, u32, u32) {
@ -321,8 +328,19 @@ pub fn init() {
unsafe { csr::wrpll::helper_reset_write(0); }
clock::spin_us(1);
}
pub fn diagnostics() {
log_frequencies();
info!("ADPLL test:");
// +/-10ppm
si549::adpll(i2c::Dcxo::Helper, -85911).expect("ADPLL write failed");
si549::adpll(i2c::Dcxo::Main, 85911).expect("ADPLL write failed");
log_frequencies();
si549::adpll(i2c::Dcxo::Helper, 0).expect("ADPLL write failed");
si549::adpll(i2c::Dcxo::Main, 0).expect("ADPLL write failed");
let mut tags = [0; 10];
for i in 0..tags.len() {
tags[i] = get_ddmtd_main_tag();

View File

@ -463,6 +463,8 @@ pub extern fn main() -> i32 {
csr::drtio_transceiver::stable_clkin_write(1);
}
clock::spin_us(1500); // wait for CPLL/QPLL lock
#[cfg(has_wrpll)]
wrpll::diagnostics();
init_rtio_crg();
#[cfg(has_hmc830_7043)]