You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
61 lines
1.2 KiB
61 lines
1.2 KiB
#include "common.h"
|
|
#include "gpio.h"
|
|
|
|
static uint32_t rcc_gpio_mask(uint32_t gpio)
|
|
{
|
|
switch (gpio) {
|
|
case GPIOA: return RCC_AHBENR_GPIOAEN;
|
|
case GPIOB: return RCC_AHBENR_GPIOBEN;
|
|
case GPIOC: return RCC_AHBENR_GPIOCEN;
|
|
case GPIOD: return RCC_AHBENR_GPIODEN;
|
|
case GPIOE: return RCC_AHBENR_GPIOEEN;
|
|
case GPIOF: return RCC_AHBENR_GPIOFEN;
|
|
case GPIOG: return RCC_AHBENR_GPIOGEN;
|
|
case GPIOH: return RCC_AHBENR_GPIOHEN;
|
|
default: return 0;
|
|
}
|
|
}
|
|
|
|
|
|
void gpio_enable(uint32_t gpio)
|
|
{
|
|
RCC_AHBENR |= rcc_gpio_mask(gpio);
|
|
}
|
|
|
|
|
|
void gpio_disable(uint32_t gpio)
|
|
{
|
|
RCC_AHBENR &= ~rcc_gpio_mask(gpio);
|
|
}
|
|
|
|
|
|
void gpio_set_af(uint32_t gpio, uint32_t pins, enum GPIO_AF af)
|
|
{
|
|
gpio_enable(gpio);
|
|
|
|
volatile uint32_t *moder = (uint32_t *) gpio + GPIO_MODER_offs;
|
|
volatile uint64_t *afr = (uint64_t *) gpio + GPIO_AFR_offs;
|
|
|
|
BitFieldLoop(i, m, 16) {
|
|
if (pins & m) {
|
|
*moder &= ~(0b11 << i * 2);
|
|
*moder |= 0b10 << i * 2;
|
|
|
|
*afr &= ~(0xF << i * 4);
|
|
*afr |= af << i * 4;
|
|
}
|
|
};
|
|
}
|
|
|
|
|
|
void gpio_set_mode(uint32_t gpio, uint32_t pins, enum GPIO_MODE mode)
|
|
{
|
|
volatile uint32_t *moder = (uint32_t *) gpio + GPIO_MODER_offs;
|
|
|
|
BitFieldLoop(i, m, 16) {
|
|
if (pins & m) {
|
|
*moder &= ~(0b11 << i * 2);
|
|
*moder |= mode << i * 2;
|
|
}
|
|
};
|
|
}
|
|
|