tanksensor and rtc sync
This commit is contained in:
@@ -1,45 +1,40 @@
|
||||
use crate::bail;
|
||||
use crate::hal::{ADC1, TANK_MULTI_SAMPLE};
|
||||
use crate::FatError::FatError;
|
||||
use embassy_time::Timer;
|
||||
use esp_hal::analog::adc::{Adc, AdcConfig, AdcPin, Attenuation};
|
||||
use esp_hal::delay::Delay;
|
||||
use esp_hal::gpio::{Flex, OutputConfig, Pull};
|
||||
use esp_hal::gpio::{Flex, Input, Output, OutputConfig, Pull};
|
||||
use esp_hal::pcnt::unit::Unit;
|
||||
use esp_hal::peripherals::GPIO5;
|
||||
use esp_hal::Blocking;
|
||||
use esp_println::println;
|
||||
use littlefs2::object_safe::DynStorage;
|
||||
use onewire::{ds18b20, Device, DeviceSearch, OneWire, DS18B20};
|
||||
|
||||
pub struct TankSensor<'a> {
|
||||
one_wire_bus: OneWire<Flex<'a>>,
|
||||
// tank_channel: AdcChannelDriver<'a, Gpio5, AdcDriver<'a, ADC1>>,
|
||||
// tank_power: PinDriver<'a, AnyIOPin, InputOutput>,
|
||||
tank_channel: Adc<'a, ADC1<'a>, Blocking>,
|
||||
tank_power: Output<'a>,
|
||||
tank_pin: AdcPin<GPIO5<'a>, ADC1<'a>>,
|
||||
// flow_counter: PcntDriver<'a>,
|
||||
// delay: Delay,
|
||||
}
|
||||
|
||||
impl<'a> TankSensor<'a> {
|
||||
pub(crate) fn create(
|
||||
mut one_wire_pin: Flex,
|
||||
// adc1: ADC1,
|
||||
// gpio5: Gpio5,
|
||||
// tank_power_pin: AnyIOPin,
|
||||
// flow_sensor_pin: AnyIOPin,
|
||||
// pcnt1: PCNT1,
|
||||
) -> Result<TankSensor, FatError> {
|
||||
mut one_wire_pin: Flex<'a>,
|
||||
adc1: ADC1<'a>,
|
||||
gpio5: GPIO5<'a>,
|
||||
tank_power: Output<'a>,
|
||||
flow_sensor: Input,
|
||||
pcnt1: Unit<'a, 1>,
|
||||
) -> Result<TankSensor<'a>, FatError> {
|
||||
one_wire_pin.apply_output_config(&OutputConfig::default().with_pull(Pull::None));
|
||||
|
||||
// let adc_config = AdcChannelConfig {
|
||||
// attenuation: attenuation::DB_11,
|
||||
// resolution: Resolution::Resolution12Bit,
|
||||
// calibration: esp_idf_hal::adc::oneshot::config::Calibration::Curve,
|
||||
// };
|
||||
// let tank_driver = AdcDriver::new(adc1).expect("Failed to configure ADC");
|
||||
// let tank_channel = AdcChannelDriver::new(tank_driver, gpio5, &adc_config)
|
||||
// .expect("Failed to configure ADC channel");
|
||||
//
|
||||
// let mut tank_power =
|
||||
// PinDriver::input_output(tank_power_pin).expect("Failed to configure pin");
|
||||
// tank_power
|
||||
// .set_pull(Pull::Floating)
|
||||
// .expect("Failed to set pull");
|
||||
//
|
||||
let mut adc1_config = AdcConfig::new();
|
||||
let tank_pin = adc1_config.enable_pin(gpio5, Attenuation::_11dB);
|
||||
let mut tank_channel = Adc::new(adc1, adc1_config);
|
||||
|
||||
let one_wire_bus = OneWire::new(one_wire_pin, false);
|
||||
|
||||
@@ -68,10 +63,10 @@ impl<'a> TankSensor<'a> {
|
||||
//
|
||||
Ok(TankSensor {
|
||||
one_wire_bus,
|
||||
// tank_channel,
|
||||
// tank_power,
|
||||
// flow_counter,
|
||||
// delay: Default::default(),
|
||||
tank_channel,
|
||||
tank_power,
|
||||
tank_pin, // flow_counter,
|
||||
// delay: Default::default(),
|
||||
})
|
||||
}
|
||||
|
||||
@@ -153,20 +148,24 @@ impl<'a> TankSensor<'a> {
|
||||
}
|
||||
|
||||
pub async fn tank_sensor_voltage(&mut self) -> Result<f32, FatError> {
|
||||
// self.tank_power.set_high()?;
|
||||
// //let stabilize
|
||||
// self.delay.delay_ms(100);
|
||||
//
|
||||
// let mut store = [0_u16; TANK_MULTI_SAMPLE];
|
||||
// for multisample in 0..TANK_MULTI_SAMPLE {
|
||||
// let value = self.tank_channel.read()?;
|
||||
// store[multisample] = value;
|
||||
// }
|
||||
// self.tank_power.set_low()?;
|
||||
//
|
||||
// store.sort();
|
||||
// let median_mv = store[6] as f32 / 1000_f32;
|
||||
let median_mv = 10_f32;
|
||||
self.tank_power.set_high();
|
||||
//let stabilize
|
||||
Timer::after_millis(100).await;
|
||||
|
||||
let mut store = [0_u16; TANK_MULTI_SAMPLE];
|
||||
for multisample in 0..TANK_MULTI_SAMPLE {
|
||||
let mut asy = (&mut self.tank_channel);
|
||||
|
||||
let value = asy.read_oneshot(&mut self.tank_pin);
|
||||
//force yield
|
||||
Timer::after_millis(10).await;
|
||||
store[multisample] = value.unwrap();
|
||||
}
|
||||
self.tank_power.set_low();
|
||||
|
||||
store.sort();
|
||||
//TODO probably wrong? check!
|
||||
let median_mv = store[6] as f32 * 3300_f32 / 4096_f32;
|
||||
Ok(median_mv)
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user