kuwoyuki
8adc726b0b
Squashed commit of the following: commit 5f16309f629b9928d2134b85ae64af69bc3ebbcd Author: kuwoyuki <kuwoyuki@cock.li> Date: Sun Nov 24 22:55:15 2024 +0600 fix: Makefile, improve onewire retries commit 55496a3bda941b52ff349dc75c9c06eb5a37c07d Author: kuwoyuki <kuwoyuki@cock.li> Date: Mon Nov 18 00:41:18 2024 +0600 fix: make onewire validity less strict commit 3428a9bc9792508972ce3e7e4e35a64f047bca10 Author: kuwoyuki <kuwoyuki@cock.li> Date: Sun Nov 17 23:57:55 2024 +0600 chore: rm bins commit 1594e5ed430522b15466c8afa62ff7fb1b28947c Author: kuwoyuki <kuwoyuki@cock.li> Date: Sun Nov 17 23:32:01 2024 +0600 chore: unplatformiofy
114 lines
3.3 KiB
C
114 lines
3.3 KiB
C
#include "multicast.h"
|
|
#include <stdio.h>
|
|
#include "socket.h"
|
|
#include "wizchip_conf.h"
|
|
|
|
|
|
int32_t multicast_loopback(uint8_t sn, uint8_t* buf, uint8_t* multicast_ip, uint16_t multicast_port)
|
|
{
|
|
int32_t ret;
|
|
uint16_t size, sentsize;
|
|
uint8_t destip[4];
|
|
uint16_t destport, port=3000;
|
|
|
|
switch(getSn_SR(sn))
|
|
{
|
|
case SOCK_UDP :
|
|
if((size = getSn_RX_RSR(sn)) > 0)
|
|
{
|
|
if(size > DATA_BUF_SIZE) size = DATA_BUF_SIZE;
|
|
ret = recvfrom(sn, buf, size, destip, (uint16_t*)&destport);
|
|
if(ret <= 0)
|
|
{
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d: recvfrom error. %ld\r\n",sn,ret);
|
|
#endif
|
|
return ret;
|
|
}
|
|
size = (uint16_t) ret;
|
|
sentsize = 0;
|
|
while(sentsize != size)
|
|
{
|
|
ret = sendto(sn, buf+sentsize, size-sentsize, destip, destport);
|
|
if(ret < 0)
|
|
{
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d: sendto error. %ld\r\n",sn,ret);
|
|
#endif
|
|
return ret;
|
|
}
|
|
sentsize += ret; // Don't care SOCKERR_BUSY, because it is zero.
|
|
}
|
|
}
|
|
|
|
break;
|
|
case SOCK_CLOSED:
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d:Multicast Loopback start\r\n",sn);
|
|
#endif
|
|
setSn_DIPR(0, multicast_ip);
|
|
setSn_DPORT(0, multicast_port);
|
|
if((ret = socket(sn, Sn_MR_UDP, port, Sn_MR_MULTI)) != sn)
|
|
return ret;
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d:Opened, UDP Multicast Socket\r\n", sn);
|
|
printf("%d:Multicast Group IP - %d.%d.%d.%d\r\n", sn, multicast_ip[0], multicast_ip[1], multicast_ip[2], multicast_ip[3]);
|
|
printf("%d:Multicast Group Port - %d\r\n", sn, multicast_port);
|
|
#endif
|
|
break;
|
|
default :
|
|
break;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
int32_t multicast_recv(uint8_t sn, uint8_t* buf, uint8_t* multicast_ip, uint16_t multicast_port)
|
|
{
|
|
int32_t ret;
|
|
uint16_t size, port=3000;
|
|
uint8_t destip[4];
|
|
uint16_t destport;
|
|
|
|
switch(getSn_SR(sn))
|
|
{
|
|
case SOCK_UDP :
|
|
if((size = getSn_RX_RSR(sn)) > 0)
|
|
{
|
|
if(size > DATA_BUF_SIZE) size = DATA_BUF_SIZE;
|
|
ret = recvfrom(sn, buf, size, destip, (uint16_t*)&destport);
|
|
if(ret <= 0)
|
|
{
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d: recvfrom error. %ld\r\n",sn,ret);
|
|
#endif
|
|
return ret;
|
|
}
|
|
size = (uint16_t) ret;
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("\r\nrecv size : %d\r\n", size);
|
|
for(int i=0; i<size; i++)
|
|
printf("%c", buf[i]);
|
|
printf("\r\n");
|
|
#endif
|
|
}
|
|
break;
|
|
case SOCK_CLOSED:
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d:Multicast Recv start\r\n",sn);
|
|
#endif
|
|
setSn_DIPR(sn, multicast_ip);
|
|
setSn_DPORT(sn, multicast_port);
|
|
if((ret = socket(sn, Sn_MR_UDP, port, Sn_MR_MULTI)) != sn)
|
|
return ret;
|
|
#ifdef _MULTICAST_DEBUG_
|
|
printf("%d:Opened, UDP Multicast Socket\r\n", sn);
|
|
printf("%d:Multicast Group IP - %d.%d.%d.%d\r\n", sn, multicast_ip[0], multicast_ip[1], multicast_ip[2], multicast_ip[3]);
|
|
printf("%d:Multicast Group Port - %d\r\n", sn, multicast_port);
|
|
#endif
|
|
break;
|
|
default :
|
|
break;
|
|
}
|
|
return 1;
|
|
}
|