/** * Copyright (c) 2017 - 2019, Nordic Semiconductor ASA * * All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * * 2. Redistributions in binary form, except as embedded into a Nordic * Semiconductor ASA integrated circuit in a product or a software update for * such product, must reproduce the above copyright notice, this list of * conditions and the following disclaimer in the documentation and/or other * materials provided with the distribution. * * 3. Neither the name of Nordic Semiconductor ASA nor the names of its * contributors may be used to endorse or promote products derived from this * software without specific prior written permission. * * 4. This software, with or without modification, must only be used with a * Nordic Semiconductor ASA integrated circuit. * * 5. Any software provided in binary form under this license must not be reverse * engineered, decompiled, modified and/or disassembled. * * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ #include "lps22hb.h" ret_code_t lps22hb_init(lps22hb_instance_t * p_instance) { ASSERT(p_instance != NULL); p_instance->interrupt_cfg = 0; p_instance->ctrl_reg[0] = 0; p_instance->ctrl_reg[1] = LPS22HB_CTRL_REG2_DEFAULT; p_instance->ctrl_reg[2] = 0; p_instance->fifo_ctrl = 0; ret_code_t err_code; if (p_instance->p_sensor_data->p_twi_mngr->p_queue->size < LPS22HB_MIN_QUEUE_SIZE) { return NRF_ERROR_INVALID_LENGTH; } err_code = lps22hb_cfg_commit(p_instance); return err_code; } ret_code_t lps22hb_autorifp_enable(lps22hb_instance_t * p_instance, bool enable) { ASSERT(p_instance != NULL); uint8_t reg = p_instance->interrupt_cfg; if (enable == true) { NRF_TWI_SENSOR_REG_SET(reg, LPS22HB_AUTORIFP_MASK, LPS22HB_AUTORIFP_POS, 1); } else { NRF_TWI_SENSOR_REG_SET(reg, LPS22HB_RESET_ARP_MASK, LPS22HB_RESET_ARP_POS, 1); } uint8_t send_msg[] = { LPS22HB_REG_INTERRUPT_CONFIG, reg }; return nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); } ret_code_t lps22hb_autozero_enable(lps22hb_instance_t * p_instance, bool enable) { ASSERT(p_instance != NULL); uint8_t reg = p_instance->interrupt_cfg; if (enable == true) { NRF_TWI_SENSOR_REG_SET(reg, LPS22HB_AUTOZERO_MASK, LPS22HB_AUTOZERO_POS, 1); } else { NRF_TWI_SENSOR_REG_SET(reg, LPS22HB_RESET_AZ_MASK, LPS22HB_RESET_AZ_POS, 1); } uint8_t send_msg[] = { LPS22HB_REG_INTERRUPT_CONFIG, reg }; return nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); } void lps22hb_data_rate_set(lps22hb_instance_t * p_instance, lps22hb_odr_t odr) { ASSERT(p_instance != NULL); NRF_TWI_SENSOR_REG_SET(p_instance->ctrl_reg[0], LPS22HB_ODR_MASK, LPS22HB_ODR_POS, odr); } ret_code_t lps22hb_data_read(lps22hb_instance_t * p_instance, lps22hb_data_callback_t user_callback, lps22hb_data_t * p_out_data, uint8_t samples) { ASSERT(p_instance != NULL); ret_code_t err_code; err_code = nrf_twi_sensor_reg_read(p_instance->p_sensor_data, p_instance->sensor_addr, LPS22HB_REG_PRESS_OUT_XL, (nrf_twi_sensor_reg_cb_t) user_callback, (uint8_t *) p_out_data, samples * LPS22HB_BYTES_PER_SAMPLE); return err_code; } void lps22hb_data_decode(lps22hb_data_t * p_data, uint8_t samples) { ASSERT(p_data != NULL); lps22hb_raw_data_t * p_in_data = (lps22hb_raw_data_t *) p_data; uint32_t pres; uint16_t temp; for (int i = samples-1; i >= 0; i--) { pres = ((uint32_t) p_in_data[i].press_out_xl) | (((uint32_t) p_in_data[i].press_out_l) << 8) | (((uint32_t) p_in_data[i].press_out_h) << 16); pres <<= 8; temp = ((uint16_t) p_in_data[i].temp_out_l) | (((uint16_t) p_in_data[i].temp_out_h) << 8); // Dividing by 256 because signed integer can't be shifted by 8 p_data[i].pressure = *((int32_t *) &pres) / 256; p_data[i].temperature = *((int16_t *) &temp); } } ret_code_t lps22hb_threshold_set(lps22hb_instance_t * p_instance, uint16_t thr) { ASSERT(p_instance != NULL); thr *= 16; uint8_t send_msg[] = { LPS22HB_REG_THS_P_L, thr & 0x00FFU, thr >> 8 }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; } ret_code_t lps22hb_ref_pressure_set(lps22hb_instance_t * p_instance, int32_t pressure) { ASSERT(p_instance != NULL); // Multiplying by 256 because signed integer can't be shifted by 8 pressure *= 256; uint32_t pres = *((uint32_t *) &pressure); pres >>= 8; uint8_t send_msg[] = { LPS22HB_REG_REF_P_XL, pres & 0x00FFU, (pres >> 8) & 0x00FFU, (pres >> 16) & 0x00FFU }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; } ret_code_t lps22hb_offset_set(lps22hb_instance_t * p_instance, int16_t offset) { ASSERT(p_instance != NULL); offset *= 16; uint16_t off = *((uint16_t *) &offset); uint8_t send_msg[] = { LPS22HB_REG_RPDS_L, off & 0x00FFU, off >> 8 }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; } ret_code_t lps22hb_cfg_commit(lps22hb_instance_t * p_instance) { ASSERT(p_instance != NULL); p_instance->ctrl_reg[1] |= LPS22HB_CTRL_REG2_DEFAULT; p_instance->ctrl_reg[0] &= ~LPS22HB_CTRL1_VALID_MASK; p_instance->ctrl_reg[1] &= ~LPS22HB_CTRL2_VALID_MASK; ret_code_t err_code; err_code = nrf_twi_sensor_reg_write(p_instance->p_sensor_data, p_instance->sensor_addr, LPS22HB_REG_INTERRUPT_CONFIG, &p_instance->interrupt_cfg, 1); if (err_code != NRF_SUCCESS) { return err_code; } err_code = nrf_twi_sensor_reg_write(p_instance->p_sensor_data, p_instance->sensor_addr, LPS22HB_REG_CTRL1, p_instance->ctrl_reg, 3); if (err_code != NRF_SUCCESS) { return err_code; } err_code = nrf_twi_sensor_reg_write(p_instance->p_sensor_data, p_instance->sensor_addr, LPS22HB_REG_FIFO_CTRL, &p_instance->fifo_ctrl, 1); return err_code; } ret_code_t lps22hb_sw_reset(lps22hb_instance_t * p_instance) { ASSERT(p_instance != NULL); uint8_t reg_val = p_instance->ctrl_reg[1]; NRF_TWI_SENSOR_REG_SET(reg_val, LPS22HB_SWRESET_MASK, LPS22HB_SWRESET_POS, 1); uint8_t send_msg[] = { LPS22HB_REG_CTRL2, reg_val }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; } ret_code_t lps22hb_boot(lps22hb_instance_t * p_instance) { ASSERT(p_instance != NULL); uint8_t reg_val = p_instance->ctrl_reg[1]; NRF_TWI_SENSOR_REG_SET(reg_val, LPS22HB_BOOT_MASK, LPS22HB_BOOT_POS, 1); uint8_t send_msg[] = { LPS22HB_REG_CTRL2, reg_val }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; } ret_code_t lps22hb_oneshot(lps22hb_instance_t * p_instance) { ASSERT(p_instance != NULL); uint8_t reg_val = p_instance->ctrl_reg[1]; NRF_TWI_SENSOR_REG_SET(reg_val, LPS22HB_ONE_SHOT_MASK, LPS22HB_ONE_SHOT_POS, 1); uint8_t send_msg[] = { LPS22HB_REG_CTRL2, reg_val }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; } ret_code_t lps22hb_low_power_enable(lps22hb_instance_t * p_instance, bool enable) { ASSERT(p_instance != NULL); uint8_t send_msg[] = { LPS22HB_REG_RES_CONF, enable }; ret_code_t err_code; err_code = nrf_twi_sensor_write(p_instance->p_sensor_data, p_instance->sensor_addr, send_msg, ARRAY_SIZE(send_msg), true); return err_code; }