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
use crate::{marker, Error, Led, Max3010x, Register as Reg, TimeSlot};
use core::marker::PhantomData;
use hal::blocking::i2c;
impl<I2C, E, MODE> Max3010x<I2C, marker::ic::Max30102, MODE>
where
I2C: i2c::WriteRead<Error = E> + i2c::Write<Error = E>,
{
pub fn into_heart_rate(
mut self,
) -> Result<Max3010x<I2C, marker::ic::Max30102, marker::mode::HeartRate>, Error<E>> {
let mode = self.mode.with_low(0b0000_0101).with_high(0b0000_0010);
self.change_mode(mode)?;
self.clear_fifo()?;
let dev = Max3010x {
i2c: self.i2c,
temperature_measurement_started: self.temperature_measurement_started,
mode: self.mode,
fifo_config: self.fifo_config,
spo2_config: self.spo2_config,
int_en1: self.int_en1,
int_en2: self.int_en2,
_ic: PhantomData,
_mode: PhantomData,
};
Ok(dev)
}
pub fn into_oximeter(
mut self,
) -> Result<Max3010x<I2C, marker::ic::Max30102, marker::mode::Oximeter>, Error<E>> {
let mode = self.mode.with_low(0b0000_0100).with_high(0b0000_0011);
self.change_mode(mode)?;
self.clear_fifo()?;
let dev = Max3010x {
i2c: self.i2c,
temperature_measurement_started: self.temperature_measurement_started,
mode: self.mode,
fifo_config: self.fifo_config,
spo2_config: self.spo2_config,
int_en1: self.int_en1,
int_en2: self.int_en2,
_ic: PhantomData,
_mode: PhantomData,
};
Ok(dev)
}
pub fn into_multi_led(
mut self,
) -> Result<Max3010x<I2C, marker::ic::Max30102, marker::mode::MultiLED>, Error<E>> {
let mode = self.mode.with_high(0b0000_0111);
self.change_mode(mode)?;
self.clear_fifo()?;
let dev = Max3010x {
i2c: self.i2c,
temperature_measurement_started: self.temperature_measurement_started,
mode: self.mode,
fifo_config: self.fifo_config,
spo2_config: self.spo2_config,
int_en1: self.int_en1,
int_en2: self.int_en2,
_ic: PhantomData,
_mode: PhantomData,
};
Ok(dev)
}
pub fn set_pulse_amplitude(&mut self, led: Led, amplitude: u8) -> Result<(), Error<E>> {
match led {
Led::Led1 => self.write_data(&[Reg::LED1_PA, amplitude]),
Led::Led2 => self.write_data(&[Reg::LED2_PA, amplitude]),
Led::All => self.write_data(&[Reg::LED1_PA, amplitude, amplitude]),
}
}
}
impl TimeSlot {
fn get_mask(self) -> u8 {
match self {
TimeSlot::Disabled => 0,
TimeSlot::Led1 => 1,
TimeSlot::Led2 => 2,
}
}
}
impl<I2C, E> Max3010x<I2C, marker::ic::Max30102, marker::mode::MultiLED>
where
I2C: i2c::WriteRead<Error = E> + i2c::Write<Error = E>,
{
pub fn set_led_time_slots(&mut self, slots: [TimeSlot; 4]) -> Result<(), Error<E>> {
use TimeSlot::Disabled;
let mut last_slot_is_disabled = slots[0] == Disabled;
for slot in &slots {
if last_slot_is_disabled && *slot != Disabled {
return Err(Error::InvalidArguments);
}
last_slot_is_disabled = *slot == Disabled;
}
let data = [
Reg::SLOT_CONFIG0,
slots[1].get_mask() << 4 | slots[0].get_mask(),
slots[3].get_mask() << 4 | slots[2].get_mask(),
];
self.write_data(&data)
}
}