极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 10715|回复: 1

请教关于while loop

[复制链接]
发表于 2015-10-11 18:27:14 | 显示全部楼层 |阅读模式
我想将收到的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[UDP_TX_PACKET_MAX_SIZE]; //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]={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[11] == '1' && packetSize <= 16) {
        stopPosition -= level;
        myServo.write(stopPosition);
        myServo1.write(stopPosition);
        myServo2.write(stopPosition);
        myServo3.write(stopPosition);
        myServo4.write(stopPosition);
        delay(15);
      }
      if  (packetBuffer[11] == '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[11] == '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 | 显示全部楼层
把你程序里面舵机控制部分代码去掉,就留下通信部分的单独调试,这样会方便查找问题的。等最后能够顺利通讯之后,再加上其他的控制代码,这样成功的机会比较大、
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

Archiver|联系我们|极客工坊

GMT+8, 2026-6-15 17:26 , Processed in 0.054264 second(s), 18 queries .

Powered by Discuz! X3.4

Copyright © 2001-2021, Tencent Cloud.

快速回复 返回顶部 返回列表