giomba
/
coppino
1
0
Fork 0
Code Issues 4 Pull Requests Projects Releases Wiki Activity

simple udp server handler

This commit is contained in:
giomba 2019-12-24 16:54:16 +01:00
parent fabd0886b6
commit ba2f76f7e6
3 changed files with 43 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
coppino-main.ino
View File

@ -1,12 +1,20 @@
#include "coppino.h" #include "coppino.h"
#include "ipv6.h" #include "ipv6.h"
#include "slip.h" #include "slip.h"
#include "udp.h"
void udp_server(const char* buffer, int len) {
digitalWrite(13, !digitalRead(13));
}
void setup() { void setup() {
pinMode(13, OUTPUT); pinMode(13, OUTPUT);
Serial.begin(19200); Serial.begin(19200);
memcpy(&coppino::address, "\x20\x01\x04\x70\xc8\x44\x00\x31\x00\x00\x00\x00\x00\x00\xca\xfe", 16); memcpy(&coppino::address, "\x20\x01\x04\x70\xc8\x44\x00\x31\x00\x00\x00\x00\x00\x00\xca\xfe", 16);
udp::set_handler(80, udp_server);
} }
void loop() { void loop() {

5
udp.h
View File

@ -21,6 +21,11 @@ namespace udp {
}; };
void handleUDP(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6Addr* dst_addr, const char* flow, char* packet, int len); void handleUDP(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6Addr* dst_addr, const char* flow, char* packet, int len);
extern void(*server_handler) (const char* buffer, int size);
extern uint16_t server_port;
void set_handler(uint16_t port, void(* handler) (const char* buffer, int size));
} }
#endif #endif

49
udp.ino
View File

@ -2,6 +2,9 @@
namespace udp { namespace udp {
void(*server_handler) (const char* buffer, int size) = NULL;
uint16_t server_port = 0;
UDPPacket::UDPPacket() { UDPPacket::UDPPacket() {
memset(packet, 0, LEN); memset(packet, 0, LEN);
} }
@ -39,29 +42,37 @@ void UDPPacket::computeChecksum(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6
memcpy(packet + 6, &checksum, 2); memcpy(packet + 6, &checksum, 2);
} }
void set_handler(uint16_t port, void(* server_handler) (const char* buffer, int size)) {
udp::server_port = port;
udp::server_handler = server_handler;
}
void handleUDP(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6Addr* dst_addr, const char* flow, char* packet, int len) { void handleUDP(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6Addr* dst_addr, const char* flow, char* packet, int len) {
UDPPacket udp_packet(packet, len); UDPPacket udp_packet(packet, len);
/* swap ports */ if (udp_packet.getDstPort() == server_port) { /* call user-defined server handler */
uint16_t tmp; if (server_port != 0 && server_handler != NULL) {
tmp = udp_packet.getSrcPort(); server_handler(packet + 8, len - 8);
udp_packet.setSrcPort(udp_packet.getDstPort()); }
udp_packet.setDstPort(tmp); } else { /* echo default UDP application handler */
/* swap ports */
udp_packet.computeChecksum(src_addr, dst_addr, len); uint16_t tmp;
tmp = udp_packet.getSrcPort();
/* prepare IPv6 packet */ udp_packet.setSrcPort(udp_packet.getDstPort());
ipv6::IPv6Packet reply_packet; udp_packet.setDstPort(tmp);
reply_packet.setPayload((char*)&udp_packet, len);
reply_packet.setFlow(flow);
//ipv6::IPv6Addr tmp_addr; udp_packet.computeChecksum(src_addr, dst_addr, len);
//memcpy(&tmp_addr, dst_addr, 16);
reply_packet.setSrcAddress(dst_addr); /* prepare IPv6 packet */
//memcpy(&tmp_addr, src_addr, 16); ipv6::IPv6Packet reply_packet;
reply_packet.setDstAddress(src_addr); reply_packet.setPayload((char*)&udp_packet, len);
reply_packet.setNextHeader(ipv6::NH_UDP); reply_packet.setFlow(flow);
slip::send((void*)&reply_packet, 40 + len);
reply_packet.setSrcAddress(dst_addr);
reply_packet.setDstAddress(src_addr);
reply_packet.setNextHeader(ipv6::NH_UDP);
slip::send((void*)&reply_packet, 40 + len);
}
} }
} }