3D-printing/klipper
1
0
Fork 0
mirror of https://github.com/Klipper3d/klipper.git synced 2025-07-22 06:04:03 -06:00
Code Issues Projects Releases Packages Wiki Activity Actions 2

stm32f4: Encode mode/func into single parameter of gpio_peripheral

Browse source 
Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
Kevin O'Connor 2019-07-28 11:32:56 -04:00
parent 7d4c475e52
commit ef0784afe6
5 changed files with 13 additions and 12 deletions
Download patch file Download diff file Expand all files Collapse all files

9
src/stm32f4/gpio.c
View file

@ -21,16 +21,17 @@ static GPIO_TypeDef * const digital_regs[] = {
// Set the mode and extended function of a pin
void
gpio_peripheral(uint32_t gpio, uint32_t mode, uint32_t func, int pullup)
gpio_peripheral(uint32_t gpio, uint32_t mode, int pullup)
{
GPIO_TypeDef *regs = digital_regs[GPIO2PORT(gpio)];
uint32_t mode_bits = mode & 0x0f, func = mode >> 4;
uint32_t pup = pullup ? (pullup > 0 ? 1 : 2) : 0;
uint32_t pos = gpio % 16, af_reg = pos / 8;
uint32_t af_shift = (pos % 8) * 4, af_msk = 0x0f << af_shift;
uint32_t m_shift = pos * 2, m_msk = 0x03 << m_shift;
regs->AFR[af_reg] = (regs->AFR[af_reg] & ~af_msk) | (func << af_shift);
regs->MODER = (regs->MODER & ~m_msk) | (mode << m_shift);
regs->MODER = (regs->MODER & ~m_msk) | (mode_bits << m_shift);
regs->PUPDR = (regs->PUPDR & ~m_msk) | (pup << m_shift);
regs->OSPEEDR = (regs->OSPEEDR & ~m_msk) | (0x02 << m_shift);
}
@ -74,7 +75,7 @@ gpio_out_reset(struct gpio_out g, uint32_t val)
regs->BSRR = g.bit;
else
regs->BSRR = g.bit << 16;
gpio_peripheral(pin, GPIO_OUTPUT, 0, 0);
gpio_peripheral(pin, GPIO_OUTPUT, 0);
irq_restore(flag);
}
@ -123,7 +124,7 @@ gpio_in_reset(struct gpio_in g, int32_t pull_up)
GPIO_TypeDef *regs = g.regs;
int pin = regs_to_pin(regs, g.bit);
irqstatus_t flag = irq_save();
gpio_peripheral(pin, GPIO_INPUT, 0, pull_up);
gpio_peripheral(pin, GPIO_INPUT, pull_up);
irq_restore(flag);
}