simon
e5db0b21c7
Probe and configure the sensor when present; log and continue boot if init fails so boards without BMA456 still run normally. Co-authored-by: Cursor <cursoragent@cursor.com>
131 lines
4.2 KiB
C
131 lines
4.2 KiB
C
/**\
|
|
* Copyright (c) 2022 Bosch Sensortec GmbH. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
**/
|
|
|
|
#include <stdio.h>
|
|
#include "bma456mm.h"
|
|
#include "common.h"
|
|
|
|
/******************************************************************************/
|
|
/*! Function */
|
|
|
|
/* This function starts the execution of program. */
|
|
int main(void)
|
|
{
|
|
/* Variable to store the status of API */
|
|
int8_t rslt;
|
|
|
|
/* Sensor initialization configuration */
|
|
struct bma4_dev bma = { 0 };
|
|
|
|
struct bma456mm_high_g_config high_g = { 0 };
|
|
struct bma456mm_out_state out_state;
|
|
|
|
/* Variable to store high-g interrupt status */
|
|
uint16_t int_status = 0;
|
|
|
|
/* Interface reference is given as a parameter
|
|
* For I2C : BMA4_I2C_INTF
|
|
* For SPI : BMA4_SPI_INTF
|
|
* Variant information given as parameter - BMA45X_VARIANT
|
|
*/
|
|
rslt = bma4_interface_init(&bma, BMA4_I2C_INTF, BMA45X_VARIANT);
|
|
bma4_error_codes_print_result("bma4_interface_init", rslt);
|
|
|
|
/* Sensor initialization */
|
|
rslt = bma456mm_init(&bma);
|
|
bma4_error_codes_print_result("bma456mm_init status", rslt);
|
|
|
|
/* Upload the configuration file to enable the features of the sensor. */
|
|
rslt = bma456mm_write_config_file(&bma);
|
|
bma4_error_codes_print_result("bma456mm_write_config status", rslt);
|
|
|
|
/* Enable the accelerometer */
|
|
rslt = bma4_set_accel_enable(BMA4_ENABLE, &bma);
|
|
bma4_error_codes_print_result("bma4_set_accel_enable status", rslt);
|
|
|
|
printf("High-g functionality test\n\n");
|
|
|
|
if (rslt == BMA4_OK)
|
|
{
|
|
/* Map the interrupt pin 1 for high-g */
|
|
rslt = bma456mm_map_interrupt(BMA4_INTR1_MAP, BMA456MM_HIGH_G_INT, BMA4_ENABLE, &bma);
|
|
bma4_error_codes_print_result("bma456mm_map_interrupt status", rslt);
|
|
|
|
if (rslt == BMA4_OK)
|
|
{
|
|
/* Enabling high-g feature */
|
|
rslt = bma456mm_feature_enable(BMA456MM_HIGH_G, BMA4_ENABLE, &bma);
|
|
bma4_error_codes_print_result("bma456mm_feature_enable status", rslt);
|
|
}
|
|
|
|
if (rslt == BMA4_OK)
|
|
{
|
|
printf("High_g enabled for all axis\n");
|
|
|
|
rslt = bma456mm_get_high_g_config(&high_g, &bma);
|
|
bma4_error_codes_print_result("bma456mm_get_high_g_config status", rslt);
|
|
|
|
high_g.axes_en = BMA456MM_HIGH_G_EN_ALL_AXIS;
|
|
rslt = bma456mm_set_high_g_config(&high_g, &bma);
|
|
bma4_error_codes_print_result("bma456mm_get_high_g_config status", rslt);
|
|
}
|
|
|
|
if (rslt == BMA4_OK)
|
|
{
|
|
printf("\nMove the board upwards for high-g interrupt\n");
|
|
|
|
for (;;)
|
|
{
|
|
/* Read the interrupt status */
|
|
rslt = bma456mm_read_int_status(&int_status, &bma);
|
|
bma4_error_codes_print_result("bma456mm_read_int_status", rslt);
|
|
|
|
/* Check if high-g interrupt is received */
|
|
if ((rslt == BMA4_OK) && (int_status & BMA456MM_HIGH_G_INT))
|
|
{
|
|
printf("\nReceived high-g interrupt\n");
|
|
|
|
rslt = bma456mm_output_state(&out_state, &bma);
|
|
bma4_error_codes_print_result("bma456mm_orientation_output", rslt);
|
|
|
|
if (out_state.high_g_detect_x)
|
|
{
|
|
printf("High-g detected in x-axis\n");
|
|
}
|
|
|
|
if (out_state.high_g_detect_y)
|
|
{
|
|
printf("High-g detected in y-axis\n");
|
|
}
|
|
|
|
if (out_state.high_g_detect_z)
|
|
{
|
|
printf("High-g detected in z-axis\n");
|
|
}
|
|
|
|
if (out_state.high_g_detect_sign == BMA4_ENABLE)
|
|
{
|
|
printf("High-g detected in negative axis\n");
|
|
}
|
|
|
|
if (out_state.high_g_detect_sign == BMA4_DISABLE)
|
|
{
|
|
printf("High-g detected in positive axis\n");
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
int_status = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
bma4_coines_deinit();
|
|
|
|
return rslt;
|
|
}
|