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
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
extern crate alloc;
use alloc::vec;
use alloc::vec::Vec;
use core::convert::TryInto;
use core::mem::{size_of};
use cortex_m::prelude::*;
use stm32f1xx_hal_bxcan::delay::Delay;
use eeprom24x::Eeprom24x;
use eeprom24x::page_size::B32;
use eeprom24x::addr_size::TwoBytes;
use ross_config::event_processor::EventProcessor;
use device_info::*;
use event_processor::*;
pub mod device_info;
pub mod event_processor;
#[repr(C)]
#[derive(Debug, PartialEq)]
pub struct DeviceInfo {
pub device_address: u16,
pub firmware_version: u32,
pub event_processor_info_address: u32,
}
#[derive(Debug)]
pub struct Eeprom<I2C, PS, AS> {
driver: Eeprom24x<I2C, PS, AS>,
device_info_address: u32,
}
pub enum EepromError {
Eeprom24xError(eeprom24x::Error<nb::Error<stm32f1xx_hal_bxcan::i2c::Error>>),
DeviceInfoError(DeviceInfoError),
EventProcessorError(EventProcessorError),
}
impl<I2C> Eeprom<I2C, B32, TwoBytes> where
I2C: _embedded_hal_blocking_i2c_WriteRead<Error = nb::Error<stm32f1xx_hal_bxcan::i2c::Error>> + _embedded_hal_blocking_i2c_Write<Error = nb::Error<stm32f1xx_hal_bxcan::i2c::Error>>,
{
pub fn new(driver: Eeprom24x<I2C, B32, TwoBytes>, device_info_address: u32) -> Self {
Self {
driver,
device_info_address,
}
}
pub fn read_device_info(&mut self) -> Result<DeviceInfo, EepromError> {
let mut data = vec!();
data.resize(size_of::<DeviceInfo>(), 0x00);
self.read_data(self.device_info_address, &mut data)?;
match DeviceInfoReader::read_from_vec(&data) {
Ok(device_info) => Ok(device_info),
Err(err) => Err(EepromError::DeviceInfoError(err)),
}
}
pub fn write_device_info(&mut self, device_info: &DeviceInfo, delay: &mut Delay) -> Result<(), EepromError> {
let mut data = vec!();
if let Err(err) = DeviceInfoWriter::write_to_vec(&mut data, device_info) {
return Err(EepromError::DeviceInfoError(err));
}
self.write_data(self.device_info_address, &data, delay)?;
Ok(())
}
pub fn read_event_processors(&mut self) -> Result<Vec<EventProcessor>, EepromError> {
let device_info = self.read_device_info()?;
let mut data = [0u8; size_of::<u32>()];
self.read_data(device_info.event_processor_info_address, &mut data)?;
let data_len = u32::from_be_bytes(data[0..=3].try_into().unwrap());
let mut data = vec!();
data.resize(data_len as usize, 0x00);
self.read_data(device_info.event_processor_info_address + size_of::<u32>() as u32, &mut data)?;
match EventProcessorReader::read_from_vec(&data) {
Ok(event_processors) => Ok(event_processors),
Err(err) => Err(EepromError::EventProcessorError(err)),
}
}
pub fn write_event_processors(&mut self, event_processors: &Vec<EventProcessor>, delay: &mut Delay) -> Result<(), EepromError> {
let mut data = vec!();
if let Err(err) = EventProcessorWriter::write_to_vec(&mut data, event_processors) {
return Err(EepromError::EventProcessorError(err));
}
for (i, byte) in u32::to_be_bytes(data.len() as u32).iter().enumerate() {
data.insert(i, *byte);
}
self.write_data(self.device_info_address, &data, delay)?;
Ok(())
}
pub fn read_data(&mut self, address: u32, data: &mut [u8]) -> Result<(), EepromError> {
loop {
match self.driver.read_data(address, data) {
Err(eeprom24x::Error::I2C(nb::Error::WouldBlock)) => continue,
Err(err) => return Err(EepromError::Eeprom24xError(err)),
Ok(_) => return Ok(()),
}
}
}
pub fn write_data(&mut self, address: u32, data: &[u8], delay: &mut Delay) -> Result<(), EepromError> {
let (page_count, slice_offset): (usize, usize) = if address % 8 == 0 {
(
(data.len() - 1) / 8 + 1,
0
)
} else {
(
data.len() / 8,
8 - (address as usize % 8),
)
};
if slice_offset != 0 {
let slice_end = if data.len() > slice_offset {
slice_offset
} else {
data.len()
};
loop {
match self.driver.write_page(address, &data[0..slice_end]) {
Err(eeprom24x::Error::I2C(nb::Error::WouldBlock)) => continue,
Err(err) => return Err(EepromError::Eeprom24xError(err)),
Ok(_) => break,
}
}
delay.delay_ms(5u32);
}
for i in 0..page_count {
let slice_start = i * 8 + slice_offset;
let slice_end = if i == page_count - 1 {
data.len()
} else {
(i + 1) * 8 + slice_offset
};
loop {
match self.driver.write_page(address + (slice_start as u32), &data[slice_start..slice_end]) {
Err(eeprom24x::Error::I2C(nb::Error::WouldBlock)) => continue,
Err(err) => return Err(EepromError::Eeprom24xError(err)),
Ok(_) => break,
}
}
delay.delay_ms(5u32);
}
Ok(())
}
}