/*******************************************************************************
* Function Name: sensor_hub_daq_task
*******************************************************************************
* Summary:
* FreeRTOS task that reads BMI270 sensor and performs motion detection
******************************************************************************/
static void sensor_hub_daq_task(void *pvParameters)
{
TickType_t xLastWakeTime = 0;
const TickType_t xDelay = 100 / portTICK_PERIOD_MS;
float acc_x = 0.0f;
float acc_y = 0.0f;
float acc_z = 0.0f;
float magnitude = 0.0f;
motion_state_t motion_state = MOTION_STATIONARY;
(void)pvParameters;
/* Initialize I2C */
initStatus = Cy_SCB_I2C_Init(CYBSP_I2C_CONTROLLER_HW,
&CYBSP_I2C_CONTROLLER_config,
&CYBSP_I2C_CONTROLLER_context);
if (CY_SCB_I2C_SUCCESS != initStatus)
{
handle_app_error();
}
Cy_SCB_I2C_Enable(CYBSP_I2C_CONTROLLER_HW);
result = mtb_hal_i2c_setup(&CYBSP_I2C_CONTROLLER_hal_obj,
&CYBSP_I2C_CONTROLLER_hal_config,
&CYBSP_I2C_CONTROLLER_context,
NULL);
if (CY_RSLT_SUCCESS != result)
{
handle_app_error();
}
/* Initialize BMI270 */
result = mtb_bmi270_init_i2c(&bmi270,
&CYBSP_I2C_CONTROLLER_hal_obj,
MTB_BMI270_ADDRESS_DEFAULT);
if (CY_RSLT_SUCCESS != result)
{
handle_app_error();
}
result = mtb_bmi270_config_default(&bmi270);
if (CY_RSLT_SUCCESS != result)
{
handle_app_error();
}
/* Clear screen */
printf("\x1b[2J\x1b[;H");
printf("************************************************************\r\n");
printf(" Lab 2-3: Motion Detection \r\n");
printf("************************************************************\r\n\r\n");
printf("Motion Thresholds:\r\n");
printf(" STATIONARY: < 0.1g | LIGHT: < 0.3g\r\n");
printf(" MODERATE: < 0.6g | INTENSE: >= 0.6g\r\n\r\n");
/* Initialize LED to OFF */
LED_OFF();
xLastWakeTime = xTaskGetTickCount();
for (;;)
{
/* Read sensor */
result = mtb_bmi270_read(&bmi270, &bmi270_data);
if (CY_RSLT_SUCCESS != result)
{
handle_app_error();
}
/* Convert to m/sΒ² */
acc_x = lsb_to_mps2(bmi270_data.sensor_data.acc.x,
ACC_RANGE_2G,
bmi270.sensor.resolution);
acc_y = lsb_to_mps2(bmi270_data.sensor_data.acc.y,
ACC_RANGE_2G,
bmi270.sensor.resolution);
acc_z = lsb_to_mps2(bmi270_data.sensor_data.acc.z,
ACC_RANGE_2G,
bmi270.sensor.resolution);
/* Calculate magnitude */
magnitude = calculate_magnitude(acc_x, acc_y, acc_z);
/* Detect motion state */
motion_state = detect_motion(magnitude);
/* Display results */
printf("Accelerometer:\r\n");
printf(" x: %9.6f m/s^2\r\n", (double)acc_x);
printf(" y: %9.6f m/s^2\r\n", (double)acc_y);
printf(" z: %9.6f m/s^2\r\n", (double)acc_z);
printf("\r\n");
printf("Magnitude: %9.6f m/s^2 (%.2f g)\r\n",
(double)magnitude,
(double)(magnitude / GRAVITY_EARTH));
printf("Motion: %s (deviation: %.2f g)\r\n",
get_motion_string(motion_state),
(double)(fabsf(magnitude - GRAVITY_EARTH) / GRAVITY_EARTH));
/* LED feedback - Active LOW (PSoC Edge E84) */
/* Turn LED ON when motion is MODERATE or higher */
if (motion_state >= MOTION_MODERATE)
{
LED_ON(); /* Clr = ON for Active LOW */
}
else
{
LED_OFF(); /* Set = OFF for Active LOW */
}
/* Move cursor back for clean display */
printf("\x1b[7A");
/* Wait for UART */
while(!(Cy_SCB_UART_IsTxComplete(CYBSP_DEBUG_UART_HW))) {};
vTaskDelayUntil(&xLastWakeTime, xDelay);
}
}
