bpmpfw: cleanup makefile and split hpp/cpp
This commit is contained in:
1 parent
e5240d835f
commit
3352dffc39
15 files changed
+464
-266
No files matched your search
@@ -32,64 +32,8 @@ namespace pllmb {
|
||||
|
||||
constexpr u32 PtoCyclePeriod = (1u << 31); // PTO_CLK_CNT_STATUS busy bit
|
||||
|
||||
inline u64 MeasurePtoHz(u32 ptoId, u32 divider, u32 preselReg, u32 preselMask) {
|
||||
u32 preselOrigBit = 0;
|
||||
u64 MeasurePtoHz(u32 ptoId, u32 divider, u32 preselReg, u32 preselMask);
|
||||
|
||||
if (preselReg) {
|
||||
u32 val = MMIO32(freq::CarBase + preselReg);
|
||||
usleep(10);
|
||||
preselOrigBit = val & preselMask;
|
||||
val &= ~preselMask;
|
||||
val |= preselMask;
|
||||
MMIO32(freq::CarBase + preselReg) = val;
|
||||
usleep(10);
|
||||
}
|
||||
|
||||
constexpr u32 cycleCount = 16;
|
||||
const u32 savedCntl = MMIO32(freq::CarBase + freq::CarPtoClkCntCntl);
|
||||
|
||||
u32 val = freq::PtoDivSelDiv1 | freq::PtoClkEnable | (cycleCount - 1);
|
||||
val |= ptoId << freq::PtoSrcSelShift;
|
||||
|
||||
MMIO32(freq::CarBase + freq::CarPtoClkCntCntl) = val;
|
||||
usleep(10);
|
||||
MMIO32(freq::CarBase + freq::CarPtoClkCntCntl) = val | freq::PtoCntRst;
|
||||
usleep(10);
|
||||
MMIO32(freq::CarBase + freq::CarPtoClkCntCntl) = val;
|
||||
usleep(10);
|
||||
MMIO32(freq::CarBase + freq::CarPtoClkCntCntl) = val | freq::PtoCntEn;
|
||||
usleep(500);
|
||||
|
||||
while (MMIO32(freq::CarBase + freq::CarPtoClkCntStatus) & PtoCyclePeriod)
|
||||
;
|
||||
|
||||
u32 cnt = MMIO32(freq::CarBase + freq::CarPtoClkCntStatus) & freq::PtoClkCntMask;
|
||||
cnt *= divider;
|
||||
|
||||
const u64 rateHz = (static_cast<u64>(cnt) * 32768) / cycleCount;
|
||||
|
||||
usleep(10);
|
||||
MMIO32(freq::CarBase + freq::CarPtoClkCntCntl) = savedCntl;
|
||||
usleep(10);
|
||||
|
||||
if (preselReg) {
|
||||
u32 val2 = MMIO32(freq::CarBase + preselReg);
|
||||
usleep(10);
|
||||
val2 &= ~preselMask;
|
||||
val2 |= preselOrigBit;
|
||||
MMIO32(freq::CarBase + preselReg) = val2;
|
||||
usleep(10);
|
||||
}
|
||||
|
||||
return rateHz;
|
||||
}
|
||||
|
||||
inline u64 MeasureRamClockHz() {
|
||||
const u64 pllmbHz = MeasurePtoHz(PtoPllmb, 2, PllmMisc2, PllmMisc2PllmbBit);
|
||||
if (pllmbHz != 0) {
|
||||
return pllmbHz;
|
||||
}
|
||||
return MeasurePtoHz(PtoPllm, 2, PllmMisc2, PllmMisc2PllmBit);
|
||||
}
|
||||
u64 MeasureRamClockHz();
|
||||
|
||||
} // namespace pllmb
|
||||
Reference in new issue
Block a user