blob: 9fc74759abaade3bdfdc6cee8de7c1695e5098c9 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
|
use core::mem;
use core::slice;
use heapless::Vec;
pub enum FromGattError {
InvalidLength,
}
pub trait FixedGattValue: Sized {
const SIZE: usize;
// Converts from gatt bytes.
// Must panic if and only if data.len != Self::SIZE
fn from_gatt(data: &[u8]) -> Self;
// Converts to gatt bytes.
// Must return a slice of len Self::SIZE
fn to_gatt(&self) -> &[u8];
}
pub trait GattValue: Sized {
const MIN_SIZE: usize;
const MAX_SIZE: usize;
// Converts from gatt bytes.
// Must panic if and only if data.len not in MIN_SIZE..=MAX_SIZE
fn from_gatt(data: &[u8]) -> Self;
// Converts to gatt bytes.
// Must return a slice of len in MIN_SIZE..=MAX_SIZE
fn to_gatt(&self) -> &[u8];
}
impl<T: FixedGattValue> GattValue for T {
const MIN_SIZE: usize = Self::SIZE;
const MAX_SIZE: usize = Self::SIZE;
fn from_gatt(data: &[u8]) -> Self {
<Self as FixedGattValue>::from_gatt(data)
}
fn to_gatt(&self) -> &[u8] {
<Self as FixedGattValue>::to_gatt(self)
}
}
pub unsafe trait Primitive: Copy {}
unsafe impl Primitive for u8 {}
unsafe impl Primitive for u16 {}
unsafe impl Primitive for u32 {}
unsafe impl Primitive for u64 {}
unsafe impl Primitive for i8 {}
unsafe impl Primitive for i16 {}
unsafe impl Primitive for i32 {}
unsafe impl Primitive for i64 {}
unsafe impl Primitive for f32 {}
unsafe impl Primitive for f64 {}
impl<T: Primitive> FixedGattValue for T {
const SIZE: usize = mem::size_of::<Self>();
fn from_gatt(data: &[u8]) -> Self {
if data.len() != Self::SIZE {
panic!("Bad len")
}
unsafe { *(data.as_ptr() as *const Self) }
}
fn to_gatt(&self) -> &[u8] {
unsafe { slice::from_raw_parts(self as *const Self as *const u8, Self::SIZE) }
}
}
impl<const N: usize> GattValue for Vec<u8, N> {
const MIN_SIZE: usize = 0;
const MAX_SIZE: usize = N;
fn from_gatt(data: &[u8]) -> Self {
unwrap!(Self::from_slice(data))
}
fn to_gatt(&self) -> &[u8] {
&self
}
}
|