53 lines
1.5 KiB
C++
53 lines
1.5 KiB
C++
#include "fsfw-hal/stm32h7/spi/spiDefinitions.h"
|
|
|
|
void spi::assignSpiMode(SpiModes spiMode, SPI_HandleTypeDef& spiHandle) {
|
|
switch(spiMode) {
|
|
case(SpiModes::MODE_0): {
|
|
spiHandle.Init.CLKPolarity = SPI_POLARITY_LOW;
|
|
spiHandle.Init.CLKPhase = SPI_PHASE_1EDGE;
|
|
break;
|
|
}
|
|
case(SpiModes::MODE_1): {
|
|
spiHandle.Init.CLKPolarity = SPI_POLARITY_LOW;
|
|
spiHandle.Init.CLKPhase = SPI_PHASE_2EDGE;
|
|
break;
|
|
}
|
|
case(SpiModes::MODE_2): {
|
|
spiHandle.Init.CLKPolarity = SPI_POLARITY_HIGH;
|
|
spiHandle.Init.CLKPhase = SPI_PHASE_1EDGE;
|
|
break;
|
|
}
|
|
case(SpiModes::MODE_3): {
|
|
spiHandle.Init.CLKPolarity = SPI_POLARITY_HIGH;
|
|
spiHandle.Init.CLKPhase = SPI_PHASE_2EDGE;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
uint32_t spi::getPrescaler(uint32_t clock_src_freq, uint32_t baudrate_mbps) {
|
|
uint32_t divisor = 0;
|
|
uint32_t spi_clk = clock_src_freq;
|
|
uint32_t presc = 0;
|
|
static const uint32_t baudrate[] = {
|
|
SPI_BAUDRATEPRESCALER_2,
|
|
SPI_BAUDRATEPRESCALER_4,
|
|
SPI_BAUDRATEPRESCALER_8,
|
|
SPI_BAUDRATEPRESCALER_16,
|
|
SPI_BAUDRATEPRESCALER_32,
|
|
SPI_BAUDRATEPRESCALER_64,
|
|
SPI_BAUDRATEPRESCALER_128,
|
|
SPI_BAUDRATEPRESCALER_256,
|
|
};
|
|
|
|
while( spi_clk > baudrate_mbps) {
|
|
presc = baudrate[divisor];
|
|
if (++divisor > 7)
|
|
break;
|
|
|
|
spi_clk = ( spi_clk >> 1);
|
|
}
|
|
|
|
return presc;
|
|
}
|