108 lines
3.1 KiB
C
108 lines
3.1 KiB
C
//#include <avr/ioavr128db48.h>
|
|
|
|
#include "fan_speeeed.h"
|
|
#include "uart.h"
|
|
|
|
uint16_t timer_period_ms = 1;
|
|
uint16_t fan_speed;
|
|
volatile uint16_t falling_edge_counter = 0;
|
|
#define MAX_PER 0x50
|
|
|
|
|
|
void init_TCA0() {
|
|
|
|
//code
|
|
// PORTMUX.TCAROUTEA = PORTMUX_TCA0_PORTD_gc;
|
|
// port d ??? why
|
|
//PORTD.DIR = PIN0_bm;
|
|
//code
|
|
//TCA0.SINGLE.PERBUF = MAX_PER;
|
|
//TCA0.SINGLE.PERBUF = (F_CPU * (1 / timer_period_ms) / 1024); /* F_CPU * F_IRQ / TCA_prescaler */
|
|
//TCA0.SINGLE.CMP0BUF = MAX_PER/2;
|
|
//TCA0.SINGLE.CTRLB = TCA_SINGLE_CMP0EN_bm | 0x03;
|
|
//TCA0.SINGLE.CTRLA = TCA_SINGLE_CLKSEL_DIV1_gc | TCA_SINGLE_ENABLE_bm;
|
|
|
|
//TCA0.SINGLE.INTCTRL = TCA_SINGLE_OVF_bm;
|
|
//TCA0.SINGLE.CTRLA = TCA_SINGLE_ENABLE_bm | TCA_SINGLE_CLKSEL_DIV1024_gc; /* Sysclk /1024 */
|
|
//TCA0_update_period_ms();
|
|
TCA0.SINGLE.INTCTRL = TCA_SINGLE_OVF_bm ;
|
|
TCA0.SINGLE.CTRLA = TCA_SINGLE_ENABLE_bm | TCA_SINGLE_CLKSEL_DIV1024_gc ; /* Sysclk /1024 */
|
|
TCA0.SINGLE.PERBUF = 3906;
|
|
//TCA0_update_period_ms();
|
|
}
|
|
|
|
void TCA0_update_period_ms() {
|
|
TCA0.SINGLE.PERBUF = (F_CPU * (1 / timer_period_ms) / 1024); /* F_CPU * F_IRQ / TCA_prescaler */
|
|
}
|
|
|
|
uint16_t RPM_calculation(uint16_t time) {
|
|
printf("time: %u", time);
|
|
fan_speed = (falling_edge_counter / time);
|
|
fan_speed = fan_speed/2;
|
|
fan_speed = fan_speed * 60/5;
|
|
printf("falling edge: %u", falling_edge_counter);
|
|
falling_edge_counter = 0;
|
|
printf("falling edge: ", falling_edge_counter);
|
|
printf("fanspeed %u \n", fan_speed);
|
|
return fan_speed;
|
|
}
|
|
|
|
|
|
void PORTB_init() {
|
|
PORTA.OUTSET |= PIN5_bm;
|
|
PORTA.DIRSET |= PIN5_bm;
|
|
}
|
|
|
|
void init_ac0(){
|
|
// CONFIGURE PINS AS ANALOG INPUTS
|
|
PORTD.DIRSET &= ~PIN6_bm;
|
|
PORTD.PIN6CTRL &= ~ PORT_ISC_gm;
|
|
PORTD.PIN6CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
PORTD.DIRSET &= ~PIN7_bm;
|
|
PORTD.PIN7CTRL &= ~ PORT_ISC_gm ;
|
|
PORTD.PIN7CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
PORTD.DIRSET &= PIN3_bm;
|
|
PORTD.PIN3CTRL &= ~ PORT_ISC_gm ;
|
|
PORTD.PIN3CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
//Wincontroll disabled
|
|
AC0.CTRLB = 0x00;
|
|
|
|
//SELECT POSITIVE AND NEGATIVE INPUTS FOR COMPARRISON
|
|
// FAN USE PD6 & PD7, COMPARE WITH PD3
|
|
AC0.MUXCTRL = AC_MUXPOS_AINP3_gc | AC_MUXNEG_AINN0_gc;
|
|
//AC_MUXPOS_AINP1_gc
|
|
|
|
// OPTIONAL: ENABLE INNPUT PIN BY WRITING "1" TO OUTEN
|
|
//AC0.CTRLA = 0x40; // 0b01000000
|
|
// ENABLE AC BY WRITING 1 TO ENABLE BIT IN ACN.CTRLA
|
|
//AC0.CTRLA |= PIN0_bm; // 0b00000001
|
|
AC0.CTRLA = AC_ENABLE_bm | AC_INTMODE_NORMAL_POSEDGE_gc | AC_OUTEN_bm;
|
|
|
|
// TURN ON INTERUPT
|
|
AC0.INTCTRL = 0x01;
|
|
}
|
|
|
|
|
|
ISR(AC0_AC_vect){ // AC0 vec flag
|
|
cli();
|
|
falling_edge_counter++;
|
|
AC0.STATUS |= 0x10; //CMP flag to 0.
|
|
//printf("yo");
|
|
sei();
|
|
}
|
|
|
|
ISR (TCA0_OVF_vect) {
|
|
cli();
|
|
RPM_calculation(1);
|
|
TCA0.SINGLE.INTFLAGS = TCA_SINGLE_OVF_bm ;
|
|
sei();
|
|
}
|
|
|
|
|
|
//-----------------------------------------------------------------------------------------------------
|
|
//-------------------------------------- S E T U P-----------------------------------------------------
|
|
|