mirror of
https://github.com/UberGuidoZ/Flipper.git
synced 2024-12-25 16:00:12 +00:00
30 lines
763 B
C
30 lines
763 B
C
|
#include "imu.h"
|
||
|
#include <furi_hal.h>
|
||
|
|
||
|
bool bmi160_begin();
|
||
|
int bmi160_read(double* vec);
|
||
|
|
||
|
bool lsm6ds3trc_begin();
|
||
|
void lsm6ds3trc_end();
|
||
|
int lsm6ds3trc_read(double* vec);
|
||
|
|
||
|
bool imu_begin() {
|
||
|
furi_hal_i2c_acquire(&furi_hal_i2c_handle_external);
|
||
|
bool ret = bmi160_begin(); // lsm6ds3trc_begin();
|
||
|
furi_hal_i2c_release(&furi_hal_i2c_handle_external);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
void imu_end() {
|
||
|
// furi_hal_i2c_acquire(&furi_hal_i2c_handle_external);
|
||
|
// lsm6ds3trc_end();
|
||
|
// furi_hal_i2c_release(&furi_hal_i2c_handle_external);
|
||
|
}
|
||
|
|
||
|
int imu_read(double* vec) {
|
||
|
furi_hal_i2c_acquire(&furi_hal_i2c_handle_external);
|
||
|
int ret = bmi160_read(vec); // lsm6ds3trc_read(vec);
|
||
|
furi_hal_i2c_release(&furi_hal_i2c_handle_external);
|
||
|
return ret;
|
||
|
}
|