| void init_AlwaysInline(uint32_t clock, uint8_t bitOrder, uint8_t dataMode) | void init_AlwaysInline(uint32_t clock, uint8_t bitOrder, uint8_t dataMode) | ||||
| __attribute__((__always_inline__)) { | __attribute__((__always_inline__)) { | ||||
| // TODO: Need to check timings as related to chip selects? | // TODO: Need to check timings as related to chip selects? | ||||
| uint32_t d, div; | |||||
| uint32_t clkhz = 528000000u / (((CCM_CBCMR >> 26 ) & 0x07 ) + 1); // LPSPI peripheral clock | |||||
| const uint32_t clk_sel[4] = {664615384, // PLL3 PFD1 | |||||
| 720000000, // PLL3 PFD0 | |||||
| 528000000, // PLL2 | |||||
| 396000000}; // PLL2 PFD2 | |||||
| uint32_t cbcmr = CCM_CBCMR; | |||||
| uint32_t clkhz = clk_sel[(cbcmr >> 4) & 0x03] / (((cbcmr >> 26 ) & 0x07 ) + 1); // LPSPI peripheral clock | |||||
| uint32_t d, div; | |||||
| if (clock == 0) clock =1; | if (clock == 0) clock =1; | ||||
| d= clkhz/clock; | d= clkhz/clock; | ||||
| if (d && clkhz/d > clock) d++; | if (d && clkhz/d > clock) d++; |