mlx90640-capture 0.1.1

Image capture utility for MLX90640 cameras
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

use std::time::Duration;

use anyhow::anyhow;
use anyhow::Result;

use rpmlx90640::read_temperatures;
use rpmlx90640::TemperatureRead;
use rpmlx90640::PIXEL_COUNT;

use linux_embedded_hal::I2cdev;
use mlx9064x::Mlx90640Driver;

pub fn get_mlx90640_frame(bus: Option<&str>, address: Option<u8>) -> Result<TemperatureRead> {
    if let Some(bus) = bus {
        // try using the linux embedded hal driver

        if !bus.is_empty() {
            // default address is 0x33
            let addr = address.unwrap_or(0x33);

            let i2c_bus = I2cdev::new(bus).map_err(|e| anyhow!("I2C Bus {} error: {}", bus, e))?;

            let mut camera = Mlx90640Driver::new(i2c_bus, addr)?;

            let mut temperatures = [0f32; PIXEL_COUNT];
            camera
                .generate_image_if_ready(&mut temperatures)
                .map_err(|e| anyhow!("Error reading frame data from camera: {}", e))?;

            std::thread::sleep(Duration::from_millis(500));

            camera
                .generate_image_if_ready(&mut temperatures)
                .map_err(|e| anyhow!("Error reading frame data from camera: {}", e))?;

            let min = temperatures.iter().cloned().fold(f32::MAX, |a, b| a.min(b));
            let max = temperatures.iter().cloned().fold(f32::MIN, |a, b| a.max(b));

            // wrap result in the convenient package of the rpmlx90640 driver
            return Ok(TemperatureRead {
                temperature_grid: temperatures,
                min_temp: min,
                max_temp: max,
            });
        }
    }

    // default to the RPI driver
    read_temperatures().map_err(|e| anyhow!("MLX90640 Error: {}", e))
}