Move private IMU data into its mgos_imu_internal.h
This commit is contained in:
@ -17,20 +17,11 @@
|
||||
#pragma once
|
||||
|
||||
#include "mgos.h"
|
||||
#include "mgos_i2c.h"
|
||||
|
||||
struct mgos_imu_mag;
|
||||
struct mgos_imu_acc;
|
||||
struct mgos_imu_gyro;
|
||||
|
||||
typedef bool (*mgos_imu_mag_detect_fn)(struct mgos_imu_mag *dev);
|
||||
typedef bool (*mgos_imu_mag_start_fn)(struct mgos_imu_mag *dev);
|
||||
typedef bool (*mgos_imu_mag_read_fn)(struct mgos_imu_mag *dev);
|
||||
typedef bool (*mgos_imu_acc_detect_fn)(struct mgos_imu_acc *dev);
|
||||
typedef bool (*mgos_imu_acc_start_fn)(struct mgos_imu_acc *dev);
|
||||
typedef bool (*mgos_imu_acc_read_fn)(struct mgos_imu_acc *dev);
|
||||
typedef bool (*mgos_imu_gyro_detect_fn)(struct mgos_imu_gyro *dev);
|
||||
typedef bool (*mgos_imu_gyro_start_fn)(struct mgos_imu_gyro *dev);
|
||||
typedef bool (*mgos_imu_gyro_read_fn)(struct mgos_imu_gyro *dev);
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
enum mgos_imu_acc_type {
|
||||
ACC_NONE = 0,
|
||||
@ -47,53 +38,7 @@ enum mgos_imu_mag_type {
|
||||
MAG_AK8963
|
||||
};
|
||||
|
||||
struct mgos_imu {
|
||||
struct mgos_imu_mag *mag;
|
||||
struct mgos_imu_acc *acc;
|
||||
struct mgos_imu_gyro *gyro;
|
||||
};
|
||||
|
||||
struct mgos_imu_mag {
|
||||
mgos_imu_mag_detect_fn detect;
|
||||
mgos_imu_mag_start_fn start;
|
||||
mgos_imu_mag_read_fn read;
|
||||
|
||||
struct mgos_i2c *i2c;
|
||||
uint8_t i2caddr;
|
||||
enum mgos_imu_mag_type type;
|
||||
|
||||
float gain[3];
|
||||
int16_t data[3];
|
||||
};
|
||||
|
||||
struct mgos_imu_acc {
|
||||
mgos_imu_acc_detect_fn detect;
|
||||
mgos_imu_acc_start_fn start;
|
||||
mgos_imu_acc_read_fn read;
|
||||
|
||||
struct mgos_i2c *i2c;
|
||||
uint8_t i2caddr;
|
||||
enum mgos_imu_acc_type type;
|
||||
|
||||
float scale;
|
||||
int16_t data[3];
|
||||
};
|
||||
|
||||
struct mgos_imu_gyro {
|
||||
mgos_imu_gyro_detect_fn detect;
|
||||
mgos_imu_gyro_start_fn start;
|
||||
mgos_imu_gyro_read_fn read;
|
||||
|
||||
struct mgos_i2c *i2c;
|
||||
uint8_t i2caddr;
|
||||
enum mgos_imu_gyro_type type;
|
||||
|
||||
float scale;
|
||||
float bias[3];
|
||||
int16_t data[3];
|
||||
int16_t temperature;
|
||||
};
|
||||
|
||||
struct mgos_imu;
|
||||
|
||||
struct mgos_imu *mgos_imu_create_i2c(struct mgos_i2c *i2c);
|
||||
bool mgos_imu_add_gyroscope_i2c(struct mgos_imu *sensor, uint8_t i2caddr, enum mgos_imu_gyro_type type);
|
||||
@ -106,23 +51,26 @@ bool mgos_imu_has_accelerometer(struct mgos_imu *sensor);
|
||||
bool mgos_imu_has_gyroscope(struct mgos_imu *sensor);
|
||||
bool mgos_imu_has_magnetometer(struct mgos_imu *sensor);
|
||||
|
||||
/* Read all available sensor data in the IMU */
|
||||
/* Read all available sensor data from the IMU */
|
||||
bool mgos_imu_read(struct mgos_imu *sensor);
|
||||
|
||||
/* Return accelerometer data in units of G */
|
||||
/* Return accelerometer data in units of m/s/s */
|
||||
bool mgos_imu_get_accelerometer(struct mgos_imu *sensor, float *x, float *y, float *z);
|
||||
|
||||
/* Return accelerometer data in units of deg/sec rotation rate */
|
||||
bool mgos_imu_get_gyroscope(struct mgos_imu *sensor, float *x, float *y, float *z);
|
||||
|
||||
/* Return magnetometer data in units of microTesla */
|
||||
/* Return magnetometer data in units of microtesla (1 microtesla = 10 milligauss) */
|
||||
bool mgos_imu_get_magnetometer(struct mgos_imu *sensor, float *x, float *y, float *z);
|
||||
|
||||
/* Return compass heading based on magnetometer data, from [0..359] */
|
||||
bool mgos_imu_get_compass_heading(struct mgos_imu *sensor, uint16_t *heading);
|
||||
|
||||
/*
|
||||
* Initialization function for MGOS -- currently a noop.
|
||||
*/
|
||||
bool mgos_imu_init(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
51
src/mgos_imu.c
Normal file
51
src/mgos_imu.c
Normal file
@ -0,0 +1,51 @@
|
||||
/*
|
||||
* Copyright 2018 Google Inc.
|
||||
*
|
||||
* Licensed under the Apache License, Version 2.0 (the "License");
|
||||
* you may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
|
||||
#include "mgos.h"
|
||||
#include "mgos_imu_internal.h"
|
||||
|
||||
// Private functions follow
|
||||
// Private functions end
|
||||
|
||||
// Public functions follow
|
||||
struct mgos_imu *mgos_imu_create(struct mgos_i2c *i2c, uint8_t i2caddr) {
|
||||
struct mgos_imu *sensor;
|
||||
|
||||
if (!i2c) {
|
||||
return NULL;
|
||||
}
|
||||
|
||||
sensor = calloc(1, sizeof(struct mgos_imu));
|
||||
if (!sensor) {
|
||||
return NULL;
|
||||
}
|
||||
return sensor;
|
||||
}
|
||||
|
||||
void mgos_imu_destroy(struct mgos_imu **sensor) {
|
||||
if (!*sensor) {
|
||||
return;
|
||||
}
|
||||
free(*sensor);
|
||||
*sensor = NULL;
|
||||
return;
|
||||
}
|
||||
|
||||
bool mgos_imu_init(void) {
|
||||
return true;
|
||||
}
|
||||
|
||||
// Public functions end
|
88
src/mgos_imu_internal.h
Normal file
88
src/mgos_imu_internal.h
Normal file
@ -0,0 +1,88 @@
|
||||
/*
|
||||
* Copyright 2018 Google Inc.
|
||||
*
|
||||
* Licensed under the Apache License, Version 2.0 (the "License");
|
||||
* you may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include "mgos.h"
|
||||
#include "mgos_imu.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
struct mgos_imu_mag;
|
||||
struct mgos_imu_acc;
|
||||
struct mgos_imu_gyro;
|
||||
|
||||
typedef bool (*mgos_imu_mag_detect_fn)(struct mgos_imu_mag *dev);
|
||||
typedef bool (*mgos_imu_mag_start_fn)(struct mgos_imu_mag *dev);
|
||||
typedef bool (*mgos_imu_mag_read_fn)(struct mgos_imu_mag *dev);
|
||||
typedef bool (*mgos_imu_acc_detect_fn)(struct mgos_imu_acc *dev);
|
||||
typedef bool (*mgos_imu_acc_start_fn)(struct mgos_imu_acc *dev);
|
||||
typedef bool (*mgos_imu_acc_read_fn)(struct mgos_imu_acc *dev);
|
||||
typedef bool (*mgos_imu_gyro_detect_fn)(struct mgos_imu_gyro *dev);
|
||||
typedef bool (*mgos_imu_gyro_start_fn)(struct mgos_imu_gyro *dev);
|
||||
typedef bool (*mgos_imu_gyro_read_fn)(struct mgos_imu_gyro *dev);
|
||||
struct mgos_imu {
|
||||
struct mgos_imu_mag * mag;
|
||||
struct mgos_imu_acc * acc;
|
||||
struct mgos_imu_gyro *gyro;
|
||||
};
|
||||
|
||||
struct mgos_imu_mag {
|
||||
mgos_imu_mag_detect_fn detect;
|
||||
mgos_imu_mag_start_fn start;
|
||||
mgos_imu_mag_read_fn read;
|
||||
|
||||
struct mgos_i2c * i2c;
|
||||
uint8_t i2caddr;
|
||||
enum mgos_imu_mag_type type;
|
||||
|
||||
float gain[3];
|
||||
int16_t data[3];
|
||||
};
|
||||
|
||||
struct mgos_imu_acc {
|
||||
mgos_imu_acc_detect_fn detect;
|
||||
mgos_imu_acc_start_fn start;
|
||||
mgos_imu_acc_read_fn read;
|
||||
|
||||
struct mgos_i2c * i2c;
|
||||
uint8_t i2caddr;
|
||||
enum mgos_imu_acc_type type;
|
||||
|
||||
float scale;
|
||||
int16_t data[3];
|
||||
};
|
||||
|
||||
struct mgos_imu_gyro {
|
||||
mgos_imu_gyro_detect_fn detect;
|
||||
mgos_imu_gyro_start_fn start;
|
||||
mgos_imu_gyro_read_fn read;
|
||||
|
||||
struct mgos_i2c * i2c;
|
||||
uint8_t i2caddr;
|
||||
enum mgos_imu_gyro_type type;
|
||||
|
||||
float scale;
|
||||
float bias[3];
|
||||
int16_t data[3];
|
||||
int16_t temperature;
|
||||
};
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
Reference in New Issue
Block a user