use csr;

pub fn wait_init() {
    info!("waiting for AMC/RTM serwb bridge to be ready...");
    unsafe {
        csr::serwb_phy_amc::control_reset_write(1);
        while csr::serwb_phy_amc::control_ready_read() == 0 {
            if csr::serwb_phy_amc::control_error_read() == 1 {
                warn!("AMC/RTM serwb bridge initialization failed, retrying.");
                csr::serwb_phy_amc::control_reset_write(1);
            }
        }
    }
    info!("done.");

    // Try reading the identifier register on the other side of the bridge.
    let rtm_identifier = unsafe {
        csr::rtm_identifier::identifier_read()
    };
    if rtm_identifier != 0x5352544d {
        error!("incorrect RTM identifier: 0x{:08x}", rtm_identifier);
        // proceed anyway
    }

    unsafe {
        debug!("AMC serwb settings:");
        debug!("  delay_min_found: {}", csr::serwb_phy_amc::control_delay_min_found_read());
        debug!("  delay_min: {}", csr::serwb_phy_amc::control_delay_min_read());
        debug!("  delay_max_found: {}", csr::serwb_phy_amc::control_delay_max_found_read());
        debug!("  delay_max: {}", csr::serwb_phy_amc::control_delay_max_read());
        debug!("  delay: {}", csr::serwb_phy_amc::control_delay_read());
        debug!("  bitslip: {}", csr::serwb_phy_amc::control_bitslip_read());
        debug!("  ready: {}", csr::serwb_phy_amc::control_ready_read());
        debug!("  error: {}", csr::serwb_phy_amc::control_error_read());

        debug!("RTM serwb settings:");
        debug!("  delay_min_found: {}", csr::serwb_phy_rtm::control_delay_min_found_read());
        debug!("  delay_min: {}", csr::serwb_phy_rtm::control_delay_min_read());
        debug!("  delay_max_found: {}", csr::serwb_phy_rtm::control_delay_max_found_read());
        debug!("  delay_max: {}", csr::serwb_phy_rtm::control_delay_max_read());
        debug!("  delay: {}", csr::serwb_phy_rtm::control_delay_read());
        debug!("  bitslip: {}", csr::serwb_phy_rtm::control_bitslip_read());
        debug!("  ready: {}", csr::serwb_phy_rtm::control_ready_read());
        debug!("  error: {}", csr::serwb_phy_rtm::control_error_read());
    }
}