74 lines
2.1 KiB
C++
74 lines
2.1 KiB
C++
#include <NativeEthernet.h>
|
|
#include <NativeEthernetServer.h>
|
|
|
|
byte mac[] = { 0x04, 0xE9, 0xE5, 0x10, 0x00, 0x02 };
|
|
IPAddress ip(192, 168, 1, 101);
|
|
const int localPort = 8888;
|
|
|
|
EthernetServer server(localPort);
|
|
EthernetClient client;
|
|
#define package_size 1024
|
|
char packetBuffer[package_size];
|
|
unsigned long prev_time = micros();
|
|
unsigned long prev1_time = micros();
|
|
bool pack_avail = false; // Make sure this is defined
|
|
|
|
|
|
void setup() {
|
|
Serial.begin(921600);
|
|
//while (!Serial);
|
|
|
|
Serial.println("Initializing Ethernet...");
|
|
Ethernet.begin(mac, ip);
|
|
|
|
if (Ethernet.hardwareStatus() == EthernetNoHardware) {
|
|
Serial.println("Ethernet hardware not found!");
|
|
while (true);
|
|
}
|
|
|
|
if (Ethernet.linkStatus() == LinkOFF) {
|
|
Serial.println("Ethernet cable not connected!");
|
|
}
|
|
|
|
server.begin();
|
|
Serial.println("TCP Server Ready. Waiting for connections...");
|
|
}
|
|
|
|
void loop() {
|
|
if (!client || !client.connected()) {
|
|
client = server.available();
|
|
if (client) {
|
|
Serial.println("Client connected!");
|
|
}
|
|
return;
|
|
}
|
|
|
|
int bytesReceived = 0;
|
|
|
|
if (client.available()) {
|
|
int byteRead = client.read(packetBuffer + bytesReceived, package_size - bytesReceived);
|
|
if (byteRead > 0) {
|
|
bytesReceived += byteRead;
|
|
}
|
|
|
|
// Check for "PACKAGE AVAILABLE" only in the first 25 bytes
|
|
if (bytesReceived < 25) {
|
|
if (strstr(packetBuffer, "P_A")) {
|
|
pack_avail = true;
|
|
}
|
|
}
|
|
|
|
// If package is available, read the full package_size
|
|
if (pack_avail & bytesReceived == package_size) {
|
|
uint16_t MHz = (package_size * 8) / (micros() - prev_time);
|
|
Serial.printf("%d MHz\n", MHz);
|
|
prev_time = micros(); // Update prev_time here
|
|
|
|
printf("%d,%d,%d,%d,%d\n", packetBuffer[255], packetBuffer[511], packetBuffer[767], packetBuffer[1023], packetBuffer[0]);
|
|
|
|
bytesReceived = 0; // Reset for the next packet
|
|
pack_avail = false; // Reset pack_avail after reading full package
|
|
}
|
|
}
|
|
}
|