kopia lustrzana https://github.com/pimoroni/pimoroni-pico
159 wiersze
4.4 KiB
C++
159 wiersze
4.4 KiB
C++
#include "breakout_mics6814.hpp"
|
|
#include <algorithm>
|
|
|
|
namespace pimoroni {
|
|
|
|
bool BreakoutMICS6814::init(bool skip_chip_id_check) {
|
|
bool success = false;
|
|
if(ioe.init(skip_chip_id_check)) {
|
|
|
|
ioe.set_mode(MICS_VREF, IOExpander::PIN_ADC);
|
|
ioe.set_mode(MICS_RED, IOExpander::PIN_ADC);
|
|
ioe.set_mode(MICS_NH3, IOExpander::PIN_ADC);
|
|
ioe.set_mode(MICS_OX, IOExpander::PIN_ADC);
|
|
|
|
ioe.set_mode(MICS_HEATER_EN, IOExpander::PIN_OD);
|
|
ioe.output(MICS_HEATER_EN, IOExpander::LOW);
|
|
|
|
// Calculate a period large enough to get 0-255 steps at the desired brightness
|
|
uint16_t period = (uint16_t)(255.0f / brightness);
|
|
|
|
ioe.set_pwm_period(period);
|
|
ioe.set_pwm_control(2); // PWM as fast as we can to avoid LED flicker
|
|
|
|
ioe.set_mode(LED_R, IOExpander::PIN_PWM, false, INVERT_OUTPUT);
|
|
ioe.set_mode(LED_G, IOExpander::PIN_PWM, false, INVERT_OUTPUT);
|
|
ioe.set_mode(LED_B, IOExpander::PIN_PWM, false, INVERT_OUTPUT);
|
|
|
|
success = true;
|
|
}
|
|
|
|
return success;
|
|
}
|
|
|
|
i2c_inst_t* BreakoutMICS6814::get_i2c() const {
|
|
return ioe.get_i2c();
|
|
}
|
|
|
|
int BreakoutMICS6814::get_address() const {
|
|
return ioe.get_address();
|
|
}
|
|
|
|
int BreakoutMICS6814::get_sda() const {
|
|
return ioe.get_sda();
|
|
}
|
|
|
|
int BreakoutMICS6814::get_scl() const {
|
|
return ioe.get_scl();
|
|
}
|
|
|
|
int BreakoutMICS6814::get_int() const {
|
|
return ioe.get_int();
|
|
}
|
|
|
|
void BreakoutMICS6814::set_address(uint8_t address) {
|
|
ioe.set_address(address);
|
|
}
|
|
|
|
float BreakoutMICS6814::get_adc_vref(void) {
|
|
return ioe.get_adc_vref();
|
|
}
|
|
|
|
void BreakoutMICS6814::set_adc_vref(float vref) {
|
|
ioe.set_adc_vref(vref);
|
|
}
|
|
|
|
void BreakoutMICS6814::set_brightness(float brightness) {
|
|
this->brightness = std::min(std::max(brightness, 0.01f), 1.0f);
|
|
|
|
// Calculate a period large enough to get 0-255 steps at the desired brightness
|
|
uint16_t period = (uint16_t)(255.0f / this->brightness);
|
|
|
|
ioe.set_pwm_period(period);
|
|
}
|
|
|
|
void BreakoutMICS6814::set_led(uint8_t r, uint8_t g, uint8_t b) {
|
|
ioe.output(LED_R, r, false); // Hold off pwm load until the last
|
|
ioe.output(LED_G, g, false); // Hold off pwm load until the last
|
|
ioe.output(LED_B, b); // Loads all 3 pwms
|
|
}
|
|
|
|
void BreakoutMICS6814::set_heater(bool on) {
|
|
ioe.output(MICS_HEATER_EN, on ? IOExpander::LOW : IOExpander::HIGH);
|
|
}
|
|
|
|
void BreakoutMICS6814::disable_heater() {
|
|
ioe.output(MICS_HEATER_EN, IOExpander::HIGH);
|
|
ioe.set_mode(MICS_HEATER_EN, IOExpander::PIN_IN);
|
|
}
|
|
|
|
float BreakoutMICS6814::get_raw_ref(uint32_t adc_timeout) {
|
|
return ioe.input_as_voltage(MICS_VREF, adc_timeout);
|
|
}
|
|
|
|
float BreakoutMICS6814::get_raw_red(uint32_t adc_timeout) {
|
|
return ioe.input_as_voltage(MICS_RED, adc_timeout);
|
|
}
|
|
|
|
float BreakoutMICS6814::get_raw_nh3(uint32_t adc_timeout) {
|
|
return ioe.input_as_voltage(MICS_NH3, adc_timeout);
|
|
}
|
|
|
|
float BreakoutMICS6814::get_raw_oxd(uint32_t adc_timeout) {
|
|
return ioe.input_as_voltage(MICS_OX, adc_timeout);
|
|
}
|
|
|
|
BreakoutMICS6814::Reading BreakoutMICS6814::read_all(uint32_t adc_timeout) {
|
|
BreakoutMICS6814::Reading reading;
|
|
reading.reducing = read_reducing(adc_timeout);
|
|
reading.nh3 = read_nh3(adc_timeout);
|
|
reading.oxidising = read_oxidising(adc_timeout);
|
|
reading.ref = read_ref(adc_timeout);
|
|
return reading;
|
|
}
|
|
|
|
float BreakoutMICS6814::read_ref(uint32_t adc_timeout) {
|
|
float ref = get_raw_ref(adc_timeout);
|
|
if(ref == -1)
|
|
ref = 0;
|
|
|
|
return ref;
|
|
}
|
|
|
|
float BreakoutMICS6814::read_reducing(uint32_t adc_timeout) {
|
|
float vref = ioe.get_adc_vref();
|
|
|
|
float red = get_raw_red(adc_timeout);
|
|
if((red != -1) && (vref != red))
|
|
red = (red * 56000.0f) / (vref - red);
|
|
else
|
|
red = 0;
|
|
|
|
return red;
|
|
}
|
|
|
|
float BreakoutMICS6814::read_nh3(uint32_t adc_timeout) {
|
|
float vref = ioe.get_adc_vref();
|
|
|
|
float nh3 = get_raw_nh3(adc_timeout);
|
|
if((nh3 != -1) && (vref != nh3))
|
|
nh3 = (nh3 * 56000.0f) / (vref - nh3);
|
|
else
|
|
nh3 = 0;
|
|
|
|
return nh3;
|
|
}
|
|
|
|
float BreakoutMICS6814::read_oxidising(uint32_t adc_timeout) {
|
|
float vref = ioe.get_adc_vref();
|
|
|
|
float oxd = get_raw_oxd(adc_timeout);
|
|
if((oxd != -1) && (vref != oxd))
|
|
oxd = (oxd * 56000.0f) / (vref - oxd);
|
|
else
|
|
oxd = 0;
|
|
|
|
return oxd;
|
|
}
|
|
}
|