Ok i am realy sory it is my fail with non - sharing code. Here it is :
#include <Servo.h>
int dirPin1M1 = 3; // nastavení směru 1 motoru 1
int dirPin2M1 = 4; // nastavení směru 2 motoru 1
int pwmPin1 = 5; // výstup PWM1
int dirPin1M2 = 7; // nastavení směru 1 motoru 2
int dirPin2M2 = 8; // nastavení směru 2 motoru 2
int pwmPin2 = 6; // výstup PWM2
byte x1, x2, x3, x4;
Servo m1Servo;
Servo m2Servo;
int duty1, duty2, duty3, duty4;
void setup()
{
m1Servo.attach(9);//definice portu připojení serva
m2Servo.attach(10);//definice portu připojení serva
Serial.begin(9600);
pinMode(dirPin1M1, OUTPUT);
pinMode(dirPin2M1, OUTPUT);
pinMode( pwmPin1, OUTPUT);
pinMode(dirPin1M2, OUTPUT);
pinMode( dirPin2M2, OUTPUT);
pinMode( pwmPin2, OUTPUT);
digitalWrite(pwmPin1, LOW);
digitalWrite(pwmPin2, LOW);
digitalWrite(dirPin1M1, LOW);
digitalWrite(dirPin2M1, LOW);
digitalWrite(dirPin1M2, LOW);
digitalWrite(dirPin2M2, LOW);
}
void loop() {
if (Serial.available() == 4)
{
x1 = (Serial.read());
int duty1 = (x1) & 0b01111111;
if (x1 & 0b10000000)
{
digitalWrite(dirPin1M1, 1);
digitalWrite(dirPin2M1, 0);
}
else
{
digitalWrite(dirPin2M1, 1);
digitalWrite(dirPin1M1, 0);
}
x2 = ( Serial.read());
int duty2 = (x2) & 0b01111111;
if (x2 & 0b10000000)
{
digitalWrite(dirPin1M2, 1);
digitalWrite(dirPin2M2, 0);
}
else
{
digitalWrite(dirPin2M2, 1);
digitalWrite(dirPin1M2, 0);
}
x3 = (Serial.read());
int duty3 = x3;
m1Servo.write(0);//nastav servo uhel 0
m1Servo.write(duty3 * 2); //nastav servo uhel x
x4 = (Serial.read());
int duty4 = x4;
m2Servo.write(0);//nastav servo uhel 0
m2Servo.write(duty4 * 2); //nastav servo uhel x
analogWrite(pwmPin1, duty1 * 2);
analogWrite(pwmPin2, duty2 * 2);
}
}