Add optional BMA456 accelerometer init on shared I2C bus.
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>
This commit is contained in:
@@ -0,0 +1,18 @@
|
||||
COINES_INSTALL_PATH ?= ../../../..
|
||||
|
||||
EXAMPLE_FILE = axis_remap.c
|
||||
|
||||
API_LOCATION ?= ../..
|
||||
|
||||
COMMON_LOCATION ?= ..
|
||||
|
||||
C_SRCS += \
|
||||
$(API_LOCATION)/bma4.c \
|
||||
$(API_LOCATION)/bma456h.c \
|
||||
$(COMMON_LOCATION)/common/common.c
|
||||
|
||||
INCLUDEPATHS += \
|
||||
$(API_LOCATION) \
|
||||
$(COMMON_LOCATION)/common
|
||||
|
||||
include $(COINES_INSTALL_PATH)/coines.mk
|
||||
@@ -0,0 +1,362 @@
|
||||
/**\
|
||||
* Copyright (c) 2022 Bosch Sensortec GmbH. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
**/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
#include "coines.h"
|
||||
#include "bma456h.h"
|
||||
#include "common.h"
|
||||
|
||||
/*********************************************************************/
|
||||
/* functions */
|
||||
/*********************************************************************/
|
||||
|
||||
/*!
|
||||
* @brief Main Function where the execution getting started to test the code.
|
||||
*
|
||||
* @param[in] argc
|
||||
* @param[in] argv
|
||||
*
|
||||
* @return status
|
||||
*
|
||||
*/
|
||||
int main(void)
|
||||
{
|
||||
int8_t rslt;
|
||||
struct bma4_dev bma4;
|
||||
uint16_t int_status = 0;
|
||||
struct bma4_remap remap_data = { 0 };
|
||||
struct bma4_accel accel = { 0 };
|
||||
struct bma4_accel_config accel_conf = { 0 };
|
||||
|
||||
char data_array[13][11] =
|
||||
{ { 0 }, { "BMA4_X" }, { "BMA4_Y" }, { 0 }, { "BMA4_Z" }, { 0 }, { 0 }, { 0 }, { 0 }, { "BMA4_NEG_X" },
|
||||
{ "BMA4_NEG_Y" }, { 0 }, { "BMA4_NEG_Z" } };
|
||||
|
||||
/* 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(&bma4, BMA4_I2C_INTF, BMA45X_VARIANT);
|
||||
bma4_error_codes_print_result("bma4_interface_init", rslt);
|
||||
|
||||
/* Sensor initialization */
|
||||
rslt = bma456h_init(&bma4);
|
||||
bma4_error_codes_print_result("bma456h_init", rslt);
|
||||
|
||||
/* Upload the configuration file to enable the features of the sensor. */
|
||||
rslt = bma456h_write_config_file(&bma4);
|
||||
bma4_error_codes_print_result("bma456h_write_config", rslt);
|
||||
|
||||
/* Accelerometer configuration Setting */
|
||||
/* Output data Rate */
|
||||
accel_conf.odr = BMA4_OUTPUT_DATA_RATE_50HZ;
|
||||
|
||||
/* Gravity range of the sensor (+/- 2G, 4G, 8G, 16G) */
|
||||
accel_conf.range = BMA4_ACCEL_RANGE_2G;
|
||||
|
||||
/* The bandwidth parameter is used to configure the number of sensor samples that are averaged
|
||||
* if it is set to 2, then 2^(bandwidth parameter) samples
|
||||
* are averaged, resulting in 4 averaged samples
|
||||
* Note1 : For more information, refer the datasheet.
|
||||
* Note2 : A higher number of averaged samples will result in a less noisier signal, but
|
||||
* this has an adverse effect on the power consumed.
|
||||
*/
|
||||
accel_conf.bandwidth = BMA4_ACCEL_NORMAL_AVG4;
|
||||
|
||||
/* Enable the filter performance mode where averaging of samples
|
||||
* will be done based on above set bandwidth and ODR.
|
||||
* There are two modes
|
||||
* 0 -> Averaging samples (Default)
|
||||
* 1 -> No averaging
|
||||
* For more info on No Averaging mode refer datasheet.
|
||||
*/
|
||||
accel_conf.perf_mode = BMA4_CIC_AVG_MODE;
|
||||
|
||||
/* Set the accel configurations */
|
||||
rslt = bma4_set_accel_config(&accel_conf, &bma4);
|
||||
bma4_error_codes_print_result("bma4_set_accel_config status", rslt);
|
||||
|
||||
/* NOTE : Enable accel after set of configurations */
|
||||
rslt = bma4_set_accel_enable(BMA4_ENABLE, &bma4);
|
||||
bma4_error_codes_print_result("bma4_set_accel_enable status", rslt);
|
||||
|
||||
/* Mapping data ready interrupt with interrupt pin 1 to get interrupt status once getting new accel data */
|
||||
rslt = bma456h_map_interrupt(BMA4_INTR1_MAP, BMA4_DATA_RDY_INT, BMA4_ENABLE, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_map_interrupt status", rslt);
|
||||
|
||||
printf("\nAXIS_REMAP_FUNC_TEST 1\n");
|
||||
printf("Get sensor data of re-mapped axes\n");
|
||||
|
||||
rslt = bma456h_get_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_get_remap_axes", rslt);
|
||||
|
||||
printf("Re-mapped x value = %s\n", data_array[remap_data.x]);
|
||||
printf("Re-mapped y value = %s\n", data_array[remap_data.y]);
|
||||
printf("Re-mapped z value = %s\n", data_array[remap_data.z]);
|
||||
|
||||
printf("Expected Re-mapped x value = BMA4_X\n");
|
||||
printf("Expected Re-mapped y value = BMA4_Y\n");
|
||||
printf("Expected Re-mapped z value = BMA4_Z\n");
|
||||
|
||||
if ((remap_data.x == BMA4_X) && (remap_data.y == BMA4_Y) && (remap_data.z == BMA4_Z))
|
||||
{
|
||||
printf(">> PASS\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(">> FAIL\n");
|
||||
}
|
||||
|
||||
printf("Print mapped data\n");
|
||||
|
||||
for (;;)
|
||||
{
|
||||
/* Read interrupt status */
|
||||
rslt = bma456h_read_int_status(&int_status, &bma4);
|
||||
bma4_error_codes_print_result("bma456_read_int_status", rslt);
|
||||
|
||||
/* Filtering only the accel data ready interrupt */
|
||||
if ((rslt == BMA4_OK) && (int_status & BMA4_ACCEL_DATA_RDY_INT))
|
||||
{
|
||||
rslt = bma4_read_accel_xyz(&accel, &bma4);
|
||||
bma4_error_codes_print_result("bma4_read_accel_xyz", rslt);
|
||||
|
||||
printf("Accel :: X = %d Y = %d Z = %d\n", accel.x, accel.y, accel.z);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
printf("\nAXIS_REMAP_FUNC_TEST 2\n");
|
||||
printf("Get sensor data of re-mapped axes\n");
|
||||
|
||||
remap_data.x = BMA4_NEG_Y;
|
||||
remap_data.y = BMA4_Z;
|
||||
remap_data.z = BMA4_NEG_X;
|
||||
|
||||
rslt = bma456h_set_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_set_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
rslt = bma456h_get_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_get_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
printf("Re-mapped x value = %s\n", data_array[remap_data.x]);
|
||||
printf("Re-mapped y value = %s\n", data_array[remap_data.y]);
|
||||
printf("Re-mapped z value = %s\n", data_array[remap_data.z]);
|
||||
}
|
||||
|
||||
printf("Expected Re-mapped x value = BMA4_NEG_Y\n");
|
||||
printf("Expected Re-mapped y value = BMA4_Z\n");
|
||||
printf("Expected Re-mapped z value = BMA4_NEG_X\n");
|
||||
|
||||
if ((remap_data.x == BMA4_NEG_Y) && (remap_data.y == BMA4_Z) && (remap_data.z == BMA4_NEG_X))
|
||||
{
|
||||
printf(">> PASS\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(">> FAIL\n");
|
||||
}
|
||||
}
|
||||
|
||||
printf("Print mapped data\n");
|
||||
|
||||
for (;;)
|
||||
{
|
||||
/* Read interrupt status */
|
||||
rslt = bma456h_read_int_status(&int_status, &bma4);
|
||||
bma4_error_codes_print_result("bma456_read_int_status", rslt);
|
||||
|
||||
/* Filtering only the accel data ready interrupt */
|
||||
if ((rslt == BMA4_OK) && (int_status & BMA4_ACCEL_DATA_RDY_INT))
|
||||
{
|
||||
rslt = bma4_read_accel_xyz(&accel, &bma4);
|
||||
bma4_error_codes_print_result("bma4_read_accel_xyz", rslt);
|
||||
|
||||
printf("Accel :: X = %d Y = %d Z = %d\n", accel.x, accel.y, accel.z);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
printf("\nAXIS_REMAP_FUNC_TEST 3\n");
|
||||
printf("Get sensor data of re-mapped axes - 2nd combination\n");
|
||||
|
||||
remap_data.x = BMA4_NEG_Z;
|
||||
remap_data.y = BMA4_NEG_X;
|
||||
remap_data.z = BMA4_Y;
|
||||
|
||||
rslt = bma456h_set_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_set_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
rslt = bma456h_get_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_get_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
printf("Re-mapped x value = %s\n", data_array[remap_data.x]);
|
||||
printf("Re-mapped y value = %s\n", data_array[remap_data.y]);
|
||||
printf("Re-mapped z value = %s\n", data_array[remap_data.z]);
|
||||
}
|
||||
|
||||
printf("Expected Re-mapped x value = BMA4_NEG_Z\n");
|
||||
printf("Expected Re-mapped y value = BMA4_NEG_X\n");
|
||||
printf("Expected Re-mapped z value = BMA4_Y\n");
|
||||
|
||||
if ((remap_data.x == BMA4_NEG_Z) && (remap_data.y == BMA4_NEG_X) && (remap_data.z == BMA4_Y))
|
||||
{
|
||||
printf(">> PASS\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(">> FAIL\n");
|
||||
}
|
||||
}
|
||||
|
||||
printf("Print mapped data\n");
|
||||
|
||||
for (;;)
|
||||
{
|
||||
/* Read interrupt status */
|
||||
rslt = bma456h_read_int_status(&int_status, &bma4);
|
||||
bma4_error_codes_print_result("bma456_read_int_status", rslt);
|
||||
|
||||
/* Filtering only the accel data ready interrupt */
|
||||
if ((rslt == BMA4_OK) && (int_status & BMA4_ACCEL_DATA_RDY_INT))
|
||||
{
|
||||
rslt = bma4_read_accel_xyz(&accel, &bma4);
|
||||
bma4_error_codes_print_result("bma4_read_accel_xyz", rslt);
|
||||
|
||||
printf("Accel :: X = %d Y = %d Z = %d\n", accel.x, accel.y, accel.z);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
printf("\nAXIS_REMAP_FUNC_TEST 4\n");
|
||||
printf("Get sensor data of re-mapped axes - 3rd combination\n");
|
||||
|
||||
remap_data.x = BMA4_Y;
|
||||
remap_data.y = BMA4_Z;
|
||||
remap_data.z = BMA4_X;
|
||||
|
||||
rslt = bma456h_set_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_set_remap_axes", rslt);
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
rslt = bma456h_get_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_get_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
printf("Re-mapped x value = %s\n", data_array[remap_data.x]);
|
||||
printf("Re-mapped y value = %s\n", data_array[remap_data.y]);
|
||||
printf("Re-mapped z value = %s\n", data_array[remap_data.z]);
|
||||
}
|
||||
|
||||
printf("Expected Re-mapped x value = BMA4_Y\n");
|
||||
printf("Expected Re-mapped y value = BMA4_Z\n");
|
||||
printf("Expected Re-mapped z value = BMA4_X\n");
|
||||
|
||||
if ((remap_data.x == BMA4_Y) && (remap_data.y == BMA4_Z) && (remap_data.z == BMA4_X))
|
||||
{
|
||||
printf(">> PASS\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(">> FAIL\n");
|
||||
}
|
||||
}
|
||||
|
||||
printf("Print mapped data\n");
|
||||
|
||||
for (;;)
|
||||
{
|
||||
/* Read interrupt status */
|
||||
rslt = bma456h_read_int_status(&int_status, &bma4);
|
||||
bma4_error_codes_print_result("bma456_read_int_status", rslt);
|
||||
|
||||
/* Filtering only the accel data ready interrupt */
|
||||
if ((rslt == BMA4_OK) && (int_status & BMA4_ACCEL_DATA_RDY_INT))
|
||||
{
|
||||
rslt = bma4_read_accel_xyz(&accel, &bma4);
|
||||
bma4_error_codes_print_result("bma4_read_accel_xyz", rslt);
|
||||
|
||||
printf("Accel :: X = %d Y = %d Z = %d\n", accel.x, accel.y, accel.z);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
printf("\nAXIS_REMAP_FUNC_TEST 5\n");
|
||||
printf("Get sensor data of re-mapped axes - 4th combination\n");
|
||||
|
||||
remap_data.x = BMA4_NEG_X;
|
||||
remap_data.y = BMA4_NEG_Y;
|
||||
remap_data.z = BMA4_NEG_Z;
|
||||
|
||||
rslt = bma456h_set_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_set_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
rslt = bma456h_get_remap_axes(&remap_data, &bma4);
|
||||
bma4_error_codes_print_result("bma456h_get_remap_axes", rslt);
|
||||
|
||||
if (rslt == BMA4_OK)
|
||||
{
|
||||
printf("Re-mapped x value = %s\n", data_array[remap_data.x]);
|
||||
printf("Re-mapped y value = %s\n", data_array[remap_data.y]);
|
||||
printf("Re-mapped z value = %s\n", data_array[remap_data.z]);
|
||||
}
|
||||
|
||||
printf("Expected Re-mapped x value = BMA4_NEG_X\n");
|
||||
printf("Expected Re-mapped y value = BMA4_NEG_Y\n");
|
||||
printf("Expected Re-mapped z value = BMA4_NEG_Z\n");
|
||||
|
||||
if ((remap_data.x == BMA4_NEG_X) && (remap_data.y == BMA4_NEG_Y) && (remap_data.z == BMA4_NEG_Z))
|
||||
{
|
||||
printf(">> PASS\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(">> FAIL\n");
|
||||
}
|
||||
}
|
||||
|
||||
printf("Print mapped data\n");
|
||||
|
||||
for (;;)
|
||||
{
|
||||
/* Read interrupt status */
|
||||
rslt = bma456h_read_int_status(&int_status, &bma4);
|
||||
bma4_error_codes_print_result("bma456_read_int_status", rslt);
|
||||
|
||||
/* Filtering only the accel data ready interrupt */
|
||||
if ((rslt == BMA4_OK) && (int_status & BMA4_ACCEL_DATA_RDY_INT))
|
||||
{
|
||||
rslt = bma4_read_accel_xyz(&accel, &bma4);
|
||||
bma4_error_codes_print_result("bma4_read_accel_xyz", rslt);
|
||||
|
||||
printf("Accel :: X = %d Y = %d Z = %d\n", accel.x, accel.y, accel.z);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
bma4_coines_deinit();
|
||||
|
||||
return rslt;
|
||||
}
|
||||
Reference in New Issue
Block a user