reflow-oven-control-sw/stm-firmware/digio.c

195 lines
4.4 KiB
C
Raw Normal View History

2020-02-15 22:09:55 +01:00
/* Reflow Oven Controller
*
* Copyright (C) 2020 Mario Hüttel <mario.huettel@gmx.net>
*
* This file is part of the Reflow Oven Controller Project.
*
* The reflow oven controller is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* The Reflow Oven Control Firmware is distributed in the hope that it will be useful,
2020-02-15 22:09:55 +01:00
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with the reflow oven controller project.
* If not, see <http://www.gnu.org/licenses/>.
*/
2020-02-12 21:00:35 +01:00
#include <reflow-controller/digio.h>
#include <stm32/stm32f4xx.h>
#include <stm-periph/clock-enable-manager.h>
#include <stm-periph/stm32-gpio-macros.h>
#include <helper-macros/helper-macros.h>
static const uint8_t digio_pins[] = {DIGIO_PINS};
static const uint8_t digio_default_io[] = {DIGIO_INOUT_DEFAULT};
static const uint8_t digio_default_altfunc[] = {DIGIO_ALTFUNC_DEFAULT};
2020-05-24 23:35:17 +02:00
static uint16_t loudspeaker_val;
static void digio_setup_pin_int(uint8_t bit_no, uint8_t in_out, uint8_t alt_func)
{
DIGIO_PORT->MODER &= MODER_DELETE(bit_no);
switch (in_out) {
case 2:
DIGIO_PORT->MODER |= ALTFUNC(bit_no);
SETAF(DIGIO_PORT, bit_no, alt_func);
break;
case 1:
DIGIO_PORT->MODER |= OUTPUT(bit_no);
break;
case 0: /* expected fallthrough */
default:
break;
}
}
void digio_setup_default_all()
{
unsigned int i;
rcc_manager_enable_clock(&RCC->AHB1ENR, BITMASK_TO_BITNO(DIGIO_RCC_MASK));
for (i = 0; i < COUNT_OF(digio_pins); i++) {
digio_setup_pin_int(digio_pins[i], digio_default_io[i], digio_default_altfunc[i]);
if (digio_default_io[i] == 1)
digio_set(i, 0);
}
}
void digio_setup_pin(uint8_t num, uint8_t in_out, uint8_t alt_func)
{
if (num >= COUNT_OF(digio_pins))
return;
digio_setup_pin_int(digio_pins[num], in_out, alt_func);
}
void digio_set(uint8_t num, int val)
{
if (num >= COUNT_OF(digio_pins))
return;
if (val)
DIGIO_PORT->ODR |= (1<<digio_pins[num]);
else
DIGIO_PORT->ODR &= ~(1<<digio_pins[num]);
}
int digio_get(uint8_t num)
{
if (num >= COUNT_OF(digio_pins))
return -1;
if ((DIGIO_PORT->MODER & (0x3<<digio_pins[num])) == OUTPUT(digio_pins[num]))
return (DIGIO_PORT->ODR & (1<<digio_pins[num]) ? 1 : 0);
else
return (DIGIO_PORT->IDR & (1<<digio_pins[num]) ? 1 : 0);
}
static const uint8_t led_pins[] = {LED_PINS};
void led_setup()
{
unsigned int i;
rcc_manager_enable_clock(&RCC->AHB1ENR, BITMASK_TO_BITNO(LED_RCC_MASK));
for (i = 0; i < COUNT_OF(led_pins); i++) {
LED_PORT->MODER &= MODER_DELETE(led_pins[i]);
LED_PORT->MODER |= OUTPUT(led_pins[i]);
}
}
void led_set(uint8_t num, int val)
{
if (num >= COUNT_OF(led_pins))
return;
if (val)
LED_PORT->ODR |= (1<<led_pins[num]);
else
LED_PORT->ODR &= ~(1<<led_pins[num]);
}
int led_get(uint8_t num)
{
if (num >= COUNT_OF(led_pins))
return -1;
return ((LED_PORT->ODR & (1<<led_pins[num])) ? 1 : 0);
}
2020-05-24 23:35:17 +02:00
static void loudspeaker_freq_timer_init(void)
{
#if LOUDSPEAKER_MULTIFREQ
rcc_manager_enable_clock(&RCC->APB1ENR, BITMASK_TO_BITNO(RCC_APB1ENR_TIM7EN));
TIM7->CR1 = 0UL;
TIM7->CR2 = 0UL;
TIM7->PSC = 1000;
TIM7->DIER = TIM_DIER_UIE;
NVIC_EnableIRQ(TIM7_IRQn);
#endif
}
void loudspeaker_setup()
{
rcc_manager_enable_clock(&RCC->AHB1ENR, BITMASK_TO_BITNO(LOUDSPEAKER_RCC_MASK));
LOUDSPEAKER_PORT->MODER &= MODER_DELETE(LOUDSPEAKER_PIN);
LOUDSPEAKER_PORT->MODER |= OUTPUT(LOUDSPEAKER_PIN);
2020-05-24 23:35:17 +02:00
loudspeaker_freq_timer_init();
loudspeaker_set(0U);
}
static void loudspeaker_start_beep(uint16_t val)
{
#if LOUDSPEAKER_MULTIFREQ
TIM7->ARR = val;
TIM7->CNT = 0UL;
TIM7->CR1 |= TIM_CR1_CEN;
#else
(void)val;
LOUDSPEAKER_PORT->ODR |= (1<<LOUDSPEAKER_PIN);
#endif
}
2020-05-24 23:35:17 +02:00
static void loudspeaker_stop_beep(void)
{
2020-05-24 23:35:17 +02:00
#if LOUDSPEAKER_MULTIFREQ
TIM7->CR1 &= ~TIM_CR1_CEN;
__DSB();
TIM7->SR = 0UL;
__DSB();
LOUDSPEAKER_PORT->ODR &= ~(1<<LOUDSPEAKER_PIN);
#else
LOUDSPEAKER_PORT->ODR &= ~(1<<LOUDSPEAKER_PIN);
#endif
}
2020-05-24 23:35:17 +02:00
void loudspeaker_set(uint16_t val)
{
loudspeaker_val = val;
if (!val) {
loudspeaker_stop_beep();
} else {
loudspeaker_start_beep(val);
}
}
uint16_t loudspeaker_get()
{
return loudspeaker_val;
}
#if LOUDSPEAKER_MULTIFREQ
void TIM7_IRQHandler(void)
{
2020-05-24 23:35:17 +02:00
TIM7->SR = 0UL;
__DSB();
LOUDSPEAKER_PORT->ODR ^= (1<<LOUDSPEAKER_PIN);
}
2020-05-24 23:35:17 +02:00
#endif