首页 › Arduino › 请教关于while loop

himawaliss 发表于 2015-10-11 18:27:14

请教关于while loop

我想将收到的udp信号写一个循环进行处理，但是我写的代码就上传后就只能收到一次信号。我觉得是我的循环写的有问题，但是我又查不出来。请大家帮我看看，谢谢了！！！

#include <SPI.h>         // needed for Arduino versions later than 0018
#include <Ethernet.h>
#include <EthernetUdp.h>         // UDP library from: [email protected] 12/30/2008
#include <Servo.h>

// Enter a MAC address and IP address of Arduino .
// The IP address will be dependent on your local network:
byte mac[] = { 0xDE, 0xAD, 0xBE, 0xEF, 0xFE, 0xED };
IPAddress ip(169, 254, 148, 239);

unsigned int localPort = 8888;      // local port to listen on

// buffers for receiving
char packetBuffer; //buffer to hold incoming packet,

// An EthernetUDP instance to let us send and receive packets over UDP
EthernetUDP Udp;

// define servos
Servo myServo;
Servo myServo1;
Servo myServo2;
Servo myServo3;
Servo myServo4;
//servoPin={5,6,7,8,9}

//define control signal
int ControlSignal;
int stopPosition = 90;
int level = 12;

void setup() {
myServo.attach(9);
myServo1.attach(8);
myServo2.attach(7);
myServo3.attach(6);
myServo4.attach(5);
// start the Ethernet and UDP:
Ethernet.begin(mac, ip);
Udp.begin(localPort);
Serial.begin(9600);
}

void loop() {
// if there's data available, read a packet
int packetSize = Udp.parsePacket();

if (packetSize)
{
    //Serial.print("Received packet of size ");
    //Serial.println(packetSize);
    //Serial.print("From ");
    //IPAddress remote = Udp.remoteIP();
    //for (int i = 0; i < 4; i++)
    //{
    //Serial.print(remote, DEC);
    //if (i < 3)
    //{
    //Serial.print(".");
    //}
    //}
    //Serial.print(", port ");
    //Serial.println(Udp.remotePort());

    // read the packet into packetBufffer
    Udp.read(packetBuffer, UDP_TX_PACKET_MAX_SIZE);
    //Serial.print(packetBuffer);
    //Serial.println(packetSize);

    //reset memory
    /* for (int i=0;i<UDP_TX_PACKET_MAX_SIZE;i++){
       packetBuffer=0;
       }
       */

    //decide move direction by targetCode and controlSignal

    int j = 0;
    while (j <= 6) {
      if(packetBuffer == '1' && packetSize <= 16) {
      stopPosition -= level;
      myServo.write(stopPosition);
      myServo1.write(stopPosition);
      myServo2.write(stopPosition);
      myServo3.write(stopPosition);
      myServo4.write(stopPosition);
      delay(15);
      }
      if(packetBuffer == '2' && packetSize > 16) {
      stopPosition = stopPosition + level;
      myServo.write(stopPosition);
      myServo1.write(stopPosition);
      myServo2.write(stopPosition);
      myServo3.write(stopPosition);
      myServo4.write(stopPosition);
      delay(15);
      }
      j++;
    }

    //int k = 0;
    //while (k <= 2) {
    if (packetBuffer == '0') {
      myServo.write(90);
      myServo1.write(90);
      myServo2.write(90);
      myServo3.write(90);
      myServo4.write(90);
      delay(15);
    }
    //k = k + 1;
    //}
}
}

叶斌远行 发表于 2015-10-13 21:41:26

把你程序里面舵机控制部分代码去掉，就留下通信部分的单独调试，这样会方便查找问题的。等最后能够顺利通讯之后，再加上其他的控制代码，这样成功的机会比较大、

查看完整版本: 请教关于while loop