-
Notifications
You must be signed in to change notification settings - Fork 102
/
adc12_parallel.rs
96 lines (77 loc) · 2.74 KB
/
adc12_parallel.rs
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
//! Example of reading a voltage with ADC1 and ADC2 on two different channels in
//! parallel
//!
//! For an example of using ADC1, see examples/adc.rs
//! For an example of using ADC3, see examples/temperature.rs
//! For an example of using ADC1 and ADC2 together, see examples/adc12.rs
#![no_main]
#![no_std]
use log::info;
use nb::block;
use cortex_m_rt::entry;
use stm32h7xx_hal::{adc, delay::Delay, pac, prelude::*, rcc::rec::AdcClkSel};
#[macro_use]
mod utilities;
#[entry]
fn main() -> ! {
utilities::logger::init();
let cp = cortex_m::Peripherals::take().unwrap();
let dp = pac::Peripherals::take().unwrap();
// Constrain and Freeze power
info!("Setup PWR...");
let pwr = dp.PWR.constrain();
let pwrcfg = example_power!(pwr).freeze();
// Constrain and Freeze clock
info!("Setup RCC...");
let rcc = dp.RCC.constrain();
// We need to configure a clock for adc_ker_ck_input. The default
// adc_ker_ck_input is pll2_p_ck, but we will use per_ck. per_ck is sourced
// from the 64MHz HSI
//
// adc_ker_ck_input is then divided by the ADC prescaler to give f_adc. The
// maximum f_adc is 50MHz
let mut ccdr = rcc.sys_ck(100.MHz()).freeze(pwrcfg, &dp.SYSCFG);
// Switch adc_ker_ck_input multiplexer to per_ck
ccdr.peripheral.kernel_adc_clk_mux(AdcClkSel::Per);
info!("");
info!("stm32h7xx-hal example - ADC");
info!("");
let mut delay = Delay::new(cp.SYST, ccdr.clocks);
// Setup ADC1 and ADC2
let (adc1, adc2) = adc::adc12(
dp.ADC1,
dp.ADC2,
4.MHz(),
&mut delay,
ccdr.peripheral.ADC12,
&ccdr.clocks,
);
let mut adc1 = adc1.enable();
adc1.set_resolution(adc::Resolution::SixteenBit);
adc1.set_sample_time(adc::AdcSampleTime::T_387);
let mut adc2 = adc2.enable();
adc2.set_resolution(adc::Resolution::SixteenBit);
adc2.set_sample_time(adc::AdcSampleTime::T_387);
// Setup GPIOA
let gpioa = dp.GPIOA.split(ccdr.peripheral.GPIOA);
// Configure pins 23 and 22 as an analog inputs
let mut channel1 = gpioa.pa4.into_analog(); // DAISY PIN 23
let mut channel2 = gpioa.pa5.into_analog(); // DAISY PIN 22
loop {
adc1.start_conversion(&mut channel1);
adc2.start_conversion(&mut channel2);
let data1 = block!(adc1.read_sample()).unwrap();
let data2 = block!(adc2.read_sample()).unwrap();
// voltage = reading * (vref/resolution)
info!(
"ADC1 reading: {}, voltage for Daisy pin X: {}",
data1,
data1 as f32 * (3.3 / adc1.slope() as f32)
);
info!(
"ADC2 reading: {}, voltage for Daisy pin X: {}",
data2,
data2 as f32 * (3.3 / adc2.slope() as f32)
);
}
}