mirrors
/
Tasmota
mirror of https://github.com/arendst/Tasmota.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #12342 from s-hadinger/mpu9250 

I2C extended MPU6886 to also support MPU9250 (found in Legacy M5Stack Fire)
This commit is contained in:
s-hadinger 2021-06-11 13:44:34 +02:00 committed by GitHub
parent 8693f5b0a8 1c5bcd6dad
commit 9915878410
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
9 changed files with 108 additions and 86 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
CHANGELOG.md
View File

@ -12,6 +12,7 @@ All notable changes to this project will be documented in this file.
- Command ``Timers`` layout of JSON message changed to single line - Command ``Timers`` layout of JSON message changed to single line
- Command ``Gpio`` layout of JSON message changed to single line - Command ``Gpio`` layout of JSON message changed to single line
- Command ``Modules`` layout of JSON message changed to single line - Command ``Modules`` layout of JSON message changed to single line
- I2C extended MPU6886 to also support MPU9250 (found in Legacy M5Stack Fire)
## [9.4.0.4] ## [9.4.0.4]
### Added ### Added

2
I2CDEVICES.md
View File

@ -91,5 +91,5 @@ Index | Define | Driver | Device | Address(es) | Description
55 | USE_EZOPMP | xsns_78 | EZOPMP | 0x61 - 0x70 | Peristaltic Pump 55 | USE_EZOPMP | xsns_78 | EZOPMP | 0x61 - 0x70 | Peristaltic Pump
56 | USE_SEESAW_SOIL | xsns_81 | SEESOIL | 0x36 - 0x39 | Adafruit seesaw soil moisture sensor 56 | USE_SEESAW_SOIL | xsns_81 | SEESOIL | 0x36 - 0x39 | Adafruit seesaw soil moisture sensor
57 | USE_TOF10120 | xsns_84 | TOF10120 | 0x52 | Time-of-flight (ToF) distance sensor 57 | USE_TOF10120 | xsns_84 | TOF10120 | 0x52 | Time-of-flight (ToF) distance sensor
58 | USE_MPU6886 | xsns_85 | MPU6886 | 0x68 | MPU6886 M5Stack 58 | USE_MPU_ACCEL | xsns_85 | MPU_ACCEL| 0x68 | MPU6886/MPU9250 6-axis MotionTracking sensor from M5Stack
59 | USE_BM8563 | xdrv_56 | BM8563 | 0x51 | BM8563 RTC from M5Stack 59 | USE_BM8563 | xdrv_56 | BM8563 | 0x51 | BM8563 RTC from M5Stack

8
lib/lib_i2c/MPU6886/library.properties → lib/lib_i2c/MPU_accel/library.properties
View File

@ -1,9 +1,9 @@
name=MPU6886 name=MPU_accel
version= version=
author=M5StickC author=M5StickC
maintainer=Stephan Hadinger maintainer=Stephan Hadinger
sentence=Support for MPU6886 sentence=Support for MPU6886, MPU9250
paragraph=Support for MPU6886 paragraph=Support for MPU6886, MPU9250
category= category=
url=https://github.com/m5stack/M5StickC/blob/master/src/utility/ url=https://github.com/m5stack/M5StickC/blob/master/src/utility/
architectures=esp32,esp8266 architectures=*

42
lib/lib_i2c/MPU6886/src/MPU6886.cpp → lib/lib_i2c/MPU_accel/src/MPU_accel.cpp
View File

@ -1,8 +1,8 @@
#include "MPU6886.h" #include "MPU_accel.h"
#include <math.h> #include <math.h>
#include <Arduino.h> #include <Arduino.h>
void MPU6886::I2C_Read_NBytes(uint8_t driver_Addr, uint8_t start_Addr, uint8_t number_Bytes, uint8_t *read_Buffer){ void MPU_accel::I2C_Read_NBytes(uint8_t driver_Addr, uint8_t start_Addr, uint8_t number_Bytes, uint8_t *read_Buffer){
myWire->beginTransmission(driver_Addr); myWire->beginTransmission(driver_Addr);
myWire->write(start_Addr); myWire->write(start_Addr);
@ -16,7 +16,7 @@ void MPU6886::I2C_Read_NBytes(uint8_t driver_Addr, uint8_t start_Addr, uint8_t n
} }
} }
void MPU6886::I2C_Write_NBytes(uint8_t driver_Addr, uint8_t start_Addr, uint8_t number_Bytes, uint8_t *write_Buffer){ void MPU_accel::I2C_Write_NBytes(uint8_t driver_Addr, uint8_t start_Addr, uint8_t number_Bytes, uint8_t *write_Buffer){
myWire->beginTransmission(driver_Addr); myWire->beginTransmission(driver_Addr);
myWire->write(start_Addr); myWire->write(start_Addr);
@ -25,13 +25,19 @@ void MPU6886::I2C_Write_NBytes(uint8_t driver_Addr, uint8_t start_Addr, uint8_t
} }
int MPU6886::Init(void){ int MPU_accel::Init(void){
unsigned char tempdata[1]; unsigned char tempdata[1];
unsigned char regdata; unsigned char regdata;
I2C_Read_NBytes(MPU6886_ADDRESS, MPU6886_WHOAMI, 1, tempdata); I2C_Read_NBytes(MPU6886_ADDRESS, MPU6886_WHOAMI, 1, tempdata);
if(tempdata[0] != 0x19) const uint8_t whoami = tempdata[0];
if (whoami == 0x19) {
model = 6886; // MPU6886
} else if (whoami == 0x71) {
model = 9250; // MPU9250
} else {
return -1; return -1;
}
delay(1); delay(1);
regdata = 0x00; regdata = 0x00;
@ -91,7 +97,7 @@ int MPU6886::Init(void){
return 0; return 0;
} }
void MPU6886::getAccelAdc(int16_t* ax, int16_t* ay, int16_t* az){ void MPU_accel::getAccelAdc(int16_t* ax, int16_t* ay, int16_t* az){
uint8_t buf[6]; uint8_t buf[6];
I2C_Read_NBytes(MPU6886_ADDRESS,MPU6886_ACCEL_XOUT_H,6,buf); I2C_Read_NBytes(MPU6886_ADDRESS,MPU6886_ACCEL_XOUT_H,6,buf);
@ -101,7 +107,7 @@ void MPU6886::getAccelAdc(int16_t* ax, int16_t* ay, int16_t* az){
*az=((int16_t)buf[4]<<8)|buf[5]; *az=((int16_t)buf[4]<<8)|buf[5];
} }
void MPU6886::getGyroAdc(int16_t* gx, int16_t* gy, int16_t* gz){ void MPU_accel::getGyroAdc(int16_t* gx, int16_t* gy, int16_t* gz){
uint8_t buf[6]; uint8_t buf[6];
I2C_Read_NBytes(MPU6886_ADDRESS,MPU6886_GYRO_XOUT_H,6,buf); I2C_Read_NBytes(MPU6886_ADDRESS,MPU6886_GYRO_XOUT_H,6,buf);
@ -112,7 +118,7 @@ void MPU6886::getGyroAdc(int16_t* gx, int16_t* gy, int16_t* gz){
} }
void MPU6886::getTempAdc(int16_t *t){ void MPU_accel::getTempAdc(int16_t *t){
uint8_t buf[2]; uint8_t buf[2];
I2C_Read_NBytes(MPU6886_ADDRESS,MPU6886_TEMP_OUT_H,2,buf); I2C_Read_NBytes(MPU6886_ADDRESS,MPU6886_TEMP_OUT_H,2,buf);
@ -123,7 +129,7 @@ void MPU6886::getTempAdc(int16_t *t){
// //!俯仰，航向，横滚：pitch，yaw，roll，指三维空间中飞行器的旋转状态。 // //!俯仰，航向，横滚：pitch，yaw，roll，指三维空间中飞行器的旋转状态。
// void MPU6886::getAhrsData(float *pitch,float *roll,float *yaw){ // void MPU_accel::getAhrsData(float *pitch,float *roll,float *yaw){
// float accX = 0; // float accX = 0;
// float accY = 0; // float accY = 0;
@ -141,7 +147,7 @@ void MPU6886::getTempAdc(int16_t *t){
// } // }
void MPU6886::getGres(){ void MPU_accel::getGres(){
switch (Gyscale) switch (Gyscale)
{ {
@ -167,7 +173,7 @@ void MPU6886::getGres(){
} }
void MPU6886::getAres(){ void MPU_accel::getAres(){
switch (Acscale) switch (Acscale)
{ {
// Possible accelerometer scales (and their register bit settings) are: // Possible accelerometer scales (and their register bit settings) are:
@ -193,7 +199,7 @@ void MPU6886::getAres(){
} }
void MPU6886::SetGyroFsr(Gscale scale) void MPU_accel::SetGyroFsr(Gscale scale)
{ {
//return IIC_Write_Byte(MPU_GYRO_CFG_REG,scale<<3);//设置陀螺仪满量程范围 //return IIC_Write_Byte(MPU_GYRO_CFG_REG,scale<<3);//设置陀螺仪满量程范围
unsigned char regdata; unsigned char regdata;
@ -205,7 +211,7 @@ void MPU6886::SetGyroFsr(Gscale scale)
getGres(); getGres();
} }
void MPU6886::SetAccelFsr(Ascale scale) void MPU_accel::SetAccelFsr(Ascale scale)
{ {
unsigned char regdata; unsigned char regdata;
regdata = (scale<<3); regdata = (scale<<3);
@ -219,7 +225,7 @@ void MPU6886::SetAccelFsr(Ascale scale)
// x/y/z are in 1/1000 if g // x/y/z are in 1/1000 if g
// avoiding costly float calculations // avoiding costly float calculations
void MPU6886::getAccelDataInt(int16_t* ax, int16_t* ay, int16_t* az) { void MPU_accel::getAccelDataInt(int16_t* ax, int16_t* ay, int16_t* az) {
int16_t accX = 0; int16_t accX = 0;
int16_t accY = 0; int16_t accY = 0;
int16_t accZ = 0; int16_t accZ = 0;
@ -231,7 +237,7 @@ void MPU6886::getAccelDataInt(int16_t* ax, int16_t* ay, int16_t* az) {
} }
void MPU6886::getAccelData(float* ax, float* ay, float* az){ void MPU_accel::getAccelData(float* ax, float* ay, float* az){
int16_t accX = 0; int16_t accX = 0;
@ -248,7 +254,7 @@ void MPU6886::getAccelData(float* ax, float* ay, float* az){
// x/y/z are in dps - degrees per second // x/y/z are in dps - degrees per second
// avoiding costly float calculations // avoiding costly float calculations
void MPU6886::getGyroDataInt(int16_t* ax, int16_t* ay, int16_t* az) { void MPU_accel::getGyroDataInt(int16_t* ax, int16_t* ay, int16_t* az) {
int16_t gyX = 0; int16_t gyX = 0;
int16_t gyY = 0; int16_t gyY = 0;
int16_t gyZ = 0; int16_t gyZ = 0;
@ -260,7 +266,7 @@ void MPU6886::getGyroDataInt(int16_t* ax, int16_t* ay, int16_t* az) {
} }
void MPU6886::getGyroData(float* gx, float* gy, float* gz){ void MPU_accel::getGyroData(float* gx, float* gy, float* gz){
int16_t gyroX = 0; int16_t gyroX = 0;
int16_t gyroY = 0; int16_t gyroY = 0;
int16_t gyroZ = 0; int16_t gyroZ = 0;
@ -271,7 +277,7 @@ void MPU6886::getGyroData(float* gx, float* gy, float* gz){
*gz = (float)gyroZ * gRes; *gz = (float)gyroZ * gRes;
} }
void MPU6886::getTempData(float *t){ void MPU_accel::getTempData(float *t){
int16_t temp = 0; int16_t temp = 0;
getTempAdc(&temp); getTempAdc(&temp);

9
lib/lib_i2c/MPU6886/src/MPU6886.h → lib/lib_i2c/MPU_accel/src/MPU_accel.h
View File

@ -5,6 +5,9 @@
library in the Wire.h/twi.c utility file. We are also using the 400 kHz fast library in the Wire.h/twi.c utility file. We are also using the 400 kHz fast
I2C mode by setting the TWI_FREQ to 400000L /twi.h utility file. I2C mode by setting the TWI_FREQ to 400000L /twi.h utility file.
*/ */
// Extended to support MPU9250 and other variants
#ifndef _MPU6886_H_ #ifndef _MPU6886_H_
#define _MPU6886_H_ #define _MPU6886_H_
@ -48,7 +51,7 @@
#define AtR 0.0174533 #define AtR 0.0174533
#define Gyro_Gr 0.0010653 #define Gyro_Gr 0.0010653
class MPU6886 { class MPU_accel {
public: public:
enum Ascale { enum Ascale {
AFS_2G = 0, AFS_2G = 0,
@ -68,14 +71,16 @@ class MPU6886 {
Ascale Acscale = AFS_8G; Ascale Acscale = AFS_8G;
int16_t acRange = 8000; // 1/1000 of g int16_t acRange = 8000; // 1/1000 of g
int16_t gyRange = 2000; // dps - degree per second int16_t gyRange = 2000; // dps - degree per second
uint32_t model = 6886; // MPU model number
public: public:
MPU6886(void) {}; MPU_accel(void) {};
#ifdef ESP32 #ifdef ESP32
void setBus(uint32_t _bus) { myWire = _bus ? &Wire1 : &Wire; }; void setBus(uint32_t _bus) { myWire = _bus ? &Wire1 : &Wire; };
#else #else
void setBus(uint32_t _bus) { myWire = &Wire; }; void setBus(uint32_t _bus) { myWire = &Wire; };
#endif #endif
int Init(void); int Init(void);
uint32_t getModel(void) const { return model; }
void getAccelAdc(int16_t* ax, int16_t* ay, int16_t* az); void getAccelAdc(int16_t* ax, int16_t* ay, int16_t* az);
void getGyroAdc(int16_t* gx, int16_t* gy, int16_t* gz); void getGyroAdc(int16_t* gx, int16_t* gy, int16_t* gz);
void getTempAdc(int16_t *t); void getTempAdc(int16_t *t);

31
tasmota/berry/drivers/mpu6886.be → tasmota/berry/drivers/mpu_accel.be
View File

@ -7,6 +7,7 @@
class MPU6886 : Driver class MPU6886 : Driver
var wire #- if wire == nil then the module is not initialized -# var wire #- if wire == nil then the module is not initialized -#
var device
var gres, ares var gres, ares
var accel, gyro var accel, gyro
@ -15,7 +16,10 @@ class MPU6886 : Driver
if self.wire if self.wire
var v = self.wire.read(0x68,0x75,1) var v = self.wire.read(0x68,0x75,1)
if v != 0x19 return end #- wrong device -# if v == 0x19 self.device = 6886
elif v == 0x71 self.device = 9250
else self.wire = nil return #- wrong device -#
end
self.wire.write(0x68, 0x6B, 0, 1) self.wire.write(0x68, 0x6B, 0, 1)
tasmota.delay(10) tasmota.delay(10)
@ -46,7 +50,7 @@ class MPU6886 : Driver
self.gres = 2000.0/32768.0 self.gres = 2000.0/32768.0
self.ares = 8.0/32678.0 self.ares = 8.0/32678.0
print("I2C: MPU6886 detected on bus "+str(self.wire.bus)) print("I2C:","MPU"+str(self.device),"detected on bus",self.wire.bus)
end end
end end
@ -90,13 +94,14 @@ class MPU6886 : Driver
if !self.wire return nil end #- exit if not initialized -# if !self.wire return nil end #- exit if not initialized -#
import string import string
var msg = string.format( var msg = string.format(
"{s}MPU6886 acc_x{m}%.3f G{e}".. "{s}MPU%d acc_x{m}%.3f G{e}"..
"{s}MPU6886 acc_y{m}%.3f G{e}".. "{s}MPU%d acc_y{m}%.3f G{e}"..
"{s}MPU6886 acc_z{m}%.3f G{e}".. "{s}MPU%d acc_z{m}%.3f G{e}"..
"{s}MPU6886 gyr_x{m}%i dps{e}".. "{s}MPU%d gyr_x{m}%i dps{e}"..
"{s}MPU6886 gyr_y{m}%i dps{e}".. "{s}MPU%d gyr_y{m}%i dps{e}"..
"{s}MPU6886 gyr_z{m}%i dps{e}", "{s}MPU%d gyr_z{m}%i dps{e}",
self.accel[0], self.accel[1], self.accel[2], self.gyro[0], self.gyro[1], self.gyro[2]) self.device, self.accel[0], self.device, self.accel[1], self.device, self.accel[2],
self.device, self.gyro[0], self.device, self.gyro[1], self.device, self.gyro[2])
tasmota.web_send_decimal(msg) tasmota.web_send_decimal(msg)
end end
@ -107,11 +112,11 @@ class MPU6886 : Driver
var ax = int(self.accel[0] * 1000) var ax = int(self.accel[0] * 1000)
var ay = int(self.accel[1] * 1000) var ay = int(self.accel[1] * 1000)
var az = int(self.accel[2] * 1000) var az = int(self.accel[2] * 1000)
var msg = string.format(",\"MPU6886\":{\"AX\":%i,\"AY\":%i,\"AZ\":%i,\"GX\":%i,\"GY\":%i,\"GZ\":%i}", var msg = string.format(",\"MPU%d\":{\"AX\":%i,\"AY\":%i,\"AZ\":%i,\"GX\":%i,\"GY\":%i,\"GZ\":%i}",
ax, ay, az, self.gyro[0], self.gyro[1], self.gyro[2]) self.device, ax, ay, az, self.gyro[0], self.gyro[1], self.gyro[2])
tasmota.response_append(msg) tasmota.response_append(msg)
end end
end end
mpu6886 = MPU6886() mpu_accel = MPU6886()
tasmota.add_driver(mpu6886) tasmota.add_driver(mpu_accel)

4
tasmota/my_user_config.h
View File

@ -628,8 +628,8 @@
// #define USE_EZORGB // [I2cDriver55] Enable support for EZO's RGB sensor (+0k5 code) - Shared EZO code required for any EZO device (+1k2 code) // #define USE_EZORGB // [I2cDriver55] Enable support for EZO's RGB sensor (+0k5 code) - Shared EZO code required for any EZO device (+1k2 code)
// #define USE_EZOPMP // [I2cDriver55] Enable support for EZO's PMP sensor (+0k3 code) - Shared EZO code required for any EZO device (+1k2 code) // #define USE_EZOPMP // [I2cDriver55] Enable support for EZO's PMP sensor (+0k3 code) - Shared EZO code required for any EZO device (+1k2 code)
// #define USE_SEESAW_SOIL // [I2cDriver56] Enable Capacitice Soil Moisture & Temperature Sensor (I2C addresses 0x36 - 0x39) (+1k3 code) // #define USE_SEESAW_SOIL // [I2cDriver56] Enable Capacitice Soil Moisture & Temperature Sensor (I2C addresses 0x36 - 0x39) (+1k3 code)
// #define USE_MPU6886 // [I2cDriver58] Enable MPU6886 - found in M5Stack - support both I2C buses on ESP32 (I2C address 0x68) (+2k code) // #define USE_MPU_ACCEL // [I2cDriver58] Enable MPU6886/MPU9250 - found in M5Stack - support both I2C buses on ESP32 (I2C address 0x68) (+2k code)
// #define USE_BM8563 // [I2cDriver58] Enable BM8563 RTC - found in M5Stack - support both I2C buses on ESP32 (I2C address 0x51) (+2.5k code) // #define USE_BM8563 // [I2cDriver59] Enable BM8563 RTC - found in M5Stack - support both I2C buses on ESP32 (I2C address 0x51) (+2.5k code)
// #define USE_DISPLAY // Add I2C Display Support (+2k code) // #define USE_DISPLAY // Add I2C Display Support (+2k code)
#define USE_DISPLAY_MODES1TO5 // Enable display mode 1 to 5 in addition to mode 0 #define USE_DISPLAY_MODES1TO5 // Enable display mode 1 to 5 in addition to mode 0

4
tasmota/tasmota_configurations_ESP32.h
View File

@ -106,7 +106,7 @@
#define USE_I2C #define USE_I2C
#define USE_BMA423 #define USE_BMA423
#define USE_MPU6886 #define USE_MPU_ACCEL
#define USE_SPI #define USE_SPI
#define USE_DISPLAY #define USE_DISPLAY
#ifdef USE_UNIVERSAL_DISPLAY #ifdef USE_UNIVERSAL_DISPLAY
@ -233,7 +233,7 @@
//#define USE_MPR121 // [I2cDriver23] Enable MPR121 controller (I2C addresses 0x5A, 0x5B, 0x5C and 0x5D) in input mode for touch buttons (+1k3 code) //#define USE_MPR121 // [I2cDriver23] Enable MPR121 controller (I2C addresses 0x5A, 0x5B, 0x5C and 0x5D) in input mode for touch buttons (+1k3 code)
//#define USE_CCS811 // [I2cDriver24] Enable CCS811 sensor (I2C address 0x5A) (+2k2 code) //#define USE_CCS811 // [I2cDriver24] Enable CCS811 sensor (I2C address 0x5A) (+2k2 code)
#define USE_CCS811_V2 // [I2cDriver24] Enable CCS811 sensor (I2C addresses 0x5A and 0x5B) (+2k8 code) #define USE_CCS811_V2 // [I2cDriver24] Enable CCS811 sensor (I2C addresses 0x5A and 0x5B) (+2k8 code)
#define USE_MPU6886 // [I2cDriver??] Enable MPU6886 6-axis MotionTracking sensor (I2C address 0x68) #define USE_MPU_ACCEL // [I2cDriver58] Enable MPU6886, MPU9250 6-axis MotionTracking sensor (I2C address 0x68)
//#define USE_MPU6050 // [I2cDriver25] Enable MPU6050 sensor (I2C address 0x68 AD0 low or 0x69 AD0 high) (+3K3 of code and 188 Bytes of RAM) //#define USE_MPU6050 // [I2cDriver25] Enable MPU6050 sensor (I2C address 0x68 AD0 low or 0x69 AD0 high) (+3K3 of code and 188 Bytes of RAM)
//#define USE_DS3231 // [I2cDriver26] Enable DS3231 external RTC in case no Wifi is avaliable. See docs in the source file (+1k2 code) //#define USE_DS3231 // [I2cDriver26] Enable DS3231 external RTC in case no Wifi is avaliable. See docs in the source file (+1k2 code)
//#define USE_MGC3130 // [I2cDriver27] Enable MGC3130 Electric Field Effect Sensor (I2C address 0x42) (+2k7 code, 0k3 mem) //#define USE_MGC3130 // [I2cDriver27] Enable MGC3130 Electric Field Effect Sensor (I2C address 0x42) (+2k7 code, 0k3 mem)

93
tasmota/xsns_85_mpu6886.ino
View File

@ -18,11 +18,11 @@
*/ */
#ifdef USE_I2C #ifdef USE_I2C
#ifdef USE_MPU6886 #if defined(USE_MPU6886) || defined(USE_MPU_ACCEL) // USE_MPU6886 deprecated, prefer USE_MPU_ACCEL
#include <MPU6886.h> #include <MPU_accel.h>
/*********************************************************************************************\ /*********************************************************************************************\
* MPU6886 * MPU6886/MPU9250
* Internal chip found in M5Stack devices, using `Wire1` internal I2C bus * Internal chip found in M5Stack devices, using `Wire1` internal I2C bus
* *
* I2C Address: 0x68 * I2C Address: 0x68
@ -32,65 +32,70 @@
#define XSNS_85 85 #define XSNS_85 85
#define XI2C_58 58 // See I2CDEVICES.md #define XI2C_58 58 // See I2CDEVICES.md
#define MPU6886_ADDRESS 0x68 #define MPU_ACCEL_ADDRESS 0x68
struct { struct {
MPU6886 Mpu; MPU_accel Mpu;
bool ready = false; uint32_t mpu_model;
int16_t ax=0, ay=0, az=0; // accelerator data int16_t ax=0, ay=0, az=0; // accelerator data
int16_t gyx=0, gyy=0, gyz=0; // accelerator data int16_t gyx=0, gyy=0, gyz=0; // accelerator data
} mpu6886_sensor; uint8_t bus = 0; // I2C bus
bool ready = false;
} mpu_sensor;
/********************************************************************************************/ /********************************************************************************************/
const char HTTP_MPU6686[] PROGMEM = const char HTTP_MPU6686[] PROGMEM =
"{s}MPU6886 acc_x" "{m}%3_f G" "{e}" "{s}MPU%d acc_x" "{m}%3_f G" "{e}"
"{s}MPU6886 acc_y" "{m}%3_f G" "{e}" "{s}MPU%d acc_y" "{m}%3_f G" "{e}"
"{s}MPU6886 acc_z" "{m}%3_f G" "{e}" "{s}MPU%d acc_z" "{m}%3_f G" "{e}"
"{s}MPU6886 gyr_x" "{m}%i dps" "{e}" "{s}MPU%d gyr_x" "{m}%i dps" "{e}"
"{s}MPU6886 gyr_y" "{m}%i dps" "{e}" "{s}MPU%d gyr_y" "{m}%i dps" "{e}"
"{s}MPU6886 gyr_z" "{m}%i dps" "{e}" "{s}MPU%d gyr_z" "{m}%i dps" "{e}"
; ;
void MPU6686_Show(uint32_t json) { void MPU_Show(uint32_t json) {
if (json) { if (json) {
ResponseAppend_P(PSTR(",\"MPU6886\":{\"AX\":%i,\"AY\":%i,\"AZ\":%i,\"GX\":%i,\"GY\":%i,\"GZ\":%i}"), ResponseAppend_P(PSTR(",\"MPU%d\":{\"AX\":%i,\"AY\":%i,\"AZ\":%i,\"GX\":%i,\"GY\":%i,\"GZ\":%i}"),
mpu6886_sensor.ax, mpu6886_sensor.ay, mpu6886_sensor.az, mpu_sensor.mpu_model,
mpu6886_sensor.gyx, mpu6886_sensor.gyy, mpu6886_sensor.gyz); mpu_sensor.ax, mpu_sensor.ay, mpu_sensor.az,
mpu_sensor.gyx, mpu_sensor.gyy, mpu_sensor.gyz);
} else { } else {
float ax = mpu6886_sensor.ax / 1000.0f; float ax = mpu_sensor.ax / 1000.0f;
float ay = mpu6886_sensor.ay / 1000.0f; float ay = mpu_sensor.ay / 1000.0f;
float az = mpu6886_sensor.az / 1000.0f; float az = mpu_sensor.az / 1000.0f;
WSContentSend_PD(HTTP_MPU6686, &ax, &ay, &az, WSContentSend_PD(HTTP_MPU6686, mpu_sensor.mpu_model, &ax, mpu_sensor.mpu_model, &ay, mpu_sensor.mpu_model, &az,
mpu6886_sensor.gyx, mpu6886_sensor.gyy, mpu6886_sensor.gyz); mpu_sensor.mpu_model, mpu_sensor.gyx, mpu_sensor.mpu_model, mpu_sensor.gyy, mpu_sensor.mpu_model, mpu_sensor.gyz);
} }
} }
void MPU6686Detect(void) { void MPU_Detect(void) {
#ifdef ESP32 #ifdef ESP32
if (!I2cSetDevice(MPU6886_ADDRESS, 0)) { if (!I2cSetDevice(MPU_ACCEL_ADDRESS, 0)) {
if (!I2cSetDevice(MPU6886_ADDRESS, 1)) { return; } // check on bus 1 if (!I2cSetDevice(MPU_ACCEL_ADDRESS, 1)) { return; } // check on bus 1
mpu6886_sensor.Mpu.setBus(1); // switch to bus 1 mpu_sensor.bus = 1;
I2cSetActiveFound(MPU6886_ADDRESS, "MPU6886", 1); mpu_sensor.Mpu.setBus(mpu_sensor.bus); // switch to bus 1
} else {
I2cSetActiveFound(MPU6886_ADDRESS, "MPU6886", 0);
} }
#else #else
if (!I2cSetDevice(MPU6886_ADDRESS)) { return; } if (!I2cSetDevice(MPU_ACCEL_ADDRESS)) { return; }
I2cSetActiveFound(MPU6886_ADDRESS, "MPU6886");
#endif #endif
mpu6886_sensor.Mpu.Init(); if (mpu_sensor.Mpu.Init() == 0) {
mpu6886_sensor.ready = true; char model_name[16];
mpu_sensor.mpu_model = mpu_sensor.Mpu.getModel();
snprintf_P(model_name, sizeof(model_name), PSTR("MPU%04d"), mpu_sensor.mpu_model);
I2cSetActiveFound(MPU_ACCEL_ADDRESS, model_name, mpu_sensor.bus);
mpu_sensor.ready = true;
}
} }
void MPU6886Every_Second(void) { void MPU_Every_Second(void) {
mpu6886_sensor.Mpu.getAccelDataInt(&mpu6886_sensor.ax, &mpu6886_sensor.ay, &mpu6886_sensor.az); mpu_sensor.Mpu.getAccelDataInt(&mpu_sensor.ax, &mpu_sensor.ay, &mpu_sensor.az);
mpu6886_sensor.Mpu.getGyroDataInt(&mpu6886_sensor.gyx, &mpu6886_sensor.gyy, &mpu6886_sensor.gyz); mpu_sensor.Mpu.getGyroDataInt(&mpu_sensor.gyx, &mpu_sensor.gyy, &mpu_sensor.gyz);
// AddLog(LOG_LEVEL_DEBUG, PSTR(">> Acc x=%i y=%i z=%i gx=%i gy=%i gz=%i"), mpu6886_sensor.ax, mpu6886_sensor.ay, mpu6886_sensor.az, // AddLog(LOG_LEVEL_DEBUG, PSTR(">> Acc x=%i y=%i z=%i gx=%i gy=%i gz=%i"), mpu_sensor.ax, mpu_sensor.ay, mpu_sensor.az,
// mpu6886_sensor.gyx, mpu6886_sensor.gyy, mpu6886_sensor.gyz); // mpu_sensor.gyx, mpu_sensor.gyy, mpu_sensor.gyz);
} }
@ -104,19 +109,19 @@ bool Xsns85(uint8_t function) {
bool result = false; bool result = false;
if (FUNC_INIT == function) { if (FUNC_INIT == function) {
MPU6686Detect(); MPU_Detect();
} }
else if (mpu6886_sensor.ready) { else if (mpu_sensor.ready) {
switch (function) { switch (function) {
case FUNC_EVERY_SECOND: case FUNC_EVERY_SECOND:
MPU6886Every_Second(); MPU_Every_Second();
break; break;
case FUNC_JSON_APPEND: case FUNC_JSON_APPEND:
MPU6686_Show(1); MPU_Show(1);
break; break;
#ifdef USE_WEBSERVER #ifdef USE_WEBSERVER
case FUNC_WEB_SENSOR: case FUNC_WEB_SENSOR:
MPU6686_Show(0); MPU_Show(0);
break; break;
#endif // USE_WEBSERVER #endif // USE_WEBSERVER
} }
@ -124,5 +129,5 @@ bool Xsns85(uint8_t function) {
return result; return result;
} }
#endif // USE_MPU6886 #endif // USE_MPU6886 USE_MPU_ACCEL
#endif // USE_I2C #endif // USE_I2C