use crate::system::{RadioClockControl, RadioClockController, RadioPeripherals};
const SYSTEM_WIFI_CLK_WIFI_BT_COMMON_M: u32 = 0x78078F;
const SYSTEM_WIFI_CLK_EN: u32 = 0x00FB9FCF;
impl RadioClockController for RadioClockControl {
fn enable(&mut self, peripheral: RadioPeripherals) {
match peripheral {
RadioPeripherals::Phy => enable_phy(),
RadioPeripherals::Bt => common_wifi_bt_clock_enable(),
RadioPeripherals::Wifi => common_wifi_bt_clock_enable(),
}
}
fn disable(&mut self, peripheral: RadioPeripherals) {
match peripheral {
RadioPeripherals::Phy => disable_phy(),
RadioPeripherals::Bt => common_wifi_bt_clock_disable(),
RadioPeripherals::Wifi => common_wifi_bt_clock_disable(),
}
}
fn reset_mac(&mut self) {
reset_mac();
}
fn init_clocks(&mut self) {
init_clocks();
}
fn ble_rtc_clk_init(&mut self) {
}
fn reset_rpa(&mut self) {
}
}
fn enable_phy() {
let syscon = unsafe { &*esp32c3::APB_CTRL::PTR };
syscon
.wifi_clk_en()
.modify(|r, w| unsafe { w.bits(r.bits() | SYSTEM_WIFI_CLK_WIFI_BT_COMMON_M) });
}
fn disable_phy() {
let syscon = unsafe { &*esp32c3::APB_CTRL::PTR };
syscon
.wifi_clk_en()
.modify(|r, w| unsafe { w.bits(r.bits() & !SYSTEM_WIFI_CLK_WIFI_BT_COMMON_M) });
}
fn common_wifi_bt_clock_enable() {
}
fn common_wifi_bt_clock_disable() {
}
fn reset_mac() {
const SYSTEM_MAC_RST: u32 = 1 << 2;
let syscon = unsafe { &*esp32c3::APB_CTRL::PTR };
syscon
.wifi_rst_en()
.modify(|r, w| unsafe { w.wifi_rst().bits(r.wifi_rst().bits() | SYSTEM_MAC_RST) });
syscon
.wifi_rst_en()
.modify(|r, w| unsafe { w.wifi_rst().bits(r.wifi_rst().bits() & !SYSTEM_MAC_RST) });
}
fn init_clocks() {
let rtc_cntl = unsafe { crate::peripherals::RTC_CNTL::steal() };
rtc_cntl
.dig_iso()
.modify(|_, w| w.wifi_force_iso().clear_bit().bt_force_iso().clear_bit());
rtc_cntl
.dig_pwc()
.modify(|_, w| w.wifi_force_pd().clear_bit().bt_force_pd().clear_bit());
const SYSTEM_WIFI_CLK_I2C_CLK_EN: u32 = 1 << 5;
const SYSTEM_WIFI_CLK_UNUSED_BIT12: u32 = 1 << 12;
const WIFI_BT_SDIO_CLK: u32 = SYSTEM_WIFI_CLK_I2C_CLK_EN | SYSTEM_WIFI_CLK_UNUSED_BIT12;
let syscon = unsafe { &*esp32c3::APB_CTRL::PTR };
syscon
.wifi_clk_en()
.modify(|r, w| unsafe { w.bits(r.bits() & !WIFI_BT_SDIO_CLK | SYSTEM_WIFI_CLK_EN) });
}