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
use crate::gpio::{
gpioa::{PA4, PA5},
Analog,
};
use crate::pac::{DAC, RCC};
#[derive(Debug)]
pub enum Error {
error,
}
use core::mem;
pub struct C1;
pub struct C2;
pub trait DacOut<V> {
fn set_value(&mut self, val: V);
fn get_value(&mut self) -> V;
}
pub trait DacPin {
fn enable(&mut self);
}
pub trait Pins<DAC> {
type Output;
}
impl Pins<DAC> for PA4<Analog> {
type Output = C1;
}
impl Pins<DAC> for PA5<Analog> {
type Output = C2;
}
impl Pins<DAC> for (PA4<Analog>, PA5<Analog>) {
type Output = (C1, C2);
}
pub fn dac<PINS>(_dac: DAC, _pins: PINS) -> PINS::Output
where
PINS: Pins<DAC>,
{
unsafe {
let rcc = &(*RCC::ptr());
rcc.apb1enr.modify(|_, w| w.dacen().set_bit());
cortex_m::asm::dsb();
rcc.apb1rstr.write(|w| w.dacrst().set_bit());
rcc.apb1rstr.write(|w| w.dacrst().clear_bit());
assert!(mem::size_of::<PINS::Output>() == 0);
#[allow(clippy::uninit_assumed_init)]
mem::MaybeUninit::uninit().assume_init()
}
}
macro_rules! dac {
($CX:ident, $en:ident, $cen:ident, $cal_flag:ident, $trim:ident, $mode:ident, $dhrx:ident, $dac_dor:ident, $daccxdhr:ident) => {
impl DacPin for $CX {
fn enable(&mut self) {
let dac = unsafe { &(*DAC::ptr()) };
dac.cr.modify(|_, w| w.$en().set_bit());
}
}
impl DacOut<u16> for $CX {
fn set_value(&mut self, val: u16) {
let dac = unsafe { &(*DAC::ptr()) };
dac.$dhrx.write(|w| unsafe { w.bits(val as u32) });
}
fn get_value(&mut self) -> u16 {
let dac = unsafe { &(*DAC::ptr()) };
dac.$dac_dor.read().bits() as u16
}
}
};
}
pub trait DacExt {
fn constrain<PINS>(self, pins: PINS) -> PINS::Output
where
PINS: Pins<DAC>;
}
impl DacExt for DAC {
fn constrain<PINS>(self, pins: PINS) -> PINS::Output
where
PINS: Pins<DAC>,
{
dac(self, pins)
}
}
dac!(C1, en1, cen1, cal_flag1, otrim1, mode1, dhr12r1, dor1, dacc1dhr);
dac!(C2, en2, cen2, cal_flag2, otrim2, mode2, dhr12r2, dor2, dacc2dhr);