huderson

Qua Mar 16, 2022 8:45 am
Sketch funciona separado, juntos radio NRF24L01 nao funciona

Amigos, Bom dia!

Estou tendo o seguinte problema, tenho 2 motores de passo e 2 servos e 2 blocos de leds, controlados via NRF24L01 em um Arduino mega, em sketch separados os motores funcionam como eu quero e os servos funcionam com o radio normal.
Mais assim que junto os dois códigos num sktech único o radio para de funcionar.

Segue o codigo:

Código:#include <Servo.h>
#include <SPI.h>
#include "RF24.h"
#include <Stepper.h>
Servo servo1;
Servo servo2;

#define RED 0x0
#define BLUE 0x1

byte whichLED = RED;
const int LED_Red = 30; // pino ligado Bloco de Led 1
const int LED_Blue = 31; // pino ligado Bloco de Led 2
 

const int stepsPerRevolutionCam = 200;  // numero de steps por revolução motor camera
const int stepsPerRevolutionBase = 1000 ;  // numero de steps por revolução motor base

byte Red_State = LOW;
byte Blue_State = LOW;

unsigned long switchDelay = 550;     //250 550 tempo de um bloco para outro
unsigned long strobeDelay = 45;      // 50  50 velocidade da piscada

unsigned long strobeWait = strobeDelay;
unsigned long waitUntilSwitch = switchDelay; 

Stepper myStepperCam(stepsPerRevolutionCam, 36, 37, 39, 40); // controles motor camera
Stepper myStepperBase(stepsPerRevolutionBase, 41, 43, 44, 45); // controles motor base
 
RF24 radio(48,49); // controles do radio
 
const uint64_t pipe = 0xE8E8F0F0E1LL; 
int msg[1]; 
int data; 
int pos;

void setup(){
servo1.attach(19); // pino ligado servo 1
servo2.attach(21); // pino ligado servo 2
 
radio.begin();
radio.openReadingPipe(1,pipe); 
radio.startListening();
pinMode(LED_Red, OUTPUT);
pinMode(LED_Blue, OUTPUT);
myStepperCam.setSpeed(10);
myStepperBase.setSpeed(10);
Serial.begin(9600);
}

void loop(){
if (radio.available())radio.read(msg, 1);
if (msg[0] <128 && msg[0] >-1)data = msg[0], pos = map(data, 0, 127, 180, 7),servo1.write(pos);     // (data, 0, 127, 7, 177)
if (msg[0] >127 && msg[0] <255)data = msg[0], pos = map(data, 255, 180, 180, 9),servo2.write(pos);  // (data, 128, 254, 9, 177)

digitalWrite(LED_Red, Red_State);     
digitalWrite(LED_Blue, Blue_State); 
 
    
    if ((long)(millis() - waitUntilSwitch)>=0) {
        // time is up!
        Red_State = LOW;
        Blue_State = LOW;
        whichLED = !whichLED;  
        waitUntilSwitch += switchDelay;
    }
 
    
    if ((long)(millis() - strobeWait)>=0) {
        if (whichLED == RED)
            Red_State = !Red_State;
        if (whichLED == BLUE)
            Blue_State = !Blue_State;
        strobeWait += strobeDelay;

  
  Serial.println("clockwise"); 
  myStepperCam.step(-stepsPerRevolutionCam); // gira na sentido horario motor camera
  myStepperBase.step(-stepsPerRevolutionBase); // gira na sentido anti-horario motor base
  delay(500);

  
  Serial.println("counterclockwise");
  myStepperCam.step(stepsPerRevolutionCam);// gira na sentido anti-horario motor camera
  myStepperBase.step(stepsPerRevolutionBase);// gira na sentido horario motor base
  delay(500);

}
}

Desde já já agradeço o auxilio...

Huderson