Cansat
/
esp32_Adafruit_BusIO
2
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Merge branch 'master' of github.com:adafruit/Adafruit_BusIO

This commit is contained in:
lady ada 2022-07-31 23:25:28 -04:00
parent 399aeea376 23ac286bd0
commit 8c7a20af42
1 changed files with 32 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

33
Adafruit_I2CDevice.cpp
View File

@ -261,9 +261,40 @@ uint8_t Adafruit_I2CDevice::address(void) { return _addr; }
* Not necessarily that the speed was achieved! * Not necessarily that the speed was achieved!
*/ */
bool Adafruit_I2CDevice::setSpeed(uint32_t desiredclk) { bool Adafruit_I2CDevice::setSpeed(uint32_t desiredclk) {
#if (ARDUINO >= 157) && !defined(ARDUINO_STM32_FEATHER) && !defined(TinyWireM_h) #if defined(__AVR__) // fix arduino core set clock
// calculate TWBR correctly
uint8_t prescaler = 1;
uint32_t atwbr = ((F_CPU / desiredclk) - 16) / 2;
if (atwbr <= 255) {
prescaler = 1;
TWSR = 0x0;
} else if (atwbr <= 1020) {
atwbr /= 4;
prescaler = 4;
TWSR = 0x1;
} else if (atwbr <= 4080) {
atwbr /= 16;
prescaler = 16;
TWSR = 0x2;
} else if (atwbr <= 16320) {
atwbr /= 64;
prescaler = 64;
TWSR = 0x3;
}
#ifdef DEBUG_SERIAL
Serial.print(F("TWSR prescaler = "));
Serial.println(prescaler);
Serial.print(F("TWBR = "));
Serial.println(atwbr);
#endif
TWBR = atwbr;
return true;
#elif (ARDUINO >= 157) && !defined(ARDUINO_STM32_FEATHER) && \
!defined(TinyWireM_h)
_wire->setClock(desiredclk); _wire->setClock(desiredclk);
return true; return true;
#else #else
(void)desiredclk; (void)desiredclk;
return false; return false;