Форум РадиоКот

Код: Выделить всё

#include <avr/io.h>
//#include <util/delay.h>
#include <SPI.h>
#include <RF24.h>
#include <Servo.h>
Servo myservo;  // create servo object to control a servo
RF24 radio(10, 9);
const uint32_t pipe = 123456789;
byte data[4];
byte speedBtnS;
int SPD = 0;

void setup()   
{
  DDRD |= (1<<5);
  DDRD |= (1<<6); 
  DDRD |= (1<<7); 
  PORTD &= ~(1<<6);
  PORTD &= ~(1<<7);
  myservo.attach(8);  // attaches the servo on pin 9 to the servo object
  //Serial.begin(57600);
  radio.begin();
  radio.setDataRate(RF24_250KBPS); // RF24_1MBPS или RF24_2MBPS
  radio.openReadingPipe(1,pipe); // открыть канал на приём
  radio.startListening(); // приём
  myservo.write(90);
}


void loop()  
{
  if(radio.available())
    {
      radio.read(data, 1);
      //Serial.println(data[0]);
      speedBtnS = (data[0] & 0b11110000) >> 4; // Берем старшие 4 бита для ШИМ (скорости)
      //speedBtnS = map(speedBtnS, 0, 15, 63, 255);   // не работает на МЕГЕ8
      analogWrite(5, (speedBtnS*13) + 60);  // устанавливаем значение ШИМ
      if (data[0] & 0b00000001){ // чтение конкретного бита
        if (data[0] & 0b00000010){ // чтение конкретного бита
          myservo.write(120); // налево
        }
        else
        {
          myservo.write(60); // направо
        }
      }
      else
      {
        myservo.write(90); // прямо
      }
      if (data[0] & 0b00000100){ // чтение конкретного бита
        if (data[0] & 0b00001000){ // чтение конкретного бита
          PORTD |= (1<<6);
          PORTD &= ~(1<<7);//// вперед
        }
        else
        {
          PORTD |= (1<<7);
          PORTD &= ~(1<<6); //// назад
        }
      }
      else
      {
        PORTD &= ~(1<<7);
        PORTD &= ~(1<<6); // стоп
      }        
   }
}