use crate::interface::InterfaceClass;
use crate::obis::ObisCode;
use crate::types::{BerError, CosemDataType};
use serde::{Deserialize, Serialize};
use std::any::Any;
pub mod control_state {
pub const DISCONNECTED: u8 = 0;
pub const CONNECTED: u8 = 1;
pub const READY_FOR_RECONNECTION: u8 = 2;
}
#[derive(Clone, Serialize, Deserialize, Debug)]
pub struct DisconnectControlConfig {
pub logical_name: ObisCode,
pub output_state: bool,
pub control_state: u8,
pub control_mode: u8,
}
#[derive(Clone, Serialize, Deserialize, Debug)]
pub struct DisconnectControl {
logical_name: ObisCode,
output_state: bool,
control_state: u8,
control_mode: u8,
}
impl DisconnectControl {
pub fn new(config: DisconnectControlConfig) -> Self {
DisconnectControl {
logical_name: config.logical_name,
output_state: config.output_state,
control_state: config.control_state,
control_mode: config.control_mode,
}
}
fn remote_disconnect(&mut self) -> CosemDataType {
if self.control_mode > 0 {
self.control_state = control_state::DISCONNECTED;
self.output_state = false;
}
CosemDataType::Null
}
fn remote_reconnect(&mut self) -> CosemDataType {
match self.control_mode {
2 | 4 => {
self.control_state = control_state::CONNECTED;
self.output_state = true;
}
1 | 3 | 5 | 6 => {
self.control_state = control_state::READY_FOR_RECONNECTION;
self.output_state = false;
}
_ => {}
}
CosemDataType::Null
}
}
impl InterfaceClass for DisconnectControl {
fn class_id(&self) -> u16 {
70
}
fn version(&self) -> u8 {
0
}
fn logical_name(&self) -> &ObisCode {
&self.logical_name
}
fn attributes(&self) -> Vec<(u8, CosemDataType)> {
vec![
(1, CosemDataType::OctetString(self.logical_name.to_bytes())),
(2, CosemDataType::Boolean(self.output_state)),
(3, CosemDataType::Enum(self.control_state)),
(4, CosemDataType::Enum(self.control_mode)),
]
}
fn methods(&self) -> Vec<(u8, String)> {
vec![(1, "remote_disconnect".to_string()), (2, "remote_reconnect".to_string())]
}
fn serialize_ber(&self, buf: &mut Vec<u8>) -> Result<(), BerError> {
let mut seq_buf = Vec::new();
CosemDataType::LongUnsigned(self.class_id()).serialize_ber(&mut seq_buf)?;
for (_, attr) in self.attributes() {
attr.serialize_ber(&mut seq_buf)?;
}
buf.push(0x02); write_length(1 + self.attributes().len(), buf); buf.extend_from_slice(&seq_buf);
Ok(())
}
fn deserialize_ber(&mut self, data: &[u8]) -> Result<(), BerError> {
let (tlv, rest) = CosemDataType::deserialize_ber(data)?;
if !rest.is_empty() {
return Err(BerError::InvalidTag);
}
let CosemDataType::Structure(seq) = tlv else {
return Err(BerError::InvalidTag);
};
if seq.len() != 5 {
return Err(BerError::InvalidLength);
}
if let CosemDataType::LongUnsigned(class_id) = seq[0] {
if class_id != self.class_id() {
return Err(BerError::InvalidValue);
}
} else {
return Err(BerError::InvalidTag);
}
if let CosemDataType::OctetString(obis) = &seq[1] {
if obis.len() == 6 {
self.logical_name = ObisCode::new(obis[0], obis[1], obis[2], obis[3], obis[4], obis[5]);
} else {
return Err(BerError::InvalidLength);
}
} else {
return Err(BerError::InvalidTag);
}
self.output_state = match seq[2] {
CosemDataType::Boolean(v) => v,
_ => return Err(BerError::InvalidTag),
};
self.control_state = match seq[3] {
CosemDataType::Enum(v) => v,
_ => return Err(BerError::InvalidTag),
};
self.control_mode = match seq[4] {
CosemDataType::Enum(v) => v,
_ => return Err(BerError::InvalidTag),
};
Ok(())
}
fn set_attribute(&mut self, attribute_id: u8, value: CosemDataType) -> Result<(), String> {
match attribute_id {
4 => match value {
CosemDataType::Enum(v) => {
self.control_mode = v;
Ok(())
}
_ => Err("control_mode must be enum".into()),
},
_ => Err(format!("DisconnectControl attribute {attribute_id} is not writable")),
}
}
fn invoke_method(&mut self, method_id: u8, _params: Option<CosemDataType>) -> Result<CosemDataType, String> {
match method_id {
1 => Ok(self.remote_disconnect()),
2 => Ok(self.remote_reconnect()),
_ => Err(format!("Method {method_id} not supported for Disconnect control")),
}
}
fn as_any(&self) -> &dyn Any {
self
}
}
#[allow(clippy::cast_possible_truncation)] fn write_length(length: usize, buf: &mut Vec<u8>) {
if length < 128 {
buf.push(length as u8);
} else {
let bytes = (length as u64).to_be_bytes();
let first_non_zero = bytes.iter().position(|&b| b != 0).unwrap_or(7);
let num_octets = 8 - first_non_zero;
buf.push(0x80 | num_octets as u8);
buf.extend_from_slice(&bytes[first_non_zero..]);
}
}
#[cfg(test)]
mod tests {
use super::*;
fn sample(control_mode: u8) -> DisconnectControl {
DisconnectControl::new(DisconnectControlConfig {
logical_name: ObisCode::new(0, 0, 96, 3, 10, 255),
output_state: true,
control_state: control_state::CONNECTED,
control_mode,
})
}
#[test]
fn class_id_and_attributes() {
let obj = sample(1);
assert_eq!(obj.class_id(), 70);
assert_eq!(obj.version(), 0);
assert_eq!(obj.attributes().len(), 4);
assert_eq!(obj.methods().len(), 2);
}
#[test]
fn round_trip() {
let obj = sample(2);
let mut buf = Vec::new();
obj.serialize_ber(&mut buf).unwrap();
let mut decoded = sample(0);
decoded.deserialize_ber(&buf).unwrap();
assert_eq!(decoded.attributes(), obj.attributes());
}
#[test]
fn disconnect_requires_enabled_mode() {
let mut obj = sample(0);
obj.invoke_method(1, None).unwrap();
assert_eq!(obj.attributes()[2].1, CosemDataType::Enum(control_state::CONNECTED));
let mut obj = sample(1);
obj.invoke_method(1, None).unwrap();
assert_eq!(obj.attributes()[2].1, CosemDataType::Enum(control_state::DISCONNECTED));
assert_eq!(obj.attributes()[1].1, CosemDataType::Boolean(false));
}
#[test]
fn reconnect_depends_on_control_mode() {
let mut obj = sample(2);
obj.control_state = control_state::DISCONNECTED;
obj.output_state = false;
obj.invoke_method(2, None).unwrap();
assert_eq!(obj.attributes()[2].1, CosemDataType::Enum(control_state::CONNECTED));
assert_eq!(obj.attributes()[1].1, CosemDataType::Boolean(true));
let mut obj = sample(3);
obj.control_state = control_state::DISCONNECTED;
obj.invoke_method(2, None).unwrap();
assert_eq!(obj.attributes()[2].1, CosemDataType::Enum(control_state::READY_FOR_RECONNECTION));
}
}