114 lines
2.9 KiB
C
114 lines
2.9 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_1 = 0;
|
|
volatile uint16_t falling_edge_counter_2 = 0;
|
|
#define MAX_PER 0x50
|
|
|
|
|
|
void init_TCA0() {
|
|
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 fancounter, uint16_t time) {
|
|
fan_speed = (fancounter / time);
|
|
fan_speed = fan_speed/2;
|
|
fan_speed = fan_speed * 60/5;
|
|
fancounter = 0;
|
|
return fan_speed;
|
|
}
|
|
|
|
|
|
void init_fanports() {
|
|
// CONFIGURE PINS AS ANALOG INPUTS
|
|
|
|
// PIN FOR FAN 1
|
|
PORTD.DIRSET &= ~PIN6_bm;
|
|
PORTD.PIN6CTRL &= ~ PORT_ISC_gm;
|
|
PORTD.PIN6CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
// PIN FOR FAN 2
|
|
PORTD.DIRSET &= ~PIN4_bm;
|
|
PORTD.PIN4CTRL &= ~ PORT_ISC_gm ;
|
|
PORTD.PIN4CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
// PIN FOR REFRENCE
|
|
PORTD.DIRSET &= PIN7_bm;
|
|
PORTD.PIN7CTRL &= ~ PORT_ISC_gm ;
|
|
PORTD.PIN7CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
}
|
|
|
|
void init_ac0(){
|
|
//Wincontroll disabled
|
|
AC0.CTRLB = 0x00;
|
|
|
|
//SELECT POSITIVE AND NEGATIVE INPUTS FOR COMPARRISON
|
|
// FAN USE PD6 COMPARE WITH PD3
|
|
AC0.MUXCTRL = AC_MUXPOS_AINP3_gc | AC_MUXNEG_AINN2_gc;
|
|
|
|
// ENABLE AC BY WRITING 1 TO ENABLE BIT IN ACN.CTRLA
|
|
AC0.CTRLA = AC_ENABLE_bm | AC_INTMODE_NORMAL_POSEDGE_gc | AC_OUTEN_bm;
|
|
|
|
// TURN ON INTERUPT
|
|
AC0.INTCTRL = 0x01;
|
|
}
|
|
|
|
|
|
void init_ac1(){
|
|
//Wincontroll disabled
|
|
AC1.CTRLB = 0x00;
|
|
|
|
//SELECT POSITIVE AND NEGATIVE INPUTS FOR COMPARRISON
|
|
// FAN USE PD4, COMPARE WITH PD3
|
|
AC1.MUXCTRL = AC_MUXPOS_AINP2_gc | AC_MUXNEG_AINN2_gc;
|
|
|
|
// ENABLE AC BY WRITING 1 TO ENABLE BIT IN ACN.CTRLA
|
|
AC1.CTRLA = AC_ENABLE_bm | AC_INTMODE_NORMAL_POSEDGE_gc | AC_OUTEN_bm;
|
|
|
|
// TURN ON INTERUPT
|
|
AC1.INTCTRL = 0x01;
|
|
}
|
|
|
|
|
|
ISR(AC0_AC_vect){ // AC0 vec flag
|
|
cli();
|
|
falling_edge_counter_1++;
|
|
AC0.STATUS |= 0x10; //CMP flag to 0
|
|
sei();
|
|
}
|
|
|
|
|
|
ISR(AC1_AC_vect){ // AC1 vec flag
|
|
cli();
|
|
falling_edge_counter_2++;
|
|
AC1.STATUS |= 0x10; //CMP flag to 0
|
|
sei();
|
|
}
|
|
|
|
// TIMER INTERUPT
|
|
ISR (TCA0_OVF_vect) {
|
|
cli();
|
|
RPM_calculation(falling_edge_counter_1,1);
|
|
RPM_calculation(falling_edge_counter_2,1);
|
|
falling_edge_counter_1 = 0;
|
|
falling_edge_counter_2 = 0;
|
|
TCA0.SINGLE.INTFLAGS = TCA_SINGLE_OVF_bm ;
|
|
sei();
|
|
}
|
|
|
|
|
|
//-----------------------------------------------------------------------------------------------------
|
|
//-------------------------------------- S E T U P-----------------------------------------------------
|
|
|