mirror of
https://github.com/pvvx/RTL00_WEB.git
synced 2024-12-29 09:05:18 +00:00
82 lines
2.1 KiB
C
82 lines
2.1 KiB
C
|
#include "FreeRTOS.h"
|
||
|
|
#include "task.h"
|
||
|
|
#include <platform/platform_stdlib.h>
|
||
|
|
|
||
|
|
#include <lwip/sockets.h>
|
||
|
|
#include <lwip_netconf.h>
|
||
|
|
#include <lwip/netif.h>
|
||
|
|
|
||
|
|
static void example_bcast_thread(void *param)
|
||
|
|
{
|
||
|
|
int socket = -1;
|
||
|
|
int broadcast = 1;
|
||
|
|
struct sockaddr_in bindAddr;
|
||
|
|
uint16_t port = 49152;
|
||
|
|
unsigned char packet[1024];
|
||
|
|
|
||
|
|
// Create socket
|
||
|
|
if((socket = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
|
||
|
|
printf("ERROR: socket failed\n");
|
||
|
|
goto err;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Set broadcast socket option
|
||
|
|
if(setsockopt(socket, SOL_SOCKET, SO_BROADCAST, &broadcast, sizeof(broadcast)) < 0){
|
||
|
|
printf("ERROR: setsockopt failed\n");
|
||
|
|
goto err;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Set the bind address
|
||
|
|
memset(&bindAddr, 0, sizeof(bindAddr));
|
||
|
|
bindAddr.sin_family = AF_INET;
|
||
|
|
bindAddr.sin_port = htons(port);
|
||
|
|
bindAddr.sin_addr.s_addr = INADDR_ANY;
|
||
|
|
if(bind(socket, (struct sockaddr *) &bindAddr, sizeof(bindAddr)) < 0){
|
||
|
|
printf("ERROR: bind failed\n");
|
||
|
|
goto err;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
while(1) {
|
||
|
|
// Receive broadcast
|
||
|
|
int packetLen;
|
||
|
|
struct sockaddr from;
|
||
|
|
struct sockaddr_in *from_sin = (struct sockaddr_in*) &from;
|
||
|
|
socklen_t fromLen = sizeof(from);
|
||
|
|
|
||
|
|
if((packetLen = recvfrom(socket, &packet, sizeof(packet), 0, &from, &fromLen)) >= 0) {
|
||
|
|
uint8_t *ip = (uint8_t *) &from_sin->sin_addr.s_addr;
|
||
|
|
uint16_t from_port = ntohs(from_sin->sin_port);
|
||
|
|
printf("recvfrom - %d bytes from %d.%d.%d.%d:%d\n", packetLen, ip[0], ip[1], ip[2], ip[3], from_port);
|
||
|
|
}
|
||
|
|
|
||
|
|
// Send broadcast
|
||
|
|
if(packetLen > 0) {
|
||
|
|
int sendLen;
|
||
|
|
struct sockaddr to;
|
||
|
|
struct sockaddr_in *to_sin = (struct sockaddr_in*) &to;
|
||
|
|
to_sin->sin_family = AF_INET;
|
||
|
|
to_sin->sin_port = htons(port);
|
||
|
|
to_sin->sin_addr.s_addr = INADDR_ANY;
|
||
|
|
|
||
|
|
if((sendLen = sendto(socket, packet, packetLen, 0, &to, sizeof(struct sockaddr))) < 0)
|
||
|
|
printf("ERROR: sendto broadcast\n");
|
||
|
|
else
|
||
|
|
printf("sendto - %d bytes to broadcast:%d\n", sendLen, port);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
err:
|
||
|
|
printf("ERROR: broadcast example failed\n");
|
||
|
|
close(socket);
|
||
|
|
vTaskDelete(NULL);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
void example_bcast(void)
|
||
|
|
{
|
||
|
|
if(xTaskCreate(example_bcast_thread, ((const char*)"example_bcast_thread"), 2048, NULL, tskIDLE_PRIORITY + 1, NULL) != pdPASS)
|
||
|
|
printf("\n\r%s xTaskCreate(init_thread) failed", __FUNCTION__);
|
||
|
|
}
|