kopia lustrzana https://github.com/pimoroni/pimoroni-pico
				
				
				
			
		
			
				
	
	
		
			121 wiersze
		
	
	
		
			4.5 KiB
		
	
	
	
		
			C++
		
	
	
			
		
		
	
	
			121 wiersze
		
	
	
		
			4.5 KiB
		
	
	
	
		
			C++
		
	
	
#include "bme68x.hpp"
 | 
						|
#include "pico/stdlib.h"
 | 
						|
 | 
						|
namespace pimoroni {
 | 
						|
    bool BME68X::init() {
 | 
						|
        int8_t result = 0;
 | 
						|
 | 
						|
        if(interrupt != PIN_UNUSED) {
 | 
						|
            gpio_set_function(interrupt, GPIO_FUNC_SIO);
 | 
						|
            gpio_set_dir(interrupt, GPIO_IN);
 | 
						|
            gpio_pull_up(interrupt);
 | 
						|
        }
 | 
						|
 | 
						|
        i2c_interface.i2c = i2c;
 | 
						|
        i2c_interface.address = address;
 | 
						|
 | 
						|
        device.intf_ptr = &i2c_interface;
 | 
						|
        device.intf = bme68x_intf::BME68X_I2C_INTF;
 | 
						|
        device.read = (bme68x_read_fptr_t)&read_bytes;
 | 
						|
        device.write = (bme68x_write_fptr_t)&write_bytes;
 | 
						|
        device.delay_us = (bme68x_delay_us_fptr_t)&delay_us;
 | 
						|
        device.amb_temp = 20;
 | 
						|
 | 
						|
        result = bme68x_init(&device);
 | 
						|
        bme68x_check_rslt("bme68x_init", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        result = bme68x_get_conf(&conf, &device);
 | 
						|
        bme68x_check_rslt("bme68x_get_conf", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        configure(BME68X_FILTER_OFF, BME68X_ODR_NONE, BME68X_OS_16X, BME68X_OS_1X, BME68X_OS_2X);
 | 
						|
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
 | 
						|
    bool BME68X::configure(uint8_t filter, uint8_t odr, uint8_t os_humidity, uint8_t os_pressure, uint8_t os_temp) {
 | 
						|
        int8_t result = 0;
 | 
						|
 | 
						|
        conf.filter = filter;
 | 
						|
        conf.odr = odr;
 | 
						|
        conf.os_hum = os_humidity;
 | 
						|
        conf.os_pres = os_pressure;
 | 
						|
        conf.os_temp = os_temp;
 | 
						|
 | 
						|
        bme68x_set_conf(&conf, &device);
 | 
						|
        bme68x_check_rslt("bme68x_set_conf", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
 | 
						|
    bool BME68X::read_forced(bme68x_data *data, uint16_t heater_temp, uint16_t heater_duration) {
 | 
						|
        int8_t result = 0;
 | 
						|
        uint8_t n_fields;
 | 
						|
        uint32_t delay_period;
 | 
						|
 | 
						|
        heatr_conf.enable = BME68X_ENABLE;
 | 
						|
        heatr_conf.heatr_temp = heater_temp;
 | 
						|
        heatr_conf.heatr_dur = heater_duration;
 | 
						|
        result = bme68x_set_heatr_conf(BME68X_FORCED_MODE, &heatr_conf, &device);
 | 
						|
        bme68x_check_rslt("bme68x_set_heatr_conf", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        result = bme68x_set_op_mode(BME68X_FORCED_MODE, &device);
 | 
						|
        bme68x_check_rslt("bme68x_set_op_mode", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        delay_period = bme68x_get_meas_dur(BME68X_FORCED_MODE, &conf, &device) + (heatr_conf.heatr_dur * 1000);
 | 
						|
        // Could probably just call sleep_us here directly, I guess the API uses this internally
 | 
						|
        device.delay_us(delay_period, device.intf_ptr);
 | 
						|
 | 
						|
        result = bme68x_get_data(BME68X_FORCED_MODE, data, &n_fields, &device);
 | 
						|
        bme68x_check_rslt("bme68x_get_data", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
 | 
						|
    /*
 | 
						|
    Will read profile_length results with the given temperatures and duration multipliers into the results array.
 | 
						|
    Blocks until it has a valid result for each temp/duration, and returns the entire set in the given order.
 | 
						|
    */
 | 
						|
    bool BME68X::read_parallel(bme68x_data *results, uint16_t *profile_temps, uint16_t *profile_durations, size_t profile_length) {
 | 
						|
        int8_t result;
 | 
						|
        bme68x_data data[3]; // Parallel & Sequential mode read 3 simultaneous fields
 | 
						|
        uint8_t n_fields;
 | 
						|
        uint32_t delay_period;
 | 
						|
 | 
						|
        heatr_conf.enable = BME68X_ENABLE;
 | 
						|
        heatr_conf.heatr_temp_prof = profile_temps;
 | 
						|
        heatr_conf.heatr_dur_prof = profile_durations;
 | 
						|
        heatr_conf.profile_len = profile_length;
 | 
						|
        heatr_conf.shared_heatr_dur = 140 - (bme68x_get_meas_dur(BME68X_PARALLEL_MODE, &conf, &device) / 1000);
 | 
						|
        result = bme68x_set_heatr_conf(BME68X_PARALLEL_MODE, &heatr_conf, &device);
 | 
						|
        bme68x_check_rslt("bme68x_set_heatr_conf", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        result = bme68x_set_op_mode(BME68X_PARALLEL_MODE, &device);
 | 
						|
        bme68x_check_rslt("bme68x_set_op_mode", result);
 | 
						|
        if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
        while (1) {
 | 
						|
            delay_period = bme68x_get_meas_dur(BME68X_PARALLEL_MODE, &conf, &device) + (heatr_conf.shared_heatr_dur * 1000);
 | 
						|
            device.delay_us(delay_period, device.intf_ptr);
 | 
						|
 | 
						|
            result = bme68x_get_data(BME68X_PARALLEL_MODE, data, &n_fields, &device);
 | 
						|
            if(result == BME68X_W_NO_NEW_DATA) continue;
 | 
						|
            bme68x_check_rslt("bme68x_get_data", result);
 | 
						|
            if(result != BME68X_OK) return false;
 | 
						|
 | 
						|
            for(auto i = 0u; i < n_fields; i++) {
 | 
						|
                results[data[i].gas_index] = data[i];
 | 
						|
 | 
						|
                if(data[i].gas_index == profile_length - 1) return true;
 | 
						|
            }
 | 
						|
        }
 | 
						|
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
} |