obsw/mission/testIp.cpp

70 lines
1.6 KiB
C++

#include "FreeRTOS.h"
#include "lwip/sio.h"
#include "task.h"
#include <arpa/inet.h>
#include <cstring>
#include <lwip/ip_addr.h>
#include <lwip/tcpip.h>
#include <lwip/netifapi.h>
#include <netif/slipif.h>
#include <sys/socket.h>
#include <xuartps.h>
extern "C" {
void myInitDone(void *arg) {
puts("init done");
}
}
uint32_t sio_data;
sio_fd_t sio_open(u8_t devnum) { return &sio_data; }
void sio_send(u8_t c, sio_fd_t fd) { XUartPs_SendByte(STDOUT_BASEADDRESS, c); }
void testIp() {
tcpip_init(myInitDone, nullptr);
ip_addr_t slip_addr = IPADDR4_INIT_BYTES(10, 0, 0, 32),
slip_mask = IPADDR4_INIT_BYTES(255, 255, 255, 0),
slip_gw = IPADDR4_INIT_BYTES(10, 25, 0, 1);
struct netif netif;
netifapi_netif_add(&netif, &slip_addr, &slip_mask, &slip_gw, NULL, slipif_init,
netif_input);
netifapi_netif_set_default(&netif);
//should be done by driver, which does not do it, so we do it here
netifapi_netif_set_link_up(&netif);
netifapi_netif_set_up(&netif);
vTaskDelay(pdMS_TO_TICKS(2000));
puts("socket");
int serverSocket = socket(AF_INET, SOCK_DGRAM, 0);
if (serverSocket == -1) {
puts("socket failed");
return;
}
sockaddr_in serverAddr;
memset(&serverAddr, 0, sizeof(serverAddr));
serverAddr.sin_family = AF_INET;
serverAddr.sin_port = htons(0xcafe);
serverAddr.sin_addr.s_addr = inet_addr("10.0.0.13");
uint8_t data[] = {1, 2, 3, 4, 5, 6, 7};
puts("send");
sendto(serverSocket, data, sizeof(data), 0, (sockaddr *)&serverAddr,
sizeof(serverAddr));
puts("send done");
}