#include "LiquidCrystal.h"
LiquidCrystal lcd(7, 6, 5, 3, 21, 4, 20);
#define SW_G (1<<PB5) //PB4 przycisk auto podnoszenia lub opadania
#define SW_A (1<<PB4) //PB5 przycisk podnoszenia auto
#define SW_U (1<<PB2) //PB2
#define SW_D (1<<PB3) //PB3
#define BUZZ (1<<PD2) //PD2
#define LED_A (1<<PD0) //PD0 kontrolka przycisku auto
#define LED_G (1<<PD1) //PD1
#define DOWN (1<<PB0) //PB0
#define UP (1<<PB1) //PB1
#define SW_3 (1<<PC5) //PC5 blokada
const int pot_1 = 14; //PC0 potencj dolny poziom
const int pot_2 = 15; //PC1 górny poziom
const int pot_3 = 16; //PC2 czulosc nacisku
const int pot_4 = 17; //PC3 czujnik wysokosci
const int pot_5 = 18; //PC4 czujnik nacisku
int U; //pot_1 - pot_4
int U1;
uint8_t prev_U1;
int U2;
uint8_t prev_U2;
int U3;
uint8_t prev_U3;
int U4;
uint8_t prev_U4;
int U5;
uint8_t prev_U5;
uint8_t flaga_a;
uint8_t flaga_u;
volatile int timer; //inkrementacja licznika
volatile int timer2;
volatile int timer3;
uint8_t timer3_old;
int X=6; //histereza
int Y=6; //histereza
uint8_t key; //klucz przycisku sw_1
uint8_t key_old; //klucz przycisku sw_2
uint8_t key_g;
uint8_t state;
uint8_t key_sw_a=0;
int U4_old;
void setup() {
DDRD =B11111111;
PORTD=B00000011;
DDRB =B11000011;
PORTB=B00110000;
DDRC =B00000000;
PORTC=B00100000;
analogReference(DEFAULT);
//.................................................... licznik
TCCR0A=(1<<WGM01); //Set the CTC mode
OCR0A=0xF9; //Value for ORC0A for 1ms
TIMSK0|=(1<<OCIE0A); //Set the interrupt request
sei(); //Enable interrupt
TCCR0B|=(1<<CS01); //Set the prescale 1/64 clock
TCCR0B|=(1<<CS00);
lcd.begin(16,2);
if (!(PINB & SW_A)){ //jeśli stan niski
PORTD &=~(LED_A); //stan niski diody świecą
PORTD &=~(LED_G); //stan niski
kalibracja();
}
//....................................................histereza Y
if (!(PINB&SW_G)) {
//histereza();
}
lcd.setCursor(0,0);
lcd.print("Akt:");
lcd.setCursor(0,1);
lcd.print("Zad:");
lcd.setCursor(8,0);
lcd.print("Gor:");
lcd.setCursor(8,1);
lcd.print("N:");
delay(10);
}
void loop() {
if (!state && !(PINB&SW_U)||(!(PINB&SW_D))) { //jeśli któryś przycisk wciśnięty przeskok do funkcji stop
state=1;
stop(); // wykonywanie po wciśnięciu przycisku
} else state++;
//.....................................................................................przycisk auto
if (!key_sw_a && !(PINB&SW_A)) { // jesli stan niski na SW_A przejdź do automat
key_sw_a=1;
automat();
} else if( key_sw_a && (PINB & SW_A )) key_sw_a++;
//..................................................................................... przycisk SWG
if (!key_g && !(PINB&SW_G)){ // jeśli klucz oraz SWG = 0
key_g=1;
upp();
} else if(key_g && (PINB&SW_G)) key_g++; //jesli klucz 1 oraz swg 1 to
//.....................................................................................automatyka
if (flaga_a==1){
if (U4>(U1+X)||U4<(U1-Y)){
if(U4>(U1+X)){
PORTB |= DOWN; // 1 opuszcz
PORTB &=~UP; // 0 podnosi
} else if (U4<(U1-Y)){
PORTB &=~DOWN; // 0 opuszcza
PORTB |= UP; // 1 podnosi
}
}
else stop();
key_old=key;
if (key_old!=key){
if (key) stop();
else if (!key) stop();
}
if (U4<(U1+X)) key=0;
else if (U4>(U1-Y)) key=1;
}
//................................................................................................
if (U4==U4_old) {
U4_old = U4;
timer3 = 0;
} else if (timer3 == 200) {
stop();
timer3 = 0;
}
//.............................................................
if (U3<10){
if (U5<U3) PORTD |= BUZZ; // 1 na BUZZER włączony
else PORTD &=~BUZZ; // 0 na BUZZER
}
else PORTD &=~BUZZ; // 0 na BUZZER
if (timer>=10){
timer=0;
timer_funkcja();
}
}
//_________________________________________________________________________
ISR(TIMER0_COMPA_vect){ //This is the interrupt request przerwanie od timera
timer++;
timer2++;
//if(flaga_a==1)
timer3++;
//else timer3=0;
if (timer3==201) timer3=0;
}
void timer_funkcja(){
U4=analogRead(pot_4);
U4=U4>>2;
//U4=map(U4,0,1023,0,125);
if (timer2>=20) {
timer2=0;
U1=analogRead(pot_1);
U1=map(U1,0,1023,0,50);
U2=analogRead(pot_2); //gora
U2=U2>>2;
//U2=map(U2,0,1023,0,127);
U3=analogRead(pot_3); // ustalona siła nacisku
//U3=U3>>2;
U3=map(U3,0,1023,0,10);
U5=analogRead(pot_5); // czujnik nacisku
U5=map(U5,0,1023,0,10);
if (prev_U1!=U1) {
prev_U1=U1;
lcd.setCursor (4, 1);
if(U1<10)lcd.print("0");
if(U1<100)lcd.print("0");
lcd.print(U1); //zad
}
if (prev_U2!=U2) {
prev_U2=U2;
lcd.setCursor (13, 0);
if(U2<10)lcd.print("0");
if(U2<100)lcd.print("0");
lcd.print(U2); //gora
}
if (prev_U3!=U3) {
prev_U1=U1;
lcd.setCursor (10, 1);
if(U3<10)lcd.print("0");
lcd.print(U3);
}
if (prev_U4!=U4) {
prev_U4=U4;
lcd.setCursor (4, 0);
if(U4<10)lcd.print("0");
if(U4<100)lcd.print("0");
lcd.print(U4);
}
if (prev_U5!=U5) {
prev_U5=U5;
lcd.setCursor (14, 1);
if(U5<10)lcd.print("0");
lcd.print(U5); //czujnik
}
}
}
void automat(){
if (!(PINC&SW_3)){
flaga_u=0;
flaga_a=1;
PORTD &=~LED_A;
PORTD |=LED_G;
// timer3=0;
// U4_old = U4;
// timer3_old = timer3;
}
}
void upp(){
if (!(PINC&SW_3)) {
flaga_u=1;
flaga_a=0;
PORTD &=~LED_G;
PORTD |= LED_A;
}
}
void stop(){
flaga_a=0;
flaga_u=0;
PORTB &=~DOWN; //0 wył
PORTB &=~UP; //0 wył
PORTD |=LED_A; // 1 dioda wył
PORTD |=LED_G; // 1 dioda wył
}
void kalibracja(){
while(1){
PORTD &=~LED_G; // 0 dioda wł
PORTD &=~LED_A; // 0 dioda wł
lcd.setCursor(0,0);
lcd.print("kalibracja");
}
}[/syntax]
Ale przyznasz, że te kilka stron kodu jednak nie wiele wnosi i nie bez powodu go wcześniej nie podałem, a jeśli wszystko rozkminiłeś to rzeczywiście szacun
Moje zagadnienie jest raczej uniwersalne typu :
[syntax=c]if (U4==U4_old) { //porównaj nową wartość ze starą
U4_old = U4; //przypisz nową do poprzedniej
timer3 = 0; //wyzeruj stanlicznika
} else if (timer3 == 200) {
stop();
timer3 = 0;
}[/syntax]
Oczywiście to powyżej się nie sprawdza, ale chodzi mi o naprowadzenie jak zrobić warunki aby uzyskać pożądany efekt
Statystyki: Napisane przez grego — 11 lut 2021, o 19:22
]]>
