reprapy.pl

Kod: Zaznacz cały

#include <Stepper.h>

const int stepsPerRevolution = 64 * 64;
int ThermistorPin = 0;
int Vo;
float R1 = 10000;
float logR2, R2, T, Tc, Tf;
float c1 = 1.009249522e-03, c2 = 2.378405444e-04, c3 = 2.019202697e-07;

Stepper myStepper(stepsPerRevolution, 9, 7, 8, 6);

void setup() {
  Serial.begin(9600);

}
int temp = 19;//startowa temperatura
int target = 19;//docelowa temperatura
int curpos = 0;//aktualna pozycja gałki
void loop() {

  Vo = analogRead(ThermistorPin);
  R2 = R1 * (1023.0 / (float)Vo - 1.0);
  logR2 = log(R2);
  T = (1.0 / (c1 + c2 * logR2 + c3 * logR2 * logR2 * logR2));
  Tc = T - 273.15;
  int targetpos = (target - (int)Tc) - curpos;
  if ( targetpos != 0 )
  {
    myStepper.setSpeed(2);
    myStepper.step(targetpos * stepsPerRevolution/10);
    curpos = (target - (int)Tc);
    temp = Tc;
    digitalWrite(9, LOW);
    digitalWrite(7, LOW);
    digitalWrite(8, LOW);
    digitalWrite(6, LOW);
    delay(5000);
  }
}