#define led1 3
#define led2 2
#define pm1 A1
float PMV1=0;
float calcva=0;
float HT=4.48;
float LT =0.8;
void initMotor(){
if(calcva>LT && calcva<HT){
runbw();
Serial.print("BW Run");
Serial.println(calcva);
}
else{
Serial.print("Stopped");
Serial.println(calcva);
stop();
}
}
void setup() {
pinMode(led1, OUTPUT);
pinMode(led2, OUTPUT);
initMotor();
stop();
Serial.begin(115200);
}
void loop() {
PMV1=analogRead(pm1);
calcva=PMV1*(5.0/1023.0);
Serial.println(calcva);
}
void runfw(){
digitalWrite(led1, HIGH);
digitalWrite(led2, LOW);
}
void runbw(){
digitalWrite(led1, LOW);
digitalWrite(led2, HIGH);
}
void stop(){
digitalWrite(led1, LOW);
digitalWrite(led2, LOW);
}