ank/mpu6050
1
Fork 0
Code Issues Activity

Make device address configurable

Browse source 
The i2c address can be changed by pulling the AD0 pin up (Section 6.4,
Page 15 of datasheet revision 3.2).

This can be necessary to do if there is an address conflict with
another chip.
This commit is contained in:
Niklas Cathor 2021-07-14 20:20:50 +02:00
parent bc49e17aa9
commit 98db8a15c6
2 changed files with 29 additions and 6 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

2
src/device.rs
View file

@ -57,7 +57,7 @@ pub const ACC_REGZ_H : u8= 0x3f;
/// High Byte Register Temperature
pub const TEMP_OUT_H : u8= 0x41;
/// Slave address of Mpu6050
pub const SLAVE_ADDR: u8 = 0x68;
pub const DEFAULT_SLAVE_ADDR: u8 = 0x68;
/// Internal register to check slave addr
pub const WHOAMI: u8 = 0x75;

31
src/lib.rs
View file

@ -76,6 +76,7 @@ pub enum Mpu6050Error<E> {
/// Handles all operations on/with Mpu6050
pub struct Mpu6050<I> {
i2c: I,
slave_addr: u8,
acc_sensitivity: f32,
gyro_sensitivity: f32,
}
@ -88,6 +89,7 @@ where
pub fn new(i2c: I) -> Self {
Mpu6050 {
i2c,
slave_addr: DEFAULT_SLAVE_ADDR,
acc_sensitivity: ACCEL_SENS.0,
gyro_sensitivity: GYRO_SENS.0,
}
@ -97,6 +99,27 @@ where
pub fn new_with_sens(i2c: I, arange: AccelRange, grange: GyroRange) -> Self {
Mpu6050 {
i2c,
slave_addr: DEFAULT_SLAVE_ADDR,
acc_sensitivity: arange.sensitivity(),
gyro_sensitivity: grange.sensitivity(),
}
}
/// Same as `new`, but the chip address can be specified (e.g. 0x69, if the A0 pin is pulled up)
pub fn new_with_addr(i2c: I, slave_addr: u8) -> Self {
Mpu6050 {
i2c,
slave_addr,
acc_sensitivity: ACCEL_SENS.0,
gyro_sensitivity: GYRO_SENS.0,
}
}
/// Combination of `new_with_sens` and `new_with_addr`
pub fn new_with_addr_and_sens(i2c: I, slave_addr: u8, arange: AccelRange, grange: GyroRange) -> Self {
Mpu6050 {
i2c,
slave_addr,
acc_sensitivity: arange.sensitivity(),
gyro_sensitivity: grange.sensitivity(),
}
@ -143,7 +166,7 @@ where
/// Verifies device to address 0x68 with WHOAMI.addr() Register
fn verify(&mut self) -> Result<(), Mpu6050Error<E>> {
let address = self.read_byte(WHOAMI)?;
if address != SLAVE_ADDR {
if address != DEFAULT_SLAVE_ADDR {
return Err(Mpu6050Error::InvalidChipId(address));
}
Ok(())
@ -358,7 +381,7 @@ where
/// Writes byte to register
pub fn write_byte(&mut self, reg: u8, byte: u8) -> Result<(), Mpu6050Error<E>> {
self.i2c.write(SLAVE_ADDR, &[reg, byte])
self.i2c.write(self.slave_addr, &[reg, byte])
.map_err(Mpu6050Error::I2c)?;
// delay disabled for dev build
// TODO: check effects with physical unit
@ -399,14 +422,14 @@ where
/// Reads byte from register
pub fn read_byte(&mut self, reg: u8) -> Result<u8, Mpu6050Error<E>> {
let mut byte: [u8; 1] = [0; 1];
self.i2c.write_read(SLAVE_ADDR, &[reg], &mut byte)
self.i2c.write_read(self.slave_addr, &[reg], &mut byte)
.map_err(Mpu6050Error::I2c)?;
Ok(byte[0])
}
/// Reads series of bytes into buf from specified reg
pub fn read_bytes(&mut self, reg: u8, buf: &mut [u8]) -> Result<(), Mpu6050Error<E>> {
self.i2c.write_read(SLAVE_ADDR, &[reg], buf)
self.i2c.write_read(self.slave_addr, &[reg], buf)
.map_err(Mpu6050Error::I2c)?;
Ok(())
}