Code Esclave
This commit is contained in:
parent
3b23142fc1
commit
f99cb0c0bb
|
@ -1,29 +1,23 @@
|
||||||
#if defined(ESP8266)
|
|
||||||
#include <ESP8266WiFi.h>
|
|
||||||
#include "MPU9250.h"
|
|
||||||
#else
|
|
||||||
#include <WiFi.h>
|
#include <WiFi.h>
|
||||||
#endif
|
|
||||||
#include <WiFiUdp.h>
|
#include <WiFiUdp.h>
|
||||||
#include <OSCMessage.h>
|
#include <OSCMessage.h>
|
||||||
|
#include <OSCBundle.h>
|
||||||
|
#include <OSCData.h>
|
||||||
char ssid[] = "cohabit"; // your network SSID (name)
|
char ssid[] = "cohabit"; // your network SSID (name)
|
||||||
char pass[] = "lewifidecohabit"; // your network password
|
char pass[] = "lewifidecohabit"; // your network password
|
||||||
|
|
||||||
int update_rate = 1000000;
|
|
||||||
|
|
||||||
|
|
||||||
WiFiUDP Udp;
|
|
||||||
// A UDP instance to let us send and receive packets over UDP
|
// A UDP instance to let us send and receive packets over UDP
|
||||||
const IPAddress outIp(192, 168, 0, 210); // remote IP of your computer
|
WiFiUDP Udp;
|
||||||
const unsigned int outPort = 16403; // remote port to receive OSC
|
const unsigned int localPort = 16403; // local port to listen for UDP packets (here's where we send the packets)
|
||||||
const unsigned int localPort = 16384; // local port to listen for OSC packets (actually not used for sending)
|
int stepPin = 14;
|
||||||
|
int dirPin = 12;
|
||||||
|
|
||||||
void setup() {
|
void setup()
|
||||||
|
{
|
||||||
Serial.begin(115200);
|
Serial.begin(115200);
|
||||||
|
// initialize LED digital pin as an output.
|
||||||
// Connect to WiFi network
|
pinMode(stepPin, OUTPUT);
|
||||||
Serial.println();
|
pinMode(dirPin, OUTPUT);
|
||||||
Serial.println();
|
Serial.println();
|
||||||
Serial.print("Connecting to ");
|
Serial.print("Connecting to ");
|
||||||
Serial.println(ssid);
|
Serial.println(ssid);
|
||||||
|
@ -42,55 +36,31 @@ void setup() {
|
||||||
Serial.println("Starting UDP");
|
Serial.println("Starting UDP");
|
||||||
Udp.begin(localPort);
|
Udp.begin(localPort);
|
||||||
Serial.print("Local port: ");
|
Serial.print("Local port: ");
|
||||||
#ifdef ESP32
|
|
||||||
Serial.println(localPort);
|
Serial.println(localPort);
|
||||||
#else
|
digitalWrite(dirPin, HIGH);
|
||||||
Serial.println(Udp.localPort());
|
|
||||||
#endif
|
|
||||||
}
|
}
|
||||||
void ledtoggle(OSCMessage &msg) {
|
|
||||||
|
void step(OSCMessage &msg) {
|
||||||
switch (msg.getInt(0)) {
|
switch (msg.getInt(0)) {
|
||||||
case 0:
|
case 0:
|
||||||
digitalWrite(LED_BUILTIN, LOW);
|
digitalWrite(stepPin, LOW);
|
||||||
break;
|
break;
|
||||||
case 1:
|
case 1:
|
||||||
digitalWrite(LED_BUILTIN, HIGH);
|
digitalWrite(stepPin, HIGH);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void receiveMessage() {
|
void loop()
|
||||||
OSCMessage inmsg;
|
{
|
||||||
|
OSCMessage msg;
|
||||||
int size = Udp.parsePacket();
|
int size = Udp.parsePacket();
|
||||||
|
|
||||||
if (size > 0) {
|
if (size > 0) {
|
||||||
while (size--) {
|
while (size--) {
|
||||||
inmsg.fill(Udp.read());
|
msg.fill(Udp.read());
|
||||||
}
|
}
|
||||||
if (!inmsg.hasError()) {
|
//step(msg);
|
||||||
inmsg.dispatch("/led", ledtoggle);
|
step(msg);
|
||||||
}
|
|
||||||
//else { auto error = inmsg.getError(); }
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop() {
|
|
||||||
receiveMessage();
|
|
||||||
OSCMessage msg("/step");
|
|
||||||
msg.add(1);
|
|
||||||
Udp.beginPacket(outIp, outPort);
|
|
||||||
msg.send(Udp);
|
|
||||||
Udp.endPacket();
|
|
||||||
msg.empty();
|
|
||||||
delayMicroseconds(update_rate);
|
|
||||||
OSCMessage msg2("/Step");
|
|
||||||
msg2.add(0);
|
|
||||||
Udp.beginPacket(outIp, outPort);
|
|
||||||
msg2.send(Udp);
|
|
||||||
Udp.endPacket();
|
|
||||||
msg2.empty();
|
|
||||||
delayMicroseconds(update_rate);
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
Loading…
Reference in a new issue