DrvGpio.cpp

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

#include "DrvGpio.hpp"

void DrvGpio::init(DrvTypes::PORT port, DrvTypes::PIN pin, DrvTypes::GPIO_FUNCTION func, DrvTypes::GPIO_MODE mode, DrvTypes::GPIO_PUPD pupd) {

    mPort = port;
    mPin = pin;

    switch (port) {
        case DrvTypes::DRV_PORTA:
            mGpio = GPIOA;
            break;
        case DrvTypes::DRV_PORTB:
            mGpio = GPIOB;
            break;
        case DrvTypes::DRV_PORTC:
            mGpio = GPIOC;
            break;
        case DrvTypes::DRV_PORTD:
            mGpio = GPIOD;
            break;
        case DrvTypes::DRV_PORTE:
            mGpio = GPIOE;
            break;
        case DrvTypes::DRV_PORTF:
            mGpio = GPIOF;
            break;
        default:
            return;
    }

    mPinMask = 1 << pin;

    setPinFuncMode(mPort, mPin, func, mode, pupd);
}

void DrvGpio::setPinFuncMode(DrvTypes::GPIO_FUNCTION func, DrvTypes::GPIO_MODE mode, DrvTypes::GPIO_PUPD pupd) {
    setPinFuncMode(mPort, mPin, func, mode);
}

void DrvGpio::setPinFuncMode(DrvTypes::PORT port, DrvTypes::PIN pin, DrvTypes::GPIO_FUNCTION func, DrvTypes::GPIO_MODE mode, DrvTypes::GPIO_PUPD pupd) {
    GPIO_TypeDef* gpio;

    switch (port) {
        case DrvTypes::DRV_PORTA:
            gpio = GPIOA;
            break;
        case DrvTypes::DRV_PORTB:
            gpio = GPIOB;
            break;
        case DrvTypes::DRV_PORTC:
            gpio = GPIOC;
            break;
        case DrvTypes::DRV_PORTD:
            gpio = GPIOD;
            break;
        case DrvTypes::DRV_PORTE:
            gpio = GPIOE;
            break;
        case DrvTypes::DRV_PORTF:
            gpio = GPIOF;
            break;
        default:
            return;
    }

    int pinShift = 2 * pin;
    int pinMode;
    gpio->OSPEEDR |= (0b11 << pinShift);
    gpio->MODER &= ~(0b11 << pinShift);
    gpio->PUPDR &= ~(0b11 << pinShift);

    switch (mode) {
        case DrvTypes::DRV_MODE_INPUT:
            pinMode = 0;
            break;
        case DrvTypes::DRV_MODE_OUTPUT_PUSH_PULL:
            pinMode = 1;
            gpio->OTYPER &= ~((uint32_t) 1 << pin);
            break;
        case DrvTypes::DRV_MODE_OUTPUT_OPEN_DRAIN:
            pinMode = 1;
            gpio->OTYPER |= ((uint32_t) 1 << pin);
            break;
        case DrvTypes::DRV_MODE_ALTERNATE_FUNCTION:
            pinMode = 2;
            break;
        case DrvTypes::DRV_MODE_ANALOG:
            pinMode = 3;
            break;
        default:
            return;
    }

    switch (pupd) {
        case DrvTypes::PUPD_NONE:
            break;
        case DrvTypes::PUPD_PULL_UP:
            gpio->PUPDR |= 0x01 << pinShift;
            break;
        case DrvTypes::PUPD_PULL_DOWN:
            gpio->PUPDR |= 0x10 << pinShift;
            break;
    }

    gpio->MODER |= pinMode << pinShift;

    pinShift = (4 * pin) % 32;
    gpio->AFR[pin >> 3] &= ~(0xF << pinShift);
    gpio->AFR[pin >> 3] |= func << pinShift;

}