reprapy.pl

Kod: Zaznacz cały

#include <Servo.h>  //Binlioteka serwa

Servo serwomechanizm;  //Odwołanie do serwa

volatile word a;     //prędkość
volatile word q;     //czas miedzy impulsami
unsigned long time;  //czas w którym był impuls
byte pozycja = 0; //Aktualna pozycja serwa 0-180

void setup() {

 pinMode(2, INPUT_PULLUP); //Kontaktron podłączony do pinu 3
 attachInterrupt(digitalPinToInterrupt (2), licz, FALLING);
  serwomechanizm.attach(10);  //Serwomechanizm podłączony do pinu 10
 
  serwomechanizm.write(4);  //Idzie na pozycję zero (przełożenie serwo-wskazówka na trybkach 2:1)
delay(500);
serwomechanizm.write(136);  //Koniec skali
delay(500);
serwomechanizm.write(64); //Połowa skali
delay(500);
serwomechanizm.write(4);  //Pozycja zero
delay(500);

//Serial.begin(9600);                // configure serial for debug
}

void loop() {

if(millis()-time<1200)
a=1144/q;                           //obwód koła 1,256m; 4 magnesy na kole co 0,314m daje 3148 impulsy na 1km; impulsy/(1km/h)  3148/3,600=0,87444Hz; impuls co 1144ms/(1km/h)
else
a=0;
//pozycja = map(a,0,12,4,136);
pozycja=(a*10+4);
if (pozycja >= 136) {serwomechanizm.write(136);}
if (pozycja <= 4) {serwomechanizm.write(4);}
 serwomechanizm.write(pozycja);

//if (a>1 && a<70) {Serial.println (a);}

}
//Funkcja odpowiedzialna za liczenie czasu miedzy impulsami
void licz()
{
  q=millis()-time;
  time=millis();
}

Kod: Zaznacz cały

#include <VarSpeedServo.h>

VarSpeedServo serwomechanizm;

volatile word a;     //prędkość
volatile word q;     //czas miedzy impulsami
unsigned long time;  //czas w którym był impuls
byte pozycja = 0; //Aktualna pozycja serwa 0-180

void setup() {

 pinMode(2, INPUT_PULLUP); //Kontaktron podłączony do pinu 3
 attachInterrupt(digitalPinToInterrupt (2), licz, FALLING);  

serwomechanizm.attach(10);  //Serwomechanizm podłączony do pinu 10, długosc impulsu pozycja 0, dlugosc impulsu pozycja 180

serwomechanizm.write(4,200);  //Idzie na pozycję zero (przełożenie serwo-wskazówka na trybkach 2:1)
delay(500);
serwomechanizm.write(134,200);  //Koniec skali
delay(500);
serwomechanizm.write(64,200); //Połowa skali
delay(500);
serwomechanizm.write(4,200);  //Pozycja zero
delay(500);  
}
void loop() {
  
if(millis()-time<1500)
a=1107000/q;              //obwód koła 1,23m; 4 magnesy na kole co 0,3075m daje 3252 impulsy na 1km; impulsy/(1km/h)  3252/3600=0,90334Hz; impuls co 1107ms/(1km/h)
else
a=0;
pozycja = map(a,0,12000,4,134); //(prędkość,0,koniec skali x 1000, pozycja 0km/h, pozycja 12km/h koniec skali)

 serwomechanizm.write(pozycja,30);
}

//Funkcja odpowiedzialna za liczenie czasu miedzy impulsami
void licz()
{
 // q=millis()-time; // edit by dziobu
 word tmp;           // edit by dziobu
tmp=millis()-time;   // edit by dziobu
if(tmp < 82)         // edit by dziobu
  return;            // edit by dziobu
q = (q*3 + tmp) >> 2; //edit by dziobu
 
  time=millis();
}

Kod: Zaznacz cały

unsigned word speed_curr; // tyle jedziesz
unsigned word speed_show; // a to wyświetlasz
...

...gdzieś w loop...
if(speed_show > speed_curr) {
  speed_show--;
  wyslij_do_Serwa_nowa_pozycje(speed_show);
} else
if(speed_show < speed_curr) {
  speed_show++;
  wyslij_do_Serwa_nowa_pozycje(speed_show);
}

Kod: Zaznacz cały

if(act_speed_x > speed_x)
{
	setTimeout(() => {  act_speed_x -= 1; }, 0.01);
}

Kod: Zaznacz cały

unsigned long last_change = 0;
void loop()
{
	if(millis() - last_change >= 20) //założyłem 20 ale opóźnienie możesz dobrać eksperymentalnie
	{
		//kod od @dziobu
		last_change = millis();
	}
}