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 { &*esp32s3::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 { &*esp32s3::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 { &*esp32s3::APB_CTRL::PTR };
syscon
.wifi_rst_en()
.modify(|r, w| unsafe { w.bits(r.bits() | SYSTEM_MAC_RST) });
syscon
.wifi_rst_en()
.modify(|r, w| unsafe { w.bits(r.bits() & !SYSTEM_MAC_RST) });
}
fn init_clocks() {
let syscon = unsafe { &*esp32s3::APB_CTRL::PTR };
const SYSTEM_WIFI_CLK_I2C_CLK_EN: u32 = 1 << 5;
const SYSTEM_WIFI_CLK_UNUSED_BIT12: u32 = 1 << 12;
const SYSTEM_WIFI_CLK_SDIO_HOST_EN: u32 = 1 << 13;
const WIFI_BT_SDIO_CLK: u32 =
SYSTEM_WIFI_CLK_I2C_CLK_EN | SYSTEM_WIFI_CLK_UNUSED_BIT12 | SYSTEM_WIFI_CLK_SDIO_HOST_EN;
syscon
.wifi_clk_en()
.modify(|r, w| unsafe { w.bits(r.bits() & !WIFI_BT_SDIO_CLK | SYSTEM_WIFI_CLK_EN) });
}