Złożyłem jeden projekt z dwóch obrotomierzy ,z 1 czujnika są podawane impulsy zliczające przepływ wody a z 2 czujnika są
podawane impulsy zliczające prędkość w k/h ,program mi oblicza ile mi przepływa wody w litrach na kilometr i wtedy reguluje mi
zadaną dawkę za pomocą zaworu, problem jest szybkością reagowania na zmianę prędkości jazdy i czy ten kod jest dobry ,czy
coś trzeba zmienić , procesor atmega328p taktowany 8mhz ,jestem początkującym i chciałbym żeby mi ktoś pomógł .
[syntax=c]#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>
#include "hd/HD_44780.h"
#define F_CPU 8000000UL
#define BUTTON_DIRDDRD
#define BUTTON_PORTPORTD
#define BUTTON_PINPIND
#define BUTTON4(1 << PD0)
#define BUTTON5(1 << PD1)
#define BUTTON1(1 << PD5)
#define BUTTON2(1 << PD6)
#define BUTTON3(1 << PD7)
#define SENSOR_DIRDDRD
#define SENSOR_PORTPORTD
#define SENSOR_PINPIND
#define SENSOR1(1 << PD2)
uint16_t ostatni_pomiar=0; //ostatni pomiar
double licznik=0;
uint8_t odliczania_1_sekundy=0; //pomocnicza do odliczania 1 sekundy
uint8_t flaga_1_sekundy=0; //flaga 1 sekundy
uint16_t ilosc_przerwan_int0=0; //ilosc przerwan int0
//uint16_t jaki_enkoder=1; //konfiguracja enkodera
uint8_t blokada=0; //blokowanie naciskania klawiszy
uint16_t dawka_LI=1;
//uint16_t dawka_LI=0;
volatileuint16_t dawka_H=0;
volatile uint16_t dawka_L=0;
//tutaj ustaw własne zasady pomiaru
#define POMIAR_ILOSC_IMPULSOW_NA_OBROT4//ilość inpulsów na jeden obrót
#define POMIAR_ILOSC_OBROTOW2//ile obrotów ma trwać pomiar
volatile unsigned long int pomiar_ilosc_cykli;
volatile unsigned int ilosc_przepelnien;
volatile unsigned char pomiar_zbocze_nr;
volatile unsigned char pomiar_gotowy;
volatile unsigned int ICR1_moment_A;
volatile unsigned int ICR1_moment_B;
char wynik[16]; //bufor wyświetlacza
ISR(TIMER1_CAPT_vect){
//Obsługa zdarzenia na ICP1
static unsigned int ICR1_aktualny;//wartość ICR1 złapana w aktualnie
//złapanym zboczu
ICR1_aktualny = ICR1;//odczytaj złapany stan licznika
if(pomiar_zbocze_nr == 1){ //czy to pierwsze złapane zbocze?
//tak, pierwsze zbocze pomiarowe,
//uruchamiamy zliczanie przepełnień Timer1
//zgaś flagę przerwania od przepełnienia
TIFR1 |= (1<<TOV1);
//włącz przerwania od przepełnienia Timer1
TIMSK1|=(1<<TOIE1);
//zeruj licznik przepełnień Timera1
ilosc_przepelnien = 0;
//zapamiętujemy stan licznika początku obrotu (moment A)
ICR1_moment_A=ICR1_aktualny;
}
else{
//każde następne zbocza pomiarowe
//czy to ostatnie zbocze (koniec pełnego obrotu silnika)?
if(pomiar_zbocze_nr == POMIAR_ILOSC_IMPULSOW_NA_OBROT
* POMIAR_ILOSC_OBROTOW){
//tak, wykryto ostatnie zbocze pomiarowe,
//czyli wykonał się pełny ostatni obrót tarczy
//wyłączamy przerwania z Input Capture Unit
//oraz przepełnienia Timer1
TIMSK1&=~( (1<<ICIE1) | (1<<TOIE1) );
//zapamiętujemy zmienne dla main()
ICR1_moment_B=ICR1_aktualny;
pomiar_gotowy=1;
}
//w pozostałych przypadkach nic nie robimy i czekamy na zliczanie
//dalszych zboczy
}
//zwiększ licznik wykrytych zboczy
pomiar_zbocze_nr++;
}
ISR(TIMER1_OVF_vect)
{
//powiększ licznik przepełnień Timera1
ilosc_przepelnien++;
}
void wykonaj_pomiar(void){
//Funkcja włącza pomiar
//zerujemy licznik przepełnień Timer0
ilosc_przepelnien = 0;
//ustawiamy nr pierwszego zbocza
pomiar_zbocze_nr = 1;
//zerujemy flagę gotowości pomiaru
pomiar_gotowy = 0;
//włącz przerwania z ICP1 Timer1
TIMSK1|=(1<<ICIE1);
}
ISR(TIMER0_OVF_vect)
{
if (odliczania_1_sekundy==60) //1 sekunda
{
flaga_1_sekundy++;
odliczania_1_sekundy=0;
}
odliczania_1_sekundy++;
}
ISR(INT0_vect)
{
ilosc_przerwan_int0++;
if(ilosc_przerwan_int0)
{
licznik=licznik+0.01;
}
}
void Device_Initalize()
{
BUTTON_DIR &= ~BUTTON1;
BUTTON_DIR &= ~BUTTON2;
BUTTON_DIR &= ~BUTTON3;
BUTTON_DIR &= ~BUTTON4;
BUTTON_DIR &= ~BUTTON5;
BUTTON_PORT |= BUTTON1;
BUTTON_PORT |= BUTTON2;
BUTTON_PORT |= BUTTON3;
BUTTON_PORT |= BUTTON4;
BUTTON_PORT |= BUTTON5;
SENSOR_DIR &= ~SENSOR1;
SENSOR_PORT |= SENSOR1;
EICRA |= (1<<ISC00);//przerwanie na kazde zbocze
EIMSK |= (1<<INT0); //zezwolenie na przerwanie INT0
TCCR0B |= (1<<CS00)|(1<<CS01);//preskaler 64
TIMSK0 |= (1<<TOIE0); //zezwolenie na przerwanie od przepełnienia
return;
}
uint8_t Parse_Input() //interpretacja klawiszy, dla wygody
{
unsigned char ret=0;
if (!(BUTTON_PIN&BUTTON1)) ret|=0x08;
if (!(BUTTON_PIN&BUTTON2)) ret|=0x04;
if (!(BUTTON_PIN&BUTTON3)) ret|=0x02;
if (!(BUTTON_PIN&BUTTON4)) ret|=0x01;
if (!(BUTTON_PIN&BUTTON5)) ret|=0x10;
return ret;
}
void dawkowanie() //podmenu wyswietlajace konfig enkodera
{
uint8_t klawisz,done=0;
//_delay_ms(1000);
while (!done)
{
klawisz=Parse_Input();
if (klawisz&0b00010000)
{
if (!blokada && dawka_LI>100)
{
dawka_LI= dawka_LI-100;
blokada=1;
}
}
else if (klawisz&0x08)
{
if (!blokada && dawka_LI>1)
{
dawka_LI= dawka_LI-10;
dawka_L= dawka_LI-5;
dawka_H= dawka_LI+5;
blokada=1;
}
}
else if (klawisz&0x04)
{
if (!blokada)
{
done=1;
blokada=1;
}
}
else if (klawisz&0x02)
{
if (!blokada && dawka_LI<400)
{
dawka_LI= dawka_LI+10;
dawka_L= dawka_LI-5;
dawka_H= dawka_LI+5;
blokada=1;
}
}
if (klawisz&0x01)
{
if (!blokada && dawka_LI<400)
{
dawka_LI= dawka_LI+100;
blokada=1;
}
//}
}
else blokada=0;
LCD_Clear();
LCD_WriteText("dawka: ");
LCD_UInt(dawka_LI);
LCD_WriteText(" litry");
LCD_GoTo(0,1);
LCD_WriteData(( dawka_LI>1)?0x7F:0xFE);
LCD_GoTo(5,1);
LCD_WriteText("ustaw");
LCD_GoTo(15,1);
LCD_WriteData(( dawka_LI<255)?0x7E:0xFE);
_delay_ms(30);
}
}
int main(void)
{
uint8_t klawisz;
//uint8_t keys;
//zmienne do obliczeń
double czas_jednego_obrotu;
double metry_na_minute;
double kilometry_na_godzine;
uint8_t litry_na_min=0;
uint16_t dawka_LI_HA;
uint16_t dawka_K;
uint16_t dawka_LITROW;
//double ilosc_ha;
PORTB|= (1<<PB0);//włącz pullup transoptora
DDRB = 0b000110;
//Ustawienie Timer1
TCCR1A=0;
TCCR1B=(1<<CS10);//preskaler 1,
Device_Initalize(); //zainicjuj urzadzenie
LCD_Initalize(); //zainicjuj wyswietlacz
sei(); //pozwalaj na przerwania
wykonaj_pomiar();//włącz pierwszy pomiar
while (1)
{
LCD_Home();
if (flaga_1_sekundy) //jesli minela 1 sekunda to pobierz zliczenia int0
{
ostatni_pomiar=ilosc_przerwan_int0;
litry_na_min = (30*ostatni_pomiar)/50;//
ilosc_przerwan_int0=0;
flaga_1_sekundy=0;
}
LCD_GoTo(14,0);
LCD_UInt( litry_na_min); //wypisz wynik na lcd
//LCD_WriteText("obr/min");
LCD_GoTo(13, 1);
LCD_UInt((licznik)); //wypisz wynik na lcd
//_delay_ms(20);
if(pomiar_gotowy)
{
// gdy pomiar został wykonany
//obliczenia
pomiar_ilosc_cykli = 65500 * ilosc_przepelnien - ICR1_moment_A
+ ICR1_moment_B;
czas_jednego_obrotu=(double) pomiar_ilosc_cykli
/ POMIAR_ILOSC_OBROTOW / F_CPU ;
metry_na_minute=1.0 / czas_jednego_obrotu;
kilometry_na_godzine= 2.0*metry_na_minute;
//kilometry na godzine
sprintf(wynik,"%2.1f ", kilometry_na_godzine);
LCD_GoTo(0, 0);
LCD_WriteText(wynik);
dawka_LITROW= 600* litry_na_min;//dawka litrów na minute * 600 sekund
dawka_K=15 *kilometry_na_godzine;//kilometry na h *15metrów
dawka_LI_HA=dawka_LITROW /dawka_K;
sprintf(wynik,"%3.u",dawka_LI_HA );
LCD_GoTo(0,1);
LCD_WriteText(wynik);
wykonaj_pomiar();
}
klawisz=Parse_Input();
if (klawisz&0b00010000) //lewy
{
if (!blokada)
{
blokada=1;
}
}
if (klawisz&0x08) //lewy
{
if (!blokada)
{
blokada=1;
}
}
else if (klawisz&0x04) //srodkowy
{
if (!blokada)
{
blokada=1;
dawkowanie();
LCD_Clear();
}
}
else if (klawisz&0x02) //prawy
{
if (!blokada)
{
blokada=1;
}
else if (klawisz&0x01) //lewy
{
if (!blokada)
{
blokada=1;
}
}
}
else blokada=0;
if(dawka_LI_HA<dawka_L ) //jerzeli dawka jest mniejsza od 240
{
PORTB=0x02; //otwieraj zawór
}
else if (dawka_LI_HA>dawka_L) //jerzeli dowka jest większa
{
PORTB&=~0x02; //zatrzymaj zawór
PORTB&=~0x04; //zatrzymaj zawór
}
if (dawka_LI_HA>dawka_H) //jerzeli dawka jest większa od 250
{
PORTB=0x04; //zamykaj zawór
}
LCD_GoTo(9,1);
LCD_UInt( dawka_L);
LCD_GoTo(10,0);
LCD_UInt( dawka_H);
}
return 0;
}[/syntax]Statystyki: Napisane przez ire — 17 mar 2018, o 22:44
]]>