321 lines
11 KiB
C
321 lines
11 KiB
C
/**
|
|
* 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;
|
|
}
|