FastIMU/src/F_BMI160.hpp at 1212b07a69cc5ab08be08325726114d6a49d613e · LiquidCGS/FastIMU · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
#pragma once

#ifndef _F_BMI160_H_
#define _F_BMI160_H_

#include "IMUBase.hpp"
#include "IMUUtils.hpp"
/*

	BMI160 REGISTERS

*/
#define BMI160_CMD 0x7E
#define BMI160_STEP_CNT_1 0x79
#define BMI160_STEP_CNT_0 0x78
#define BMI160_OFFSET_6 0x77
#define BMI160_OFFSET_5 0x76
#define BMI160_OFFSET_4 0x75
#define BMI160_OFFSET_3 0x74
#define BMI160_OFFSET_2 0x73
#define BMI160_OFFSET_1 0x72
#define BMI160_OFFSET_0 0x71
#define BMI160_NV_CONF 0x70
#define BMI160_SELF_TEST 0x6D
#define BMI160_PMU_TRIGGER 0x6C
#define BMI160_IF_CONF 0x6B
#define BMI160_CONF 0x6A
#define BMI160_FOC_CONF 0x69
#define BMI160_INT_FLAT_1 0x68
#define BMI160_INT_FLAT_0 0x67
#define BMI160_INT_ORIENT_1 0x66
#define BMI160_INT_ORIENT_0 0x65
#define BMI160_INT_TAP_1 0x64
#define BMI160_INT_TAP_0 0x63
#define BMI160_INT_MOTION_3 0x62
#define BMI160_INT_MOTION_2 0x61
#define BMI160_INT_MOTION_1 0x60
#define BMI160_INT_MOTION_0 0x5F
#define BMI160_INT_LOWHIGH_4 0x5E
#define BMI160_INT_LOWHIGH_3 0x5D
#define BMI160_INT_LOWHIGH_2 0x5C
#define BMI160_INT_LOWHIGH_1 0x5B
#define BMI160_INT_LOWHIGH_0 0x5A
#define BMI160_INT_DATA_1 0x59
#define BMI160_INT_DATA_0 0x58
#define BMI160_INT_MAP_2 0x57
#define BMI160_INT_MAP_1 0x56
#define BMI160_INT_MAP_0 0x55
#define BMI160_INT_LATCH 0x54
#define BMI160_INT_OUT_CTRL 0x53
#define BMI160_INT_EN_2 0x52
#define BMI160_INT_EN_1 0x51
#define BMI160_INT_EN_0 0x50
#define BMI160_MAG_IF_4 0x4F
#define BMI160_MAG_IF_3 0x4E
#define BMI160_MAG_IF_2 0x4D
#define BMI160_MAG_IF_1 0x4C
#define BMI160_MAG_IF_0 0x4B
#define BMI160_FIFO_CONFIG_1 0x47
#define BMI160_FIFO_CONFIG_0 0x46
#define BMI160_FIFO_DOWNS 0x45
#define BMI160_MAG_CONF 0x44
#define BMI160_GYR_RANGE 0x43
#define BMI160_GYR_CONF 0x42
#define BMI160_ACC_RANGE 0x41
#define BMI160_ACC_CONF 0x40
#define BMI160_FIFO_DATA 0x24
#define BMI160_FIFO_LENGTH_1 0x23
#define BMI160_FIFO_LENGTH_0 0x22
#define BMI160_TEMPERATURE_1 0x21
#define BMI160_TEMPERATURE_0 0x20
#define BMI160_INT_STATUS_3 0x1F
#define BMI160_INT_STATUS_2 0x1E
#define BMI160_INT_STATUS_1 0x1D
#define BMI160_INT_STATUS_0	0x1C
#define BMI160_STATUS 0x1B
#define BMI160_SENSOR_TIME_H 0x1A
#define BMI160_SENSOR_TIME_M 0x19
#define BMI160_SENSOR_TIME_L 0x18
#define BMI160_ACC_Z_H 0x17
#define BMI160_ACC_Z_L 0x16
#define BMI160_ACC_Y_H 0x15
#define BMI160_ACC_Y_L 0x14
#define BMI160_ACC_X_H 0x13
#define BMI160_ACC_X_L 0x12
#define BMI160_GYR_Z_H 0x11
#define BMI160_GYR_Z_L 0x10
#define BMI160_GYR_Y_H 0x0F
#define BMI160_GYR_Y_L 0x0E
#define BMI160_GYR_X_H 0x0D
#define BMI160_GYR_X_L 0x0C
#define BMI160_RHALL_H 0x0B
#define BMI160_RHALL_L 0x0A
#define BMI160_MAG_Z_H 0x09
#define BMI160_MAG_Z_L 0x08
#define BMI160_MAG_Y_H 0x07
#define BMI160_MAG_Y_L 0x06
#define BMI160_MAG_X_H 0x05
#define BMI160_MAG_X_L 0x04
#define BMI160_PMU_STATUS 0x03
#define BMI160_ERR_REG 0x02
#define BMI160_CHIP_ID 0x00
#define BMI160_CHIP_ID_DEFAULT_VALUE 0xD1
#define BMI160_DEFAULT_ADDRESS 0x69

class BMI160 : public IMUBase {
public:
	explicit BMI160(TwoWire& wire = Wire) : wire(wire) {};

	// Inherited via IMUBase
	int init(calData cal, uint8_t address = BMI160_DEFAULT_ADDRESS) override;

	void update() override;
	void getAccel(AccelData* out) override;
	void getGyro(GyroData* out) override;
	void getMag(MagData* out) override {};
	void getQuat(Quaternion* out) override {};
	float getTemp() override { return temperature; };

	int setAccelODR(uint8_t odr);		// Set accel ODR: 0x06=25Hz, 0x0A=400Hz, 0x0C=1600Hz
	int setGyroODR(uint8_t odr);		// Set gyro ODR: 0x06=25Hz, 0x0A=400Hz, 0x0C=1600Hz, 0x0D=3200Hz
	int setAccelBandwidth(uint8_t bwp); // Set accel bandwidth: 0=normal, 1=RES_OSR4
	int setGyroBandwidth(uint8_t bwp);	// Set gyro bandwidth/OSR: 0=OSR4, 1=OSR2, 2=normal, 3=CIC
	int setGyroRange(int range) override;
	int setAccelRange(int range) override;
	int setIMUGeometry(int index) override { geometryIndex = index; return 0; };

	void calibrateAccelGyro(calData* cal) override;
	virtual void calibrateMag(calData* cal) override {};

	bool hasMagnetometer() override {
		return false;
	}
	bool hasTemperature() override {
		return true;
	}
	bool hasQuatOutput() override {
		return false;
	}

	String IMUName() override {
		return "BMI-160";
	}
	String IMUType() override {
		return "BMI160";
	}
	String IMUManufacturer() override {
		return "Bosch";
	}

private:
	float aRes = 16.0 / 32768.0;			//ares value for full range (16g) readings
	float gRes = 2000.0 / 32768.0;			//gres value for full range (2000dps) readings
	int geometryIndex = 0;

	float temperature = 0.f;
	AccelData accel = { 0 };
	GyroData gyro = { 0 };

	calData calibration;
	uint8_t IMUAddress;

	TwoWire& wire;
};
#endif /* _F_BMI160_H_ */