///////////////////
#include <Servo.h>
Servo servaProverka;
Servo servaProverka2;
int dur =0;
int val=0;
int val2=0;
int val3=0;
int PPMin = 3; // Сигнал с пульта газ 1490-1510 нетрал
int RCval; // длительность импульса
int adj_val; // назначает что значение должно быть 0-255
int PPMin2 = 2; // Сигнал с пульта газ 1490-1510 нетрал
int RCval2; // длительность импульса
int adj_val2; // назначает что значение должно быть 0-255
int servoPin = 4;
int servoPin2 = 5;
void setup()
{
Serial.begin(9600);
pinMode(PPMin, INPUT); //газ
pinMode(PPMin2, INPUT); //газ
servaProverka.attach(servoPin);
servaProverka2.attach(servoPin2);
}
void loop()
{
{
RCval = pulseIn(PPMin, HIGH, 20000); //руль
adj_val = map(RCval, 1080, 1880, 11, 255); //
val=map(adj_val,140,0,0,24);
val2=map(adj_val,140,0,0,24);
RCval2 = pulseIn(PPMin2, HIGH, 20000); //руль
adj_val2 = map(RCval2, 1080, 1880, 0, 255); //
val3=map(adj_val2,134,6,0,24);
}
//if(val>0&val<2) val=0;
/////////////////////////
//servaProverka.write(95);// левая 4 пин назад
//servaProverka2.write(94); // правая 5 пин вперед
//delay(50); //непосредственно, вызов функции измерения длинны импульса
// Serial.print("val = " ); // запись значения в serial (просмотр в Tools->Serial Monitor)
// Serial.print(duration);
// Serial.println(val);
Serial.println(adj_val2 );
Serial.println(val3);
if(val<-200) val=0 ,val2 =0;
if(val>43) val=0 ,val2 =0;
servaProverka.write(95-val+(val3*3/4));// левая 4 пин назад
servaProverka2.write(94+val2+(val3*3/4)); // правая 5 пин вперед
//delay(500);
}
///////////////////