108 lines
3.0 KiB
Arduino
108 lines
3.0 KiB
Arduino
/**
|
|
*
|
|
* @license MIT License
|
|
*
|
|
* Copyright (c) 2023 lewis he
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in all
|
|
* copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*
|
|
* @file BHI260AP_DebugInfo.ino
|
|
* @author Lewis He (lewishe@outlook.com)
|
|
* @date 2023-10-08
|
|
* @note Changed from Boschsensortec API https://github.com/boschsensortec/BHY2_SensorAPI
|
|
*/
|
|
#include <Wire.h>
|
|
#include <SPI.h>
|
|
#include <Arduino.h>
|
|
#include "SensorBHI260AP.hpp"
|
|
|
|
#ifdef BHY2_USE_I2C
|
|
#define BHI260AP_SDA 21
|
|
#define BHI260AP_SCL 22
|
|
#define BHI260AP_IRQ 39
|
|
#define BHI260AP_RST -1
|
|
#else
|
|
#define BHI260AP_MOSI 33
|
|
#define BHI260AP_MISO 34
|
|
#define BHI260AP_SCK 35
|
|
#define BHI260AP_CS 36
|
|
#define BHI260AP_IRQ 37
|
|
#define BHI260AP_RST 47
|
|
#endif
|
|
|
|
SensorBHI260AP bhy;
|
|
|
|
|
|
void quaternion_process_callback(uint8_t sensor_id, uint8_t *data_ptr, uint32_t len, uint64_t *timestamp)
|
|
{
|
|
Serial.println(bhy.getSensorName(sensor_id));
|
|
}
|
|
|
|
|
|
|
|
void setup()
|
|
{
|
|
Serial.begin(115200);
|
|
while (!Serial);
|
|
|
|
|
|
// Set the reset pin and interrupt pin, if any
|
|
bhy.setPins(BHI260AP_RST, BHI260AP_IRQ);
|
|
|
|
#ifdef BHY2_USE_I2C
|
|
// Using I2C interface
|
|
// BHI260AP_SLAVE_ADDRESS_L = 0x28
|
|
// BHI260AP_SLAVE_ADDRESS_H = 0x29
|
|
if (!bhy.init(Wire, BHI260AP_SDA, BHI260AP_SCL, BHI260AP_SLAVE_ADDRESS_L)) {
|
|
Serial.print("Failed to init BHI260AP - ");
|
|
Serial.println(bhy.getError());
|
|
while (1) {
|
|
delay(1000);
|
|
}
|
|
}
|
|
#else
|
|
// Using SPI interface
|
|
if (!bhy.init(SPI, BHI260AP_CS, BHI260AP_MOSI, BHI260AP_MISO, BHI260AP_SCK)) {
|
|
Serial.print("Failed to init BHI260AP - ");
|
|
Serial.println(bhy.getError());
|
|
while (1) {
|
|
delay(1000);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
Serial.println("Init BHI260AP Sensor success!");
|
|
|
|
|
|
// Output all current sensor information
|
|
bhy.printInfo(Serial);
|
|
|
|
// Output interrupt configuration information to Serial
|
|
bhy.printInterruptCtrl(Serial);
|
|
}
|
|
|
|
|
|
void loop()
|
|
{
|
|
// Update sensor fifo
|
|
bhy.update();
|
|
delay(50);
|
|
}
|
|
|