Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_AVR: bugfix to SPIDriver.cpp 

* Had freq set to 10 mhz, not 1mhz... stupid mistake.
This commit is contained in:
Pat Hickey 2012-09-05 15:23:32 -07:00 committed by Andrew Tridgell
parent 177da8ea5b
commit a9dff1ad25
1 changed files with 4 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
libraries/AP_HAL_AVR/SPIDriver.cpp
View File

@ -20,14 +20,13 @@ void ArduinoSPIDriver::init(void* machtnichts) {
SPCR |= _BV(MSTR); SPCR |= _BV(MSTR);
SPCR |= _BV(SPE); SPCR |= _BV(SPE);
// set_freq(10000000); set_freq( 1000000);
// dbg: set_freq is broken
// lets just set SPR0 (div/16)
SPCR |= _BV(SPR0);
} }
void ArduinoSPIDriver::set_freq(uint32_t freq_hz) { void ArduinoSPIDriver::set_freq(uint32_t freq_hz) {
int div = F_CPU / freq_hz; const uint16_t freq_khz = (uint16_t)(freq_hz / 1000UL);
const uint16_t fcpu_khz = (uint16_t)(F_CPU / 1000UL);
const int16_t div = fcpu_khz / freq_khz;
/* can't divide clock by more than 128. */ /* can't divide clock by more than 128. */
uint8_t b = _divider_bits( div > 128 ? 128 : ((uint8_t) div)); uint8_t b = _divider_bits( div > 128 ? 128 : ((uint8_t) div));
_set_clock_divider_bits(b); _set_clock_divider_bits(b);