diff options
Diffstat (limited to 'src/atsam/i2c.c')
| -rw-r--r-- | src/atsam/i2c.c | 5 |
1 files changed, 3 insertions, 2 deletions
diff --git a/src/atsam/i2c.c b/src/atsam/i2c.c index fc56ce50..f7e68b81 100644 --- a/src/atsam/i2c.c +++ b/src/atsam/i2c.c @@ -48,8 +48,9 @@ i2c_init(Twi *p_twi, uint32_t rate) p_twi->TWI_CR = TWI_CR_SVDIS; p_twi->TWI_CR = TWI_CR_MSEN; + uint32_t pclk = get_pclock_frequency(p_twi == TWI0 ? ID_TWI0 : ID_TWI1); uint32_t cldiv = 0, chdiv = 0, ckdiv = 0; - cldiv = SystemCoreClock / ((rate > 384000 ? 384000 : rate) * 2) - 4; + cldiv = pclk / ((rate > 384000 ? 384000 : rate) * 2) - 4; while ((cldiv > 255) && (ckdiv < 7)) { ckdiv++; @@ -57,7 +58,7 @@ i2c_init(Twi *p_twi, uint32_t rate) } if (rate > 348000) { - chdiv = SystemCoreClock / ((2 * rate - 384000) * 2) - 4; + chdiv = pclk / ((2 * rate - 384000) * 2) - 4; while ((chdiv > 255) && (ckdiv < 7)) { ckdiv++; chdiv /= 2; |