120 lines
3.1 KiB
C
120 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_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) {
|
|
printf("time: %u", time);
|
|
fan_speed = (fancounter / time);
|
|
fan_speed = fan_speed/2;
|
|
fan_speed = fan_speed * 60/5;
|
|
printf("falling edge: %u", fancounter);
|
|
fancounter = 0;
|
|
printf("falling edge: ", fancounter);
|
|
printf("fanspeed %u \n", fan_speed);
|
|
return fan_speed;
|
|
}
|
|
|
|
|
|
void init_fanports() {
|
|
// CONFIGURE PINS AS ANALOG INPUTS
|
|
PORTD.DIRSET &= ~PIN6_bm;
|
|
PORTD.PIN6CTRL &= ~ PORT_ISC_gm;
|
|
PORTD.PIN6CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
PORTD.DIRSET &= ~PIN4_bm;
|
|
PORTD.PIN4CTRL &= ~ PORT_ISC_gm ;
|
|
PORTD.PIN4CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
|
|
PORTD.DIRSET &= PIN7_bm;
|
|
PORTD.PIN7CTRL &= ~ PORT_ISC_gm ;
|
|
PORTD.PIN7CTRL = PORT_ISC_INPUT_DISABLE_gc;
|
|
}
|
|
|
|
void init_ac0_fan1(){
|
|
//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_AINN2_gc;
|
|
//AC_MUXPOS_AINP1_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_fan2(){
|
|
//Wincontroll disabled
|
|
AC1.CTRLB = 0x00;
|
|
|
|
//SELECT POSITIVE AND NEGATIVE INPUTS FOR COMPARRISON
|
|
// FAN USE PD6 & PD7, 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++;
|
|
printf("ac0");
|
|
AC0.STATUS |= 0x10; //CMP flag to 0
|
|
sei();
|
|
}
|
|
|
|
|
|
ISR(AC1_AC_vect){ // AC0 vec flag
|
|
cli();
|
|
falling_edge_counter_2++;
|
|
printf("ac1");
|
|
AC1.STATUS |= 0x10; //CMP flag to 0
|
|
sei();
|
|
}
|
|
|
|
|
|
ISR (TCA0_OVF_vect) {
|
|
cli();
|
|
|
|
printf("fan1");
|
|
RPM_calculation(falling_edge_counter_1,1);
|
|
printf("fan2");
|
|
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-----------------------------------------------------
|
|
|