stm32_gpio.c

Go to the documentation of this file.

/**
 * \file    heivs/stm32_gpio.c
 */

#include "heivs/stm32_gpio.h"
#include "stm32/stm32f4xx_gpio.h"
#include "stm32/stm32f4xx_rcc.h"

status_e gpio_setup(const struct gpio_t *gpio)
{
    /* Handle the GPIO_NC case */
    if (gpio->ctrl == GPIO_NC_CTRL)
    {
        return NO_ERROR;
    }
    RCC_AHB1PeriphClockCmd(1 << gpio->ctrl, ENABLE);

    GPIO_TypeDef *GPIOx = _internal_gpio_get_ctrl(gpio);
    uint32_t mode = gpio->mode;
    uint32_t type = (mode >> _GPIO_TYPE_SHIFT) & _GPIO_TYPE_MASK;
    uint32_t out_value  = (mode >> _GPIO_OUT_SHIFT) & _GPIO_OUT_MASK;
    uint32_t drive = (mode >> _GPIO_DRIVE_SHIFT) & _GPIO_DRIVE_MASK;
    uint32_t speed = (mode >> _GPIO_SPEED_SHIFT) & _GPIO_SPEED_MASK;
    uint32_t pull = (mode >> _GPIO_PULL_SHIFT) & _GPIO_PULL_MASK;
    uint32_t af_nr = (mode >> _GPIO_AF_NR_SHIFT) & _GPIO_AF_NR_MASK;

    gpio_set(gpio, out_value);

    GPIOx->AFR[gpio->nr >> 0x03] &=~ (0xF << ((gpio->nr & 0x07) * 4));
    GPIOx->AFR[gpio->nr >> 0x03] |= (af_nr << ((gpio->nr & 0x07) * 4));

    GPIOx->MODER  &= ~(GPIO_MODER_MODER0 << (gpio->nr * 2));
    GPIOx->MODER |= type << (gpio->nr * 2);

    GPIOx->OSPEEDR &= ~(GPIO_OSPEEDER_OSPEEDR0 << (gpio->nr * 2));
    GPIOx->OSPEEDR |= speed << (gpio->nr * 2);

    GPIOx->OTYPER  &= ~((GPIO_OTYPER_OT_0) << ((uint16_t)gpio->nr)) ;
    GPIOx->OTYPER |= drive << gpio->nr;

    GPIOx->PUPDR &= ~(GPIO_PUPDR_PUPDR0 << ((uint16_t)gpio->nr * 2));
    GPIOx->PUPDR |= pull << (gpio->nr * 2);

    return NO_ERROR;
}

status_e gpio_setup_list(const struct gpio_t gpio[], size_t len)
{
    size_t i;
    status_e status;

    for (i = 0 ; i < len ; i++)
    {
        status = gpio_setup(&gpio[i]);
        if (status != NO_ERROR)
        {
            return status;
        }
    }

    return NO_ERROR;
}