Управление при помощи поворотного энкодера (Rotary Encoder)

[SiMuS]

например мы садим энкодеры на каналы 2,3 и 4,5
поправьте плз

void loop()  
{  
  if(digitalRead(2)==HIGH){
bytes[0]=25;
  Serial.write( bytes,2); 
  bytes[0]=0;
}else{
bytes[0]=5;
  Serial.write( bytes,2); 
  bytes[0]=0;
}   
  if(digitalRead(3)==HIGH){
bytes[0]=5;
  Serial.write( bytes,2); 
  bytes[0]=0;
}else{
bytes[0]=25;
  Serial.write( bytes,2); 
  bytes[0]=0;
}
  if(digitalRead(4)==HIGH){
bytes[0]=35;
  Serial.write( bytes,2); 
  bytes[0]=0;
}else{
bytes[0]=15;
  Serial.write( bytes,2); 
  bytes[0]=0;
}
  if(digitalRead5)==HIGH){
bytes[0]=15;
  Serial.write( bytes,2); 
  bytes[0]=0;
}else{
bytes[0]=35;
  Serial.write( bytes,2); 
  bytes[0]=0;
}