69 lines
2.2 KiB
Rust
69 lines
2.2 KiB
Rust
use core::mem::MaybeUninit;
|
|
|
|
use embassy_futures::block_on;
|
|
|
|
use super::cmd::CmdSerial;
|
|
use super::consts::TlPacketType;
|
|
use super::evt::EvtBox;
|
|
use super::unsafe_linked_list::{LST_init_head, LST_is_empty, LST_remove_head};
|
|
use super::{
|
|
channels, BleTable, BLE_CMD_BUFFER, CS_BUFFER, EVT_QUEUE, HCI_ACL_DATA_BUFFER, TL_BLE_TABLE, TL_CHANNEL,
|
|
TL_REF_TABLE,
|
|
};
|
|
use crate::ipcc::Ipcc;
|
|
use crate::tl_mbox::cmd::CmdPacket;
|
|
|
|
pub struct Ble;
|
|
|
|
impl Ble {
|
|
pub(crate) fn new(ipcc: &mut Ipcc) -> Self {
|
|
unsafe {
|
|
LST_init_head(EVT_QUEUE.as_mut_ptr());
|
|
|
|
TL_BLE_TABLE = MaybeUninit::new(BleTable {
|
|
pcmd_buffer: BLE_CMD_BUFFER.as_mut_ptr().cast(),
|
|
pcs_buffer: CS_BUFFER.as_mut_ptr().cast(),
|
|
pevt_queue: EVT_QUEUE.as_ptr().cast(),
|
|
phci_acl_data_buffer: HCI_ACL_DATA_BUFFER.as_mut_ptr().cast(),
|
|
});
|
|
}
|
|
|
|
ipcc.c1_set_rx_channel(channels::cpu2::IPCC_BLE_EVENT_CHANNEL, true);
|
|
|
|
Ble
|
|
}
|
|
|
|
pub(crate) fn evt_handler(ipcc: &mut Ipcc) {
|
|
unsafe {
|
|
let mut node_ptr = core::ptr::null_mut();
|
|
let node_ptr_ptr: *mut _ = &mut node_ptr;
|
|
|
|
while !LST_is_empty(EVT_QUEUE.as_mut_ptr()) {
|
|
LST_remove_head(EVT_QUEUE.as_mut_ptr(), node_ptr_ptr);
|
|
|
|
let event = node_ptr.cast();
|
|
let event = EvtBox::new(event);
|
|
|
|
block_on(TL_CHANNEL.send(event));
|
|
}
|
|
}
|
|
|
|
ipcc.c1_clear_flag_channel(channels::cpu2::IPCC_BLE_EVENT_CHANNEL);
|
|
}
|
|
|
|
pub(crate) fn send_cmd(ipcc: &mut Ipcc, buf: &[u8]) {
|
|
unsafe {
|
|
let pcmd_buffer: *mut CmdPacket = (*TL_REF_TABLE.assume_init().ble_table).pcmd_buffer;
|
|
let pcmd_serial: *mut CmdSerial = &mut (*pcmd_buffer).cmd_serial;
|
|
let pcmd_serial_buf: *mut u8 = pcmd_serial.cast();
|
|
|
|
core::ptr::copy(buf.as_ptr(), pcmd_serial_buf, buf.len());
|
|
|
|
let mut cmd_packet = &mut *(*TL_REF_TABLE.assume_init().ble_table).pcmd_buffer;
|
|
cmd_packet.cmd_serial.ty = TlPacketType::BleCmd as u8;
|
|
}
|
|
|
|
ipcc.c1_set_flag_channel(channels::cpu1::IPCC_BLE_CMD_CHANNEL);
|
|
}
|
|
}
|