Hw.cpp

//------------------------------------------------------------------------------
//This file is part of embKernel. 
//See license.txt for the full license governing this code.
//------------------------------------------------------------------------------

#include "Hw.hpp"
#include "stm32f4xx.h"

DrvGpio Hw::sButton;
DrvGpio Hw::sLed1;
DrvGpio Hw::sLed2;
DrvGpio Hw::sLed3;
DrvGpio Hw::sLed4;

void Hw::init() {
    //Clock config
    RCC ->CFGR = 0; //Reset all clock config

    RCC ->CR = RCC_CR_HSION | RCC_CR_HSEON | PWR_CR_VOS; //HSI and HSE on, Regulator voltage=1 (maximum frequency)

    while (!(RCC ->CR & RCC_CR_HSERDY )) { //Wait HSE ready
    }

    FLASH ->ACR = FLASH_ACR_ICEN | FLASH_ACR_DCEN | FLASH_ACR_LATENCY_5WS; //6 wait states, data and instruction cache enabled

    const static uint32_t PLLM = 4;
    const static uint32_t PLLN = 168;
    const static uint32_t PLLQ = 7;
    const static uint32_t PLLP = 2;
    RCC ->PLLCFGR = PLLM | RCC_PLLCFGR_PLLSRC_HSE | (PLLN << 6) | (PLLQ << 24) | (((PLLP >> 1) - 1) << 16);

    RCC ->CFGR |= RCC_CFGR_HPRE_DIV1 | RCC_CFGR_PPRE1_DIV4 | RCC_CFGR_PPRE2_DIV2; //SYSCLK=168MHz, APB1=42MHz,APB2=84MHz

    RCC ->CR |= RCC_CR_PLLON; //Enable PLL

    while (!(RCC ->CR & RCC_CR_PLLRDY )) { //Wait PLL ready
    }

    RCC ->CFGR |= RCC_CFGR_SW_PLL; //Switch to PLL clock

    while (!(RCC ->CFGR & RCC_CFGR_SWS_PLL )) { //Wait for system to switch to PLL
    }

    //Enable peripherals
#if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
    SCB->CPACR |= ((3UL << 10*2)|(3UL << 11*2)); /* set CP10 and CP11 Full Access */
#endif

    RCC ->AHB1ENR |= RCC_APB1ENR_PWREN | RCC_AHB1ENR_GPIOAEN | RCC_AHB1ENR_GPIOBEN | //
            RCC_AHB1ENR_GPIOCEN | RCC_AHB1ENR_GPIODEN | //
            RCC_AHB1ENR_GPIOEEN | RCC_AHB1ENR_GPIOHEN | //
            RCC_AHB1ENR_DMA2EN;

    RCC ->APB1ENR |= RCC_APB1ENR_SPI2EN;
    RCC ->APB2ENR |= RCC_APB2ENR_SYSCFGEN | RCC_APB2ENR_SDIOEN | RCC_APB2ENR_SPI1EN;

    SYSCFG ->PMC |= SYSCFG_PMC_MII_RMII_SEL; //Set RMII mode

    //Ethernet RMII
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTA, DrvTypes::DRV_PIN1, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_REF_CLK
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTA, DrvTypes::DRV_PIN2, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //MDIO
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTA, DrvTypes::DRV_PIN7, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_CRS_DV

    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTB, DrvTypes::DRV_PIN11, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_TX_EN
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTB, DrvTypes::DRV_PIN12, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_TXD0
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTB, DrvTypes::DRV_PIN13, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_TXD1

    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN1, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //MDC
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN4, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_RXD0
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN5, DrvTypes::DRV_FUNC11, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //RMII_RXD1

    //SDIO
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN7, DrvTypes::DRV_FUNC0, DrvTypes::DRV_MODE_INPUT, DrvTypes::PUPD_PULL_UP); //SD DETECT
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN8, DrvTypes::DRV_FUNC12, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION, DrvTypes::PUPD_PULL_UP); //SDIO_D0
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN9, DrvTypes::DRV_FUNC12, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION, DrvTypes::PUPD_PULL_UP); //SDIO_D1
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN10, DrvTypes::DRV_FUNC12, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION, DrvTypes::PUPD_PULL_UP); //SDIO_D2
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN11, DrvTypes::DRV_FUNC12, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION, DrvTypes::PUPD_PULL_UP); //SDIO_D3
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTC, DrvTypes::DRV_PIN12, DrvTypes::DRV_FUNC12, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION); //SDIO_CK
    DrvGpio::setPinFuncMode(DrvTypes::DRV_PORTD, DrvTypes::DRV_PIN2, DrvTypes::DRV_FUNC12, DrvTypes::DRV_MODE_ALTERNATE_FUNCTION, DrvTypes::PUPD_PULL_UP); //SDIO_CMD

    //LED
    sLed1.init(DrvTypes::DRV_PORTD, DrvTypes::DRV_PIN12, DrvTypes::DRV_FUNC0, DrvTypes::DRV_MODE_OUTPUT_PUSH_PULL);
    sLed2.init(DrvTypes::DRV_PORTD, DrvTypes::DRV_PIN13, DrvTypes::DRV_FUNC0, DrvTypes::DRV_MODE_OUTPUT_PUSH_PULL);
    sLed3.init(DrvTypes::DRV_PORTD, DrvTypes::DRV_PIN14, DrvTypes::DRV_FUNC0, DrvTypes::DRV_MODE_OUTPUT_PUSH_PULL);
    sLed4.init(DrvTypes::DRV_PORTD, DrvTypes::DRV_PIN15, DrvTypes::DRV_FUNC0, DrvTypes::DRV_MODE_OUTPUT_PUSH_PULL);

}