mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-16 08:38:26 +00:00
start moving clock routines into an API library
clock setting calls, for legacy reasons, are duplicated in all the stages of the bootloaders. This is a start toward moving these routines into a common set of calls that improves maintainability.
This commit is contained in:
parent
bd08328530
commit
31385a5599
1 changed files with 44 additions and 0 deletions
44
libs/bao1x-api/src/clocks.rs
Normal file
44
libs/bao1x-api/src/clocks.rs
Normal file
|
|
@ -0,0 +1,44 @@
|
|||
pub const FREQ_OSC_MHZ: u32 = 48;
|
||||
|
||||
/// This takes in the FD input frequency (the frequency to be divided) in MHz
|
||||
/// and the fd value, and returns the resulting divided frequency.
|
||||
/// *not tested*
|
||||
#[allow(dead_code)]
|
||||
pub fn fd_to_clk(fd_in_mhz: u32, fd_val: u32) -> u32 { (fd_in_mhz * (fd_val + 1)) / 256 }
|
||||
|
||||
/// Takes in the FD input frequencyin MHz, and then the desired frequency.
|
||||
/// Returns Some((fd value, deviation in *hz*, not MHz)) if the requirement is satisfiable
|
||||
/// Returns None if the equation is ill-formed.
|
||||
/// *not tested*
|
||||
#[allow(dead_code)]
|
||||
pub fn clk_to_fd(fd_in_mhz: u32, desired_mhz: u32) -> Option<(u32, i32)> {
|
||||
let platonic_fd: u32 = (desired_mhz * 256) / fd_in_mhz;
|
||||
if platonic_fd > 0 {
|
||||
let actual_fd = platonic_fd - 1;
|
||||
let actual_clk = fd_to_clk(fd_in_mhz, actual_fd);
|
||||
Some((actual_fd, desired_mhz as i32 - actual_clk as i32))
|
||||
} else {
|
||||
None
|
||||
}
|
||||
}
|
||||
|
||||
/// Takes in the top clock in MHz, desired perclk in MHz, and returns a tuple of
|
||||
/// (min cycle, fd, actual freq)
|
||||
/// *tested*
|
||||
pub fn clk_to_per(top_in_mhz: u32, perclk_in_mhz: u32) -> Option<(u8, u8, u32)> {
|
||||
let fd_platonic = ((256 * perclk_in_mhz) / (top_in_mhz / 2)).min(256);
|
||||
if fd_platonic > 0 {
|
||||
let fd = fd_platonic - 1;
|
||||
let min_cycle = (2 * (256 / (fd + 1))).max(1);
|
||||
let min_freq = top_in_mhz / min_cycle;
|
||||
let target_freq = top_in_mhz * (fd + 1) / 512;
|
||||
let actual_freq = target_freq.max(min_freq);
|
||||
if fd < 256 && min_cycle < 256 && min_cycle > 0 {
|
||||
Some(((min_cycle - 1) as u8, fd as u8, actual_freq))
|
||||
} else {
|
||||
None
|
||||
}
|
||||
} else {
|
||||
None
|
||||
}
|
||||
}
|
||||
Loading…
Reference in a new issue