use crate::status::Status;
use super::RxBw;
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
pub enum ZigbeeMode {
Oqpsk250 = 0,
Oqpsk100 = 1,
Oqpsk25 = 2,
Bpsk20 = 3,
Bpsk40 = 4,
}
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
pub enum FcsMode {
FcsOn = 0,
FcsInFifo = 1,
}
pub fn set_zigbee_params_cmd(zigbee_mode: ZigbeeMode, rx_bw: RxBw, pld_len: u8, pbl_len_tx: u16, addr_filt_en: bool, fcs_mode: FcsMode) -> [u8; 8] {
let mut cmd = [0u8; 8];
cmd[0] = 0x02;
cmd[1] = 0x9F;
cmd[2] |= zigbee_mode as u8;
cmd[3] |= rx_bw as u8;
cmd[4] |= pld_len;
cmd[5] |= ((pbl_len_tx >> 8) & 0xFF) as u8;
cmd[6] |= (pbl_len_tx & 0xFF) as u8;
if addr_filt_en { cmd[7] |= 4; }
cmd[7] |= (fcs_mode as u8) & 0x1;
cmd
}
pub fn get_zigbee_packet_status_req() -> [u8; 2] {
[0x02, 0xA1]
}
pub fn set_zigbee_packet_len_cmd(pld_len: u8) -> [u8; 3] {
let mut cmd = [0u8; 3];
cmd[0] = 0x02;
cmd[1] = 0xA2;
cmd[2] |= pld_len;
cmd
}
pub fn set_zigbee_address_cmd(long_dest_addr: u64, short_dest_addr: u16, pan_id: u16, trans_id: u8) -> [u8; 15] {
let mut cmd = [0u8; 15];
cmd[0] = 0x02;
cmd[1] = 0xA3;
cmd[2] |= ((long_dest_addr >> 56) & 0xFF) as u8;
cmd[3] |= ((long_dest_addr >> 48) & 0xFF) as u8;
cmd[4] |= ((long_dest_addr >> 40) & 0xFF) as u8;
cmd[5] |= ((long_dest_addr >> 32) & 0xFF) as u8;
cmd[6] |= ((long_dest_addr >> 24) & 0xFF) as u8;
cmd[7] |= ((long_dest_addr >> 16) & 0xFF) as u8;
cmd[8] |= ((long_dest_addr >> 8) & 0xFF) as u8;
cmd[9] |= (long_dest_addr & 0xFF) as u8;
cmd[10] |= ((short_dest_addr >> 8) & 0xFF) as u8;
cmd[11] |= (short_dest_addr & 0xFF) as u8;
cmd[12] |= ((pan_id >> 8) & 0xFF) as u8;
cmd[13] |= (pan_id & 0xFF) as u8;
cmd[14] |= trans_id;
cmd
}
pub fn get_zigbee_rx_stats_req() -> [u8; 2] {
[0x02, 0xA0]
}
#[derive(Default)]
pub struct ZigbeePacketStatusRsp([u8; 9]);
impl ZigbeePacketStatusRsp {
pub fn new() -> Self {
Self::default()
}
pub fn status(&mut self) -> Status {
Status::from_slice(&self.0[..2])
}
pub fn rx_header(&self) -> u8 {
self.0[2]
}
pub fn pkt_len(&self) -> u16 {
(self.0[4] as u16) |
((self.0[3] as u16) << 8)
}
pub fn rssi_avg(&self) -> u16 {
(((self.0[7] >> 2) & 0x1) as u16) |
((self.0[5] as u16) << 1)
}
pub fn rssi_sync(&self) -> u16 {
((self.0[7] & 0x1) as u16) |
((self.0[6] as u16) << 1)
}
pub fn lqi(&self) -> u8 {
self.0[8]
}
}
impl AsMut<[u8]> for ZigbeePacketStatusRsp {
fn as_mut(&mut self) -> &mut [u8] {
&mut self.0
}
}
#[derive(Default)]
pub struct ZigbeeRxStatsRsp([u8; 8]);
impl ZigbeeRxStatsRsp {
pub fn new() -> Self {
Self::default()
}
pub fn status(&mut self) -> Status {
Status::from_slice(&self.0[..2])
}
pub fn pkt_rx(&self) -> u16 {
(self.0[3] as u16) |
((self.0[2] as u16) << 8)
}
pub fn crc_error(&self) -> u16 {
(self.0[5] as u16) |
((self.0[4] as u16) << 8)
}
pub fn len_error(&self) -> u16 {
(self.0[7] as u16) |
((self.0[6] as u16) << 8)
}
}
impl AsMut<[u8]> for ZigbeeRxStatsRsp {
fn as_mut(&mut self) -> &mut [u8] {
&mut self.0
}
}