support plc socket and optimize LWIP test demo cases
This commit is contained in:
parent
68e5436aae
commit
e5d124231c
|
@ -67,7 +67,7 @@ static void TCPSocketRecvTask(void *arg)
|
||||||
}
|
}
|
||||||
|
|
||||||
lw_print("tcp bind success, start to receive.\n");
|
lw_print("tcp bind success, start to receive.\n");
|
||||||
lw_pr_info("\n\nLocal Port:%d\n\n", LWIP_LOCAL_PORT);
|
lw_notice("\n\nLocal Port:%d\n\n", LWIP_LOCAL_PORT);
|
||||||
|
|
||||||
// setup socket fd as listening mode
|
// setup socket fd as listening mode
|
||||||
if (listen(fd, 5) != 0 )
|
if (listen(fd, 5) != 0 )
|
||||||
|
@ -78,7 +78,7 @@ static void TCPSocketRecvTask(void *arg)
|
||||||
|
|
||||||
// accept client connection
|
// accept client connection
|
||||||
clientfd = accept(fd, (struct sockaddr *)&tcp_addr, (socklen_t*)&addr_len);
|
clientfd = accept(fd, (struct sockaddr *)&tcp_addr, (socklen_t*)&addr_len);
|
||||||
lw_pr_info("client %s connected\n", inet_ntoa(tcp_addr.sin_addr));
|
lw_notice("client %s connected\n", inet_ntoa(tcp_addr.sin_addr));
|
||||||
|
|
||||||
while(1)
|
while(1)
|
||||||
{
|
{
|
||||||
|
@ -86,8 +86,8 @@ static void TCPSocketRecvTask(void *arg)
|
||||||
recv_len = recvfrom(clientfd, recv_buf, TCP_DEMO_BUF_SIZE, 0, (struct sockaddr *)&tcp_addr, &addr_len);
|
recv_len = recvfrom(clientfd, recv_buf, TCP_DEMO_BUF_SIZE, 0, (struct sockaddr *)&tcp_addr, &addr_len);
|
||||||
if(recv_len > 0)
|
if(recv_len > 0)
|
||||||
{
|
{
|
||||||
lw_pr_info("Receive from : %s\n", inet_ntoa(tcp_addr.sin_addr));
|
lw_notice("Receive from : %s\n", inet_ntoa(tcp_addr.sin_addr));
|
||||||
lw_pr_info("Receive data : %d - %s\n\n", recv_len, recv_buf);
|
lw_notice("Receive data : %d - %s\n\n", recv_len, recv_buf);
|
||||||
}
|
}
|
||||||
sendto(clientfd, recv_buf, recv_len, 0, (struct sockaddr*)&tcp_addr, addr_len);
|
sendto(clientfd, recv_buf, recv_len, 0, (struct sockaddr*)&tcp_addr, addr_len);
|
||||||
}
|
}
|
||||||
|
@ -113,7 +113,7 @@ void TCPSocketRecvTest(int argc, char *argv[])
|
||||||
sscanf(argv[1], "%d.%d.%d.%d", &tcp_socket_ip[0], &tcp_socket_ip[1], &tcp_socket_ip[2], &tcp_socket_ip[3]);
|
sscanf(argv[1], "%d.%d.%d.%d", &tcp_socket_ip[0], &tcp_socket_ip[1], &tcp_socket_ip[2], &tcp_socket_ip[3]);
|
||||||
}
|
}
|
||||||
|
|
||||||
lwip_config_tcp(lwip_ipaddr, lwip_netmask, lwip_gwaddr);
|
lwip_config_tcp(lwip_ipaddr, lwip_netmask, tcp_socket_ip);
|
||||||
sys_thread_new("TCPSocketRecvTask", TCPSocketRecvTask, NULL, LWIP_TASK_STACK_SIZE, LWIP_DEMO_TASK_PRIO);
|
sys_thread_new("TCPSocketRecvTask", TCPSocketRecvTask, NULL, LWIP_TASK_STACK_SIZE, LWIP_DEMO_TASK_PRIO);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -133,7 +133,7 @@ static void TCPSocketSendTask(void *arg)
|
||||||
if (fd < 0)
|
if (fd < 0)
|
||||||
{
|
{
|
||||||
lw_print("Socket error\n");
|
lw_print("Socket error\n");
|
||||||
goto __exit;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
struct sockaddr_in tcp_sock;
|
struct sockaddr_in tcp_sock;
|
||||||
|
@ -145,25 +145,23 @@ static void TCPSocketSendTask(void *arg)
|
||||||
if (connect(fd, (struct sockaddr *)&tcp_sock, sizeof(struct sockaddr)))
|
if (connect(fd, (struct sockaddr *)&tcp_sock, sizeof(struct sockaddr)))
|
||||||
{
|
{
|
||||||
lw_print("Unable to connect\n");
|
lw_print("Unable to connect\n");
|
||||||
goto __exit;
|
closesocket(fd);
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
lw_print("tcp connect success, start to send.\n");
|
lw_print("tcp connect success, start to send.\n");
|
||||||
lw_pr_info("\n\nTarget Port:%d\n\n", LWIP_TARGET_PORT);
|
lw_notice("\n\nTarget Port:%d\n\n", LWIP_TARGET_PORT);
|
||||||
|
|
||||||
while (cnt --)
|
while (cnt --)
|
||||||
{
|
{
|
||||||
lw_print("Lwip client is running.\n");
|
lw_print("Lwip client is running.\n");
|
||||||
snprintf(send_msg, sizeof(send_msg), "TCP test package times %d\r\n", cnt);
|
snprintf(send_msg, sizeof(send_msg), "TCP test package times %d\r\n", cnt);
|
||||||
sendto(fd, send_msg, strlen(send_msg), 0, (struct sockaddr*)&tcp_sock, sizeof(struct sockaddr));
|
sendto(fd, send_msg, strlen(send_msg), 0, (struct sockaddr*)&tcp_sock, sizeof(struct sockaddr));
|
||||||
lw_pr_info("Send tcp msg: %s ", send_msg);
|
lw_notice("Send tcp msg: %s ", send_msg);
|
||||||
MdelayKTask(1000);
|
MdelayKTask(1000);
|
||||||
}
|
}
|
||||||
|
|
||||||
__exit:
|
|
||||||
if (fd >= 0)
|
|
||||||
closesocket(fd);
|
closesocket(fd);
|
||||||
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -78,8 +78,8 @@ static void UdpSocketRecvTask(void *arg)
|
||||||
{
|
{
|
||||||
memset(recv_buf, 0, UDP_BUF_SIZE);
|
memset(recv_buf, 0, UDP_BUF_SIZE);
|
||||||
recv_len = recvfrom(socket_fd, recv_buf, UDP_BUF_SIZE, 0, (struct sockaddr *)&server_addr, &addr_len);
|
recv_len = recvfrom(socket_fd, recv_buf, UDP_BUF_SIZE, 0, (struct sockaddr *)&server_addr, &addr_len);
|
||||||
lw_pr_info("Receive from : %s\n", inet_ntoa(server_addr.sin_addr));
|
lw_notice("Receive from : %s\n", inet_ntoa(server_addr.sin_addr));
|
||||||
lw_pr_info("Receive data : %s\n\n", recv_buf);
|
lw_notice("Receive data : %s\n\n", recv_buf);
|
||||||
sendto(socket_fd, recv_buf, recv_len, 0, (struct sockaddr*)&server_addr, addr_len);
|
sendto(socket_fd, recv_buf, recv_len, 0, (struct sockaddr*)&server_addr, addr_len);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -151,7 +151,7 @@ static void UdpSocketSendTask(void *arg)
|
||||||
{
|
{
|
||||||
snprintf(send_str, sizeof(send_str), "UDP test package times %d\r\n", cnt);
|
snprintf(send_str, sizeof(send_str), "UDP test package times %d\r\n", cnt);
|
||||||
sendto(socket_fd, send_str, strlen(send_str), 0, (struct sockaddr*)&udp_sock, sizeof(struct sockaddr));
|
sendto(socket_fd, send_str, strlen(send_str), 0, (struct sockaddr*)&udp_sock, sizeof(struct sockaddr));
|
||||||
lw_pr_info("Send UDP msg: %s ", send_str);
|
lw_notice("Send UDP msg: %s ", send_str);
|
||||||
MdelayKTask(1000);
|
MdelayKTask(1000);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -11,7 +11,7 @@
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @file ua_demo.c
|
* @file opcua_demo.c
|
||||||
* @brief Demo for OpcUa function
|
* @brief Demo for OpcUa function
|
||||||
* @version 1.0
|
* @version 1.0
|
||||||
* @author AIIT XUOS Lab
|
* @author AIIT XUOS Lab
|
||||||
|
@ -29,7 +29,6 @@
|
||||||
* Definitions
|
* Definitions
|
||||||
******************************************************************************/
|
******************************************************************************/
|
||||||
|
|
||||||
#define TCP_LOCAL_PORT 4840
|
|
||||||
#define UA_URL_SIZE 100
|
#define UA_URL_SIZE 100
|
||||||
#define UA_STACK_SIZE 4096
|
#define UA_STACK_SIZE 4096
|
||||||
#define UA_TASK_PRIO 15
|
#define UA_TASK_PRIO 15
|
||||||
|
@ -66,18 +65,17 @@ static void UaConnectTestTask(void* arg)
|
||||||
UA_ClientConfig_setDefault(config);
|
UA_ClientConfig_setDefault(config);
|
||||||
snprintf(ua_uri, sizeof(ua_uri), "opc.tcp://%d.%d.%d.%d:4840",
|
snprintf(ua_uri, sizeof(ua_uri), "opc.tcp://%d.%d.%d.%d:4840",
|
||||||
test_ua_ip[0], test_ua_ip[1], test_ua_ip[2], test_ua_ip[3]);
|
test_ua_ip[0], test_ua_ip[1], test_ua_ip[2], test_ua_ip[3]);
|
||||||
ua_pr_info("ua uri: %d %s\n", strlen(ua_uri), ua_uri);
|
ua_notice("ua uri: %d %s\n", strlen(ua_uri), ua_uri);
|
||||||
retval = UA_Client_connect(client,ua_uri);
|
retval = UA_Client_connect(client,ua_uri);
|
||||||
|
|
||||||
if(retval != UA_STATUSCODE_GOOD)
|
if(retval != UA_STATUSCODE_GOOD)
|
||||||
{
|
{
|
||||||
ua_pr_info("ua: [%s] connected failed %x\n", __func__, retval);
|
ua_notice("ua: [%s] connected failed %x\n", __func__, retval);
|
||||||
UA_Client_delete(client);
|
UA_Client_delete(client);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
ua_pr_info("ua: [%s] connected ok!\n", __func__);
|
ua_notice("ua: [%s] connected ok!\n", __func__);
|
||||||
UA_Client_disconnect(client);
|
|
||||||
UA_Client_delete(client);
|
UA_Client_delete(client);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -92,12 +90,13 @@ SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) |
|
||||||
|
|
||||||
void UaBrowserObjectsTestTask(void* param)
|
void UaBrowserObjectsTestTask(void* param)
|
||||||
{
|
{
|
||||||
|
static int test_cnt = 0;
|
||||||
UA_Client* client = UA_Client_new();
|
UA_Client* client = UA_Client_new();
|
||||||
ua_pr_info("ua: [%s] start ...\n", __func__);
|
ua_notice("ua: [%s] start %d ...\n", __func__, test_cnt++);
|
||||||
|
|
||||||
if(client == NULL)
|
if(client == NULL)
|
||||||
{
|
{
|
||||||
ua_print("ua: [%s] tcp client null\n", __func__);
|
ua_error("ua: [%s] tcp client NULL\n", __func__);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -107,18 +106,17 @@ void UaBrowserObjectsTestTask(void* param)
|
||||||
|
|
||||||
if(retval != UA_STATUSCODE_GOOD)
|
if(retval != UA_STATUSCODE_GOOD)
|
||||||
{
|
{
|
||||||
ua_print("ua: [%s] connect failed %#x\n", __func__, retval);
|
ua_error("ua: [%s] connect failed %#x\n", __func__, retval);
|
||||||
UA_Client_delete(client);
|
UA_Client_delete(client);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
ua_print("ua: [%s] connect ok!\n", __func__);
|
ua_notice("--- start read time ---\n", __func__);
|
||||||
ua_pr_info("--- start read time ---\n", __func__);
|
|
||||||
ua_read_time(client);
|
ua_read_time(client);
|
||||||
ua_pr_info("--- get server info ---\n", __func__);
|
ua_notice("--- get server info ---\n", __func__);
|
||||||
ua_test_browser_objects(client);
|
ua_test_browser_objects(client);
|
||||||
|
|
||||||
/* Clean up */
|
/* Clean up */
|
||||||
UA_Client_disconnect(client);
|
|
||||||
UA_Client_delete(client); /* Disconnects the client internally */
|
UA_Client_delete(client); /* Disconnects the client internally */
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -130,7 +128,7 @@ void* UaBrowserObjectsTest(int argc, char* argv[])
|
||||||
{
|
{
|
||||||
if(sscanf(argv[1], "%d.%d.%d.%d", &test_ua_ip[0], &test_ua_ip[1], &test_ua_ip[2], &test_ua_ip[3]) == EOF)
|
if(sscanf(argv[1], "%d.%d.%d.%d", &test_ua_ip[0], &test_ua_ip[1], &test_ua_ip[2], &test_ua_ip[3]) == EOF)
|
||||||
{
|
{
|
||||||
lw_pr_info("input wrong ip\n");
|
lw_notice("input wrong ip\n");
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -147,7 +145,7 @@ SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) |
|
||||||
void UaGetInfoTestTask(void* param)
|
void UaGetInfoTestTask(void* param)
|
||||||
{
|
{
|
||||||
UA_Client* client = UA_Client_new();
|
UA_Client* client = UA_Client_new();
|
||||||
ua_pr_info("ua: [%s] start ...\n", __func__);
|
ua_notice("ua: [%s] start ...\n", __func__);
|
||||||
|
|
||||||
if(client == NULL)
|
if(client == NULL)
|
||||||
{
|
{
|
||||||
|
@ -167,7 +165,7 @@ void UaGetInfoTestTask(void* param)
|
||||||
}
|
}
|
||||||
|
|
||||||
ua_print("ua: [%s] connect ok!\n", __func__);
|
ua_print("ua: [%s] connect ok!\n", __func__);
|
||||||
ua_pr_info("--- interactive server ---\n", __func__);
|
ua_notice("--- interactive server ---\n", __func__);
|
||||||
ua_test_interact_server(client);
|
ua_test_interact_server(client);
|
||||||
/* Clean up */
|
/* Clean up */
|
||||||
UA_Client_disconnect(client);
|
UA_Client_disconnect(client);
|
||||||
|
@ -182,7 +180,7 @@ void* UaGetInfoTest(int argc, char* argv[])
|
||||||
{
|
{
|
||||||
if(sscanf(argv[1], "%d.%d.%d.%d", &test_ua_ip[0], &test_ua_ip[1], &test_ua_ip[2], &test_ua_ip[3]) == EOF)
|
if(sscanf(argv[1], "%d.%d.%d.%d", &test_ua_ip[0], &test_ua_ip[1], &test_ua_ip[2], &test_ua_ip[3]) == EOF)
|
||||||
{
|
{
|
||||||
lw_pr_info("input wrong ip\n");
|
lw_notice("input wrong ip\n");
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -199,7 +197,7 @@ SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) |
|
||||||
void UaAddNodesTask(void* param)
|
void UaAddNodesTask(void* param)
|
||||||
{
|
{
|
||||||
UA_Client* client = UA_Client_new();
|
UA_Client* client = UA_Client_new();
|
||||||
ua_pr_info("ua: [%s] start ...\n", __func__);
|
ua_notice("ua: [%s] start ...\n", __func__);
|
||||||
|
|
||||||
if(client == NULL)
|
if(client == NULL)
|
||||||
{
|
{
|
||||||
|
@ -219,7 +217,7 @@ void UaAddNodesTask(void* param)
|
||||||
}
|
}
|
||||||
|
|
||||||
ua_print("ua: [%s] connect ok!\n", __func__);
|
ua_print("ua: [%s] connect ok!\n", __func__);
|
||||||
ua_pr_info("--- add nodes ---\n", __func__);
|
ua_notice("--- add nodes ---\n", __func__);
|
||||||
ua_add_nodes(client);
|
ua_add_nodes(client);
|
||||||
/* Clean up */
|
/* Clean up */
|
||||||
UA_Client_disconnect(client);
|
UA_Client_disconnect(client);
|
||||||
|
@ -234,7 +232,7 @@ void* UaAddNodesTest(int argc, char* argv[])
|
||||||
{
|
{
|
||||||
if(sscanf(argv[1], "%d.%d.%d.%d", &test_ua_ip[0], &test_ua_ip[1], &test_ua_ip[2], &test_ua_ip[3]) == EOF)
|
if(sscanf(argv[1], "%d.%d.%d.%d", &test_ua_ip[0], &test_ua_ip[1], &test_ua_ip[2], &test_ua_ip[3]) == EOF)
|
||||||
{
|
{
|
||||||
lw_pr_info("input wrong ip\n");
|
lw_notice("input wrong ip\n");
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
|
@ -4,3 +4,7 @@ menuconfig USING_CONTROL_PLC_OPCUA
|
||||||
default y
|
default y
|
||||||
depends on RESOURCES_LWIP
|
depends on RESOURCES_LWIP
|
||||||
|
|
||||||
|
menuconfig USING_CONTROL_PLC_SOCKET
|
||||||
|
bool "PLC support SOCKET"
|
||||||
|
default y
|
||||||
|
depends on RESOURCES_LWIP
|
||||||
|
|
|
@ -6,6 +6,10 @@ ifeq ($(CONFIG_USING_CONTROL_PLC_OPCUA), y)
|
||||||
SRC_DIR += opcua
|
SRC_DIR += opcua
|
||||||
endif
|
endif
|
||||||
|
|
||||||
|
ifeq ($(CONFIG_USING_CONTROL_PLC_SOCKET), y)
|
||||||
|
SRC_DIR += socket
|
||||||
|
endif
|
||||||
|
|
||||||
endif
|
endif
|
||||||
|
|
||||||
SRC_FILES += interoperability.c
|
SRC_FILES += interoperability.c
|
||||||
|
|
|
@ -68231,11 +68231,11 @@ UA_Log_Stdout_log(void *context, UA_LogLevel level, UA_LogCategory category,
|
||||||
// (int)(tOffset / UA_DATETIME_SEC / 36), logLevelNames[level], logCategoryNames[category]);
|
// (int)(tOffset / UA_DATETIME_SEC / 36), logLevelNames[level], logCategoryNames[category]);
|
||||||
// vprintf(msg, args);
|
// vprintf(msg, args);
|
||||||
|
|
||||||
KPrintf("%s/%s" ANSI_COLOR_RESET "\t",
|
ua_print("%s/%s" ANSI_COLOR_RESET "\t",
|
||||||
logLevelNames[level], logCategoryNames[category]);
|
logLevelNames[level], logCategoryNames[category]);
|
||||||
vsnprintf(str, sizeof(str) - 1, msg, args);
|
vsnprintf(str, sizeof(str) - 1, msg, args);
|
||||||
KPrintf(msg, str);
|
ua_print(msg, str);
|
||||||
KPrintf("\n");
|
ua_print("\n");
|
||||||
|
|
||||||
// printf("\n");
|
// printf("\n");
|
||||||
fflush(stdout);
|
fflush(stdout);
|
||||||
|
|
|
@ -28,7 +28,7 @@ int ua_open(void *dev)
|
||||||
|
|
||||||
param->client = UA_Client_new();
|
param->client = UA_Client_new();
|
||||||
|
|
||||||
ua_pr_info("ua: [%s] start ...\n", __func__);
|
ua_notice("ua: [%s] start ...\n", __func__);
|
||||||
|
|
||||||
if (param->client == NULL)
|
if (param->client == NULL)
|
||||||
{
|
{
|
||||||
|
@ -39,11 +39,11 @@ int ua_open(void *dev)
|
||||||
UA_ClientConfig *config = UA_Client_getConfig(param->client);
|
UA_ClientConfig *config = UA_Client_getConfig(param->client);
|
||||||
UA_ClientConfig_setDefault(config);
|
UA_ClientConfig_setDefault(config);
|
||||||
|
|
||||||
ua_pr_info("ua: [%s] %d %s\n", __func__, strlen(param->ua_remote_ip), param->ua_remote_ip);
|
ua_notice("ua: [%s] %d %s\n", __func__, strlen(param->ua_remote_ip), param->ua_remote_ip);
|
||||||
|
|
||||||
UA_StatusCode retval = UA_Client_connect(param->client, param->ua_remote_ip);
|
UA_StatusCode retval = UA_Client_connect(param->client, param->ua_remote_ip);
|
||||||
if(retval != UA_STATUSCODE_GOOD) {
|
if(retval != UA_STATUSCODE_GOOD) {
|
||||||
ua_pr_info("ua: [%s] deleted ret %x!\n", __func__, retval);
|
ua_notice("ua: [%s] deleted ret %x!\n", __func__, retval);
|
||||||
return (int)retval;
|
return (int)retval;
|
||||||
}
|
}
|
||||||
return EOK;
|
return EOK;
|
||||||
|
@ -52,7 +52,6 @@ int ua_open(void *dev)
|
||||||
void ua_close(void *dev)
|
void ua_close(void *dev)
|
||||||
{
|
{
|
||||||
UaParamType *param = (UaParamType *)dev;
|
UaParamType *param = (UaParamType *)dev;
|
||||||
UA_Client_disconnect(param->client);
|
|
||||||
UA_Client_delete(param->client); /* Disconnects the client internally */
|
UA_Client_delete(param->client); /* Disconnects the client internally */
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -43,8 +43,9 @@ typedef struct UaParam
|
||||||
|
|
||||||
#define ua_print //KPrintf
|
#define ua_print //KPrintf
|
||||||
#define ua_trace() //KPrintf("ua: [%s] line %d checked!\n", __func__, __LINE__)
|
#define ua_trace() //KPrintf("ua: [%s] line %d checked!\n", __func__, __LINE__)
|
||||||
#define ua_pr_info KPrintf
|
#define ua_notice KPrintf
|
||||||
#define ua_debug //KPrintf
|
#define ua_debug //KPrintf
|
||||||
|
#define ua_error KPrintf
|
||||||
|
|
||||||
extern const char *opc_server_url;
|
extern const char *opc_server_url;
|
||||||
extern char test_ua_ip[];
|
extern char test_ua_ip[];
|
||||||
|
|
|
@ -42,7 +42,7 @@ static UA_StatusCode nodeIter(UA_NodeId childId, UA_Boolean isInverse, UA_NodeId
|
||||||
}
|
}
|
||||||
|
|
||||||
UA_NodeId* parent = (UA_NodeId*)handle;
|
UA_NodeId* parent = (UA_NodeId*)handle;
|
||||||
ua_pr_info("%d, %d --- %d ---> NodeId %d, %d\n",
|
ua_notice("%d, %d --- %d ---> NodeId %d, %d\n",
|
||||||
parent->namespaceIndex, parent->identifier.numeric,
|
parent->namespaceIndex, parent->identifier.numeric,
|
||||||
referenceTypeId.identifier.numeric, childId.namespaceIndex,
|
referenceTypeId.identifier.numeric, childId.namespaceIndex,
|
||||||
childId.identifier.numeric);
|
childId.identifier.numeric);
|
||||||
|
@ -81,38 +81,38 @@ void ua_print_value(UA_Variant* val)
|
||||||
if(val->type == &UA_TYPES[UA_TYPES_LOCALIZEDTEXT])
|
if(val->type == &UA_TYPES[UA_TYPES_LOCALIZEDTEXT])
|
||||||
{
|
{
|
||||||
UA_LocalizedText* ptr = (UA_LocalizedText*)val->data;
|
UA_LocalizedText* ptr = (UA_LocalizedText*)val->data;
|
||||||
ua_pr_info("%.*s (Text)\n", ptr->text.length, ptr->text.data);
|
ua_notice("%.*s (Text)\n", ptr->text.length, ptr->text.data);
|
||||||
}
|
}
|
||||||
else if(val->type == &UA_TYPES[UA_TYPES_UINT32])
|
else if(val->type == &UA_TYPES[UA_TYPES_UINT32])
|
||||||
{
|
{
|
||||||
UA_UInt32* ptr = (UA_UInt32*)val->data;
|
UA_UInt32* ptr = (UA_UInt32*)val->data;
|
||||||
ua_pr_info("%d (UInt32)\n", *ptr);
|
ua_notice("%d (UInt32)\n", *ptr);
|
||||||
}
|
}
|
||||||
else if(val->type == &UA_TYPES[UA_TYPES_BOOLEAN])
|
else if(val->type == &UA_TYPES[UA_TYPES_BOOLEAN])
|
||||||
{
|
{
|
||||||
UA_Boolean* ptr = (UA_Boolean*)val->data;
|
UA_Boolean* ptr = (UA_Boolean*)val->data;
|
||||||
ua_pr_info("%i (BOOL)\n", *ptr);
|
ua_notice("%i (BOOL)\n", *ptr);
|
||||||
}
|
}
|
||||||
else if(val->type == &UA_TYPES[UA_TYPES_INT32])
|
else if(val->type == &UA_TYPES[UA_TYPES_INT32])
|
||||||
{
|
{
|
||||||
UA_Int32* ptr = (UA_Int32*)val->data;
|
UA_Int32* ptr = (UA_Int32*)val->data;
|
||||||
ua_pr_info("%d (Int32)\n", *ptr);
|
ua_notice("%d (Int32)\n", *ptr);
|
||||||
}
|
}
|
||||||
else if(val->type == &UA_TYPES[UA_TYPES_INT16])
|
else if(val->type == &UA_TYPES[UA_TYPES_INT16])
|
||||||
{
|
{
|
||||||
UA_Int16* ptr = (UA_Int16*)val->data;
|
UA_Int16* ptr = (UA_Int16*)val->data;
|
||||||
ua_pr_info("%d (Int16)\n", *ptr);
|
ua_notice("%d (Int16)\n", *ptr);
|
||||||
}
|
}
|
||||||
else if(val->type == &UA_TYPES[UA_TYPES_STRING])
|
else if(val->type == &UA_TYPES[UA_TYPES_STRING])
|
||||||
{
|
{
|
||||||
UA_String* ptr = (UA_String*)val->data;
|
UA_String* ptr = (UA_String*)val->data;
|
||||||
ua_pr_info("%*.s (String)\n", ptr->length, ptr->data);
|
ua_notice("%*.s (String)\n", ptr->length, ptr->data);
|
||||||
}
|
}
|
||||||
else if(val->type == &UA_TYPES[UA_TYPES_DATETIME])
|
else if(val->type == &UA_TYPES[UA_TYPES_DATETIME])
|
||||||
{
|
{
|
||||||
UA_DateTime* ptr = (UA_DateTime*)val->data;
|
UA_DateTime* ptr = (UA_DateTime*)val->data;
|
||||||
UA_DateTimeStruct dts = UA_DateTime_toStruct(*ptr);
|
UA_DateTimeStruct dts = UA_DateTime_toStruct(*ptr);
|
||||||
ua_pr_info("%d-%d-%d %d:%d:%d.%03d (Time)\n",
|
ua_notice("%d-%d-%d %d:%d:%d.%03d (Time)\n",
|
||||||
dts.day, dts.month, dts.year, dts.hour, dts.min, dts.sec, dts.milliSec);
|
dts.day, dts.month, dts.year, dts.hour, dts.min, dts.sec, dts.milliSec);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -144,14 +144,14 @@ void ua_print_nodeid(UA_NodeId *node_id)
|
||||||
switch(node_id->identifierType)
|
switch(node_id->identifierType)
|
||||||
{
|
{
|
||||||
case UA_NODEIDTYPE_NUMERIC:
|
case UA_NODEIDTYPE_NUMERIC:
|
||||||
ua_pr_info(" NodeID n%d,%d ", node_id->namespaceIndex, node_id->identifier.numeric);
|
ua_notice(" NodeID n%d,%d ", node_id->namespaceIndex, node_id->identifier.numeric);
|
||||||
break;
|
break;
|
||||||
case UA_NODEIDTYPE_STRING:
|
case UA_NODEIDTYPE_STRING:
|
||||||
ua_pr_info(" NodeID n%d,%.*s ", node_id->namespaceIndex, node_id->identifier.string.length,
|
ua_notice(" NodeID n%d,%.*s ", node_id->namespaceIndex, node_id->identifier.string.length,
|
||||||
node_id->identifier.string.data);
|
node_id->identifier.string.data);
|
||||||
break;
|
break;
|
||||||
case UA_NODEIDTYPE_BYTESTRING:
|
case UA_NODEIDTYPE_BYTESTRING:
|
||||||
ua_pr_info(" NodeID n%d,%s ", node_id->namespaceIndex, node_id->identifier.byteString.data);
|
ua_notice(" NodeID n%d,%s ", node_id->namespaceIndex, node_id->identifier.byteString.data);
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
|
@ -160,7 +160,7 @@ void ua_print_nodeid(UA_NodeId *node_id)
|
||||||
|
|
||||||
void ua_print_object(UA_BrowseResponse* res)
|
void ua_print_object(UA_BrowseResponse* res)
|
||||||
{
|
{
|
||||||
ua_pr_info("%-9s %-16s %-16s %-16s\n", "NAMESPACE", "NODEID", "BROWSE NAME", "DISPLAY NAME");
|
ua_notice("%-9s %-16s %-16s %-16s\n", "NAMESPACE", "NODEID", "BROWSE NAME", "DISPLAY NAME");
|
||||||
|
|
||||||
for(size_t i = 0; i < res->resultsSize; ++i)
|
for(size_t i = 0; i < res->resultsSize; ++i)
|
||||||
{
|
{
|
||||||
|
@ -170,14 +170,14 @@ void ua_print_object(UA_BrowseResponse* res)
|
||||||
|
|
||||||
if(ref->nodeId.nodeId.identifierType == UA_NODEIDTYPE_NUMERIC)
|
if(ref->nodeId.nodeId.identifierType == UA_NODEIDTYPE_NUMERIC)
|
||||||
{
|
{
|
||||||
ua_pr_info("%-9d %-16d %-16.*s %-16.*s\n", ref->nodeId.nodeId.namespaceIndex,
|
ua_notice("%-9d %-16d %-16.*s %-16.*s\n", ref->nodeId.nodeId.namespaceIndex,
|
||||||
ref->nodeId.nodeId.identifier.numeric, (int)ref->browseName.name.length,
|
ref->nodeId.nodeId.identifier.numeric, (int)ref->browseName.name.length,
|
||||||
ref->browseName.name.data, (int)ref->displayName.text.length,
|
ref->browseName.name.data, (int)ref->displayName.text.length,
|
||||||
ref->displayName.text.data);
|
ref->displayName.text.data);
|
||||||
}
|
}
|
||||||
else if(ref->nodeId.nodeId.identifierType == UA_NODEIDTYPE_STRING)
|
else if(ref->nodeId.nodeId.identifierType == UA_NODEIDTYPE_STRING)
|
||||||
{
|
{
|
||||||
ua_pr_info("%-9d %-16.*s %-16.*s %-16.*s\n", ref->nodeId.nodeId.namespaceIndex,
|
ua_notice("%-9d %-16.*s %-16.*s %-16.*s\n", ref->nodeId.nodeId.namespaceIndex,
|
||||||
(int)ref->nodeId.nodeId.identifier.string.length,
|
(int)ref->nodeId.nodeId.identifier.string.length,
|
||||||
ref->nodeId.nodeId.identifier.string.data,
|
ref->nodeId.nodeId.identifier.string.data,
|
||||||
(int)ref->browseName.name.length, ref->browseName.name.data,
|
(int)ref->browseName.name.length, ref->browseName.name.data,
|
||||||
|
@ -188,7 +188,7 @@ void ua_print_object(UA_BrowseResponse* res)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
ua_pr_info("\n");
|
ua_notice("\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
UA_StatusCode ua_read_array_value(UA_Client* client, int array_size, UA_ReadValueId* array)
|
UA_StatusCode ua_read_array_value(UA_Client* client, int array_size, UA_ReadValueId* array)
|
||||||
|
@ -203,7 +203,7 @@ UA_StatusCode ua_read_array_value(UA_Client* client, int array_size, UA_ReadValu
|
||||||
|| (response.resultsSize != array_size))
|
|| (response.resultsSize != array_size))
|
||||||
{
|
{
|
||||||
UA_ReadResponse_clear(&response);
|
UA_ReadResponse_clear(&response);
|
||||||
ua_pr_info("ua: [%s] read failed 0x%x\n", __func__,
|
ua_notice("ua: [%s] read failed 0x%x\n", __func__,
|
||||||
response.responseHeader.serviceResult);
|
response.responseHeader.serviceResult);
|
||||||
return UA_STATUSCODE_BADUNEXPECTEDERROR;
|
return UA_STATUSCODE_BADUNEXPECTEDERROR;
|
||||||
}
|
}
|
||||||
|
@ -215,11 +215,11 @@ UA_StatusCode ua_read_array_value(UA_Client* client, int array_size, UA_ReadValu
|
||||||
if((response.results[i].status == UA_STATUSCODE_GOOD)
|
if((response.results[i].status == UA_STATUSCODE_GOOD)
|
||||||
&& (response.results[i].hasValue))
|
&& (response.results[i].hasValue))
|
||||||
{
|
{
|
||||||
ua_pr_info("node %s: ", ua_get_nodeid_str(&array[i].nodeId));
|
ua_notice("node %s: ", ua_get_nodeid_str(&array[i].nodeId));
|
||||||
ua_print_value(&response.results[i].value);
|
ua_print_value(&response.results[i].value);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
ua_pr_info("\n");
|
ua_notice("\n");
|
||||||
|
|
||||||
free(arr_ret);
|
free(arr_ret);
|
||||||
UA_ReadResponse_clear(&response);
|
UA_ReadResponse_clear(&response);
|
||||||
|
@ -229,7 +229,7 @@ UA_StatusCode ua_read_array_value(UA_Client* client, int array_size, UA_ReadValu
|
||||||
void ua_browser_id(UA_Client* client, UA_NodeId id)
|
void ua_browser_id(UA_Client* client, UA_NodeId id)
|
||||||
{
|
{
|
||||||
/* Browse some objects */
|
/* Browse some objects */
|
||||||
ua_pr_info("Browsing nodes in objects folder:\n");
|
ua_notice("Browsing nodes in objects folder:\n");
|
||||||
UA_BrowseRequest bReq;
|
UA_BrowseRequest bReq;
|
||||||
UA_BrowseRequest_init(&bReq);
|
UA_BrowseRequest_init(&bReq);
|
||||||
bReq.requestedMaxReferencesPerNode = 0;
|
bReq.requestedMaxReferencesPerNode = 0;
|
||||||
|
@ -327,7 +327,7 @@ void ua_write_nodeid_value(UA_Client* client, UA_NodeId id, char* value)
|
||||||
|
|
||||||
if(wResp.responseHeader.serviceResult == UA_STATUSCODE_GOOD)
|
if(wResp.responseHeader.serviceResult == UA_STATUSCODE_GOOD)
|
||||||
{
|
{
|
||||||
ua_pr_info("write new value is: %s\n", value);
|
ua_notice("write new value is: %s\n", value);
|
||||||
}
|
}
|
||||||
|
|
||||||
UA_WriteRequest_clear(&wReq);
|
UA_WriteRequest_clear(&wReq);
|
||||||
|
@ -489,7 +489,7 @@ void ua_read_time(UA_Client* client)
|
||||||
{
|
{
|
||||||
UA_DateTime raw_date = *(UA_DateTime*) value.data;
|
UA_DateTime raw_date = *(UA_DateTime*) value.data;
|
||||||
UA_DateTimeStruct dts = UA_DateTime_toStruct(raw_date);
|
UA_DateTimeStruct dts = UA_DateTime_toStruct(raw_date);
|
||||||
ua_pr_info("date is: %d-%d-%d %d:%d:%d.%03d\n",
|
ua_notice("date is: %d-%d-%d %d:%d:%d.%03d\n",
|
||||||
dts.day, dts.month, dts.year, dts.hour, dts.min, dts.sec, dts.milliSec);
|
dts.day, dts.month, dts.year, dts.hour, dts.min, dts.sec, dts.milliSec);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -53,7 +53,7 @@ void ua_test_browser_objects(UA_Client *client)
|
||||||
ua_browser_id(client, UA_TEST_BROWSER_NODEID);
|
ua_browser_id(client, UA_TEST_BROWSER_NODEID);
|
||||||
ua_browser_id(client, UA_TEST_BROWSER_NODEID1);
|
ua_browser_id(client, UA_TEST_BROWSER_NODEID1);
|
||||||
test_id = UA_TEST_BROWSER_NODEID1;
|
test_id = UA_TEST_BROWSER_NODEID1;
|
||||||
ua_pr_info("Show values in %s:\n", ua_get_nodeid_str(&test_id));
|
ua_notice("Show values in %s:\n", ua_get_nodeid_str(&test_id));
|
||||||
ua_test_read_array(client);
|
ua_test_read_array(client);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
@ -64,11 +64,11 @@ void ua_test_write_attr(UA_Client *client)
|
||||||
char val_str[UA_NODE_LEN];
|
char val_str[UA_NODE_LEN];
|
||||||
UA_NodeId id = UA_TEST_WRITE_NODEID;
|
UA_NodeId id = UA_TEST_WRITE_NODEID;
|
||||||
|
|
||||||
ua_pr_info("--- Test write %s ---\n", ua_get_nodeid_str(&id));
|
ua_notice("--- Test write %s ---\n", ua_get_nodeid_str(&id));
|
||||||
ua_read_nodeid_value(client, id, &value);
|
ua_read_nodeid_value(client, id, &value);
|
||||||
ua_write_nodeid_value(client, id, itoa(value + 1, val_str, 10));
|
ua_write_nodeid_value(client, id, itoa(value + 1, val_str, 10));
|
||||||
ua_read_nodeid_value(client, id, &value);
|
ua_read_nodeid_value(client, id, &value);
|
||||||
ua_pr_info("\n");
|
ua_notice("\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
int ua_test_interact_server(UA_Client *client)
|
int ua_test_interact_server(UA_Client *client)
|
||||||
|
|
|
@ -0,0 +1,11 @@
|
||||||
|
|
||||||
|
menuconfig USING_CONTROL_PLC_OPCUA
|
||||||
|
bool "PLC support OPCUA"
|
||||||
|
default y
|
||||||
|
depends on RESOURCES_LWIP
|
||||||
|
|
||||||
|
menuconfig USING_CONTROL_PLC_SOCKET
|
||||||
|
bool "PLC support SOCKET"
|
||||||
|
default y
|
||||||
|
depends on RESOURCES_LWIP
|
||||||
|
|
|
@ -0,0 +1,4 @@
|
||||||
|
SRC_FILES := plc_socket.c
|
||||||
|
|
||||||
|
include $(KERNEL_ROOT)/compiler.mk
|
||||||
|
|
File diff suppressed because it is too large
Load Diff
|
@ -0,0 +1,322 @@
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2022 AIIT XUOS Lab
|
||||||
|
* XiUOS is licensed under Mulan PSL v2.
|
||||||
|
* You can use this software according to the terms and conditions of the Mulan PSL v2.
|
||||||
|
* You may obtain a copy of Mulan PSL v2 at:
|
||||||
|
* http://license.coscl.org.cn/MulanPSL2
|
||||||
|
* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
|
||||||
|
* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
|
||||||
|
* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
|
||||||
|
* See the Mulan PSL v2 for more details.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file plc_socket.c
|
||||||
|
* @brief Demo for PLC socket communication function
|
||||||
|
* @version 1.0
|
||||||
|
* @author AIIT XUOS Lab
|
||||||
|
* @date 2022.03.16
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "transform.h"
|
||||||
|
#include "plc_socket.h"
|
||||||
|
#include "sys_arch.h"
|
||||||
|
#include "lwip/sockets.h"
|
||||||
|
|
||||||
|
#define PLC_SOCK_CMD_NUM 10
|
||||||
|
|
||||||
|
// for saving PLC command
|
||||||
|
int plc_cmd_index = 0;
|
||||||
|
|
||||||
|
//siemens test
|
||||||
|
PlcBinCmdType TestPlcCmd[PLC_SOCK_CMD_NUM] =
|
||||||
|
{
|
||||||
|
#ifdef SUPPORT_PLC_SIEMENS
|
||||||
|
// handshake1 repeat 1
|
||||||
|
{
|
||||||
|
0, 3000, 22,
|
||||||
|
{
|
||||||
|
0x03, 0x00, 0x00, 0x16, 0x11, 0xE0, 0x00, 0x00,
|
||||||
|
0x02, 0xC8, 0x00, 0xC1, 0x02, 0x02, 0x01, 0xC2,
|
||||||
|
0x02, 0x02, 0x01, 0xC0, 0x01, 0x0A
|
||||||
|
}
|
||||||
|
},
|
||||||
|
// handshake2
|
||||||
|
{
|
||||||
|
1, 500, 25,
|
||||||
|
{
|
||||||
|
0x03, 0x00, 0x00, 0x19, 0x02, 0xF0, 0x80, 0x32,
|
||||||
|
0x01, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x08, 0x00,
|
||||||
|
0x00, 0xF0, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00,
|
||||||
|
0xF0
|
||||||
|
}
|
||||||
|
},
|
||||||
|
// read command
|
||||||
|
{
|
||||||
|
2, 1000, 31,
|
||||||
|
{
|
||||||
|
0x03, 0x00, 0x00, 0x1F, 0x02, 0xF0, 0x80, 0x32,
|
||||||
|
0x01, 0x00, 0x00, 0x33, 0x01, 0x00, 0x0E, 0x00,
|
||||||
|
0x00, 0x04, 0x01, 0x12, 0x0A, 0x10, 0x02, 0x00,
|
||||||
|
0xD2, 0x00, 0x34, 0x84, 0x00, 0x00, 0x00
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// oml plc
|
||||||
|
#else// SUPPORT_PLC_OML
|
||||||
|
{
|
||||||
|
0, 1000, 18,
|
||||||
|
{
|
||||||
|
0x80, 0x00, 0x02, 0x00, 0x03, 0x00, 0x00, 0x7E,
|
||||||
|
0x00, 0x00, 0x01, 0x01, 0x82, 0x0F, 0xA0, 0x00,
|
||||||
|
0x00, 0x20
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
};
|
||||||
|
|
||||||
|
//SIEMENS PLC IP: 192.168.250.9 Port: 102
|
||||||
|
//S7-200 192.168.250.8
|
||||||
|
//S7-1200 192.168.250.6
|
||||||
|
//OML 192.168.250.3 port 9600
|
||||||
|
PlcSocketParamType plc_socket_demo_data = {
|
||||||
|
.ip = {192, 168, 250, 3},
|
||||||
|
.port = 9600,
|
||||||
|
.device_type = PLC_DEV_TYPE_OML,
|
||||||
|
.socket_type = SOCK_STREAM, //SOCK_DGRAM, //udp
|
||||||
|
.step = 0,
|
||||||
|
.cmd_num = 3,
|
||||||
|
.buf_size = PLC_TEST_SIZE,
|
||||||
|
.buf = NULL,
|
||||||
|
};
|
||||||
|
|
||||||
|
#define OML_HEADER_LEN 78
|
||||||
|
#define CHECK_OML_HEADER(_s) ((0xC0 == *(_s)) && (0x00 == *(_s + 1)) && (0x02 == *(_s + 2)) && (0x00 == *(_s + 3)))
|
||||||
|
|
||||||
|
/******************************************************************************/
|
||||||
|
|
||||||
|
static void *PlcSocketStart(void *arg)
|
||||||
|
{
|
||||||
|
int fd = -1;
|
||||||
|
int recv_len;
|
||||||
|
int step = 0;
|
||||||
|
char *recv_buf;
|
||||||
|
struct sockaddr_in sock_addr;
|
||||||
|
socklen_t addr_len = sizeof(struct sockaddr_in);
|
||||||
|
PlcSocketParamType *param = (PlcSocketParamType *)&plc_socket_demo_data;
|
||||||
|
|
||||||
|
plc_print("start %d.%d.%d.%d:%d dev %d sock %d\n",
|
||||||
|
param->ip[0],
|
||||||
|
param->ip[1],
|
||||||
|
param->ip[2],
|
||||||
|
param->ip[3],
|
||||||
|
param->port,
|
||||||
|
param->device_type,
|
||||||
|
param->socket_type);
|
||||||
|
|
||||||
|
//malloc memory
|
||||||
|
recv_buf = (char *)malloc(param->buf_size);
|
||||||
|
if (recv_buf == NULL)
|
||||||
|
{
|
||||||
|
plc_error("No memory\n");
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
fd = socket(AF_INET, param->socket_type, 0);
|
||||||
|
if (fd < 0)
|
||||||
|
{
|
||||||
|
plc_error("Socket error %d\n", param->socket_type);
|
||||||
|
free(recv_buf);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
plc_print("start %d.%d.%d.%d:%d\n", param->ip[0], param->ip[1], param->ip[2], param->ip[3], param->port);
|
||||||
|
|
||||||
|
sock_addr.sin_family = AF_INET;
|
||||||
|
sock_addr.sin_port = htons(param->port);
|
||||||
|
sock_addr.sin_addr.s_addr = PP_HTONL(LWIP_MAKEU32(param->ip[0], param->ip[1], param->ip[2], param->ip[3]));
|
||||||
|
memset(&(sock_addr.sin_zero), 0, sizeof(sock_addr.sin_zero));
|
||||||
|
|
||||||
|
if (connect(fd, (struct sockaddr *)&sock_addr, sizeof(struct sockaddr)) < 0)
|
||||||
|
{
|
||||||
|
plc_error("Unable to connect\n");
|
||||||
|
closesocket(fd);
|
||||||
|
free(recv_buf);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
lw_notice("client %s connected\n", inet_ntoa(sock_addr.sin_addr));
|
||||||
|
|
||||||
|
while(step < param->cmd_num)
|
||||||
|
{
|
||||||
|
sendto(fd, TestPlcCmd[step].cmd, TestPlcCmd[step].cmd_len, 0, (struct sockaddr*)&sock_addr, addr_len);
|
||||||
|
lw_notice("Send Cmd: %d - ", TestPlcCmd[step].cmd_len);
|
||||||
|
for(int i = 0; i < TestPlcCmd[step].cmd_len; i++)
|
||||||
|
{
|
||||||
|
lw_notice(" %#x", TestPlcCmd[step].cmd[i]);
|
||||||
|
}
|
||||||
|
lw_notice("\n");
|
||||||
|
MdelayKTask(TestPlcCmd[step].delay_ms);
|
||||||
|
|
||||||
|
memset(recv_buf, 0, param->buf_size);
|
||||||
|
while(1)
|
||||||
|
{
|
||||||
|
recv_len = recvfrom(fd, recv_buf, param->buf_size, 0, (struct sockaddr *)&sock_addr, &addr_len);
|
||||||
|
if(recv_len > 0)
|
||||||
|
{
|
||||||
|
if(param->device_type == PLC_DEV_TYPE_OML)
|
||||||
|
{
|
||||||
|
if((recv_len == OML_HEADER_LEN) && (CHECK_OML_HEADER(recv_buf)))
|
||||||
|
{
|
||||||
|
lw_notice("This is Oml package!!!\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
lw_notice("Receive from : %s\n", inet_ntoa(sock_addr.sin_addr));
|
||||||
|
lw_notice("Receive data : %d -", recv_len);
|
||||||
|
for(int i = 0; i < recv_len; i++)
|
||||||
|
{
|
||||||
|
lw_notice(" %#x", recv_buf[i]);
|
||||||
|
}
|
||||||
|
lw_notice("\n");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
step ++;
|
||||||
|
}
|
||||||
|
|
||||||
|
closesocket(fd);
|
||||||
|
free(recv_buf);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
void PlcGetParamCmd(char *cmd)
|
||||||
|
{
|
||||||
|
const char s[2] = ",";
|
||||||
|
char *token;
|
||||||
|
uint16_t cmd_index = 0;
|
||||||
|
char bin_cmd[PLC_BIN_CMD_LEN] = {0};
|
||||||
|
token = strtok(cmd, s);
|
||||||
|
while(token != NULL)
|
||||||
|
{
|
||||||
|
sscanf(token, "%x", &bin_cmd[cmd_index]);
|
||||||
|
plc_print("%d - %s %d\n", cmd_index, token, bin_cmd[cmd_index]);
|
||||||
|
token = strtok(NULL, s);
|
||||||
|
cmd_index ++;
|
||||||
|
}
|
||||||
|
TestPlcCmd[plc_cmd_index].cmd_len = cmd_index;
|
||||||
|
memcpy(TestPlcCmd[plc_cmd_index].cmd, bin_cmd, cmd_index);
|
||||||
|
plc_print("get %d cmd len %d\n", plc_cmd_index, TestPlcCmd[plc_cmd_index].cmd_len);
|
||||||
|
plc_cmd_index ++;
|
||||||
|
plc_socket_demo_data.cmd_num = plc_cmd_index;
|
||||||
|
}
|
||||||
|
|
||||||
|
void PlcShowUsage(void)
|
||||||
|
{
|
||||||
|
plc_notice("------------------------------------\n");
|
||||||
|
plc_notice("PlcSocket [ip].[ip].[ip].[ip]:[port]\n");
|
||||||
|
plc_notice("PlcSocket support other param:\n");
|
||||||
|
plc_notice("plc=[] 0: OML 1:SIEMENS\n");
|
||||||
|
plc_notice("tcp=[] 0: udp 1:tcp\n");
|
||||||
|
plc_notice("ip=[ip.ip.ip.ip]\n");
|
||||||
|
plc_notice("port=port\n");
|
||||||
|
plc_notice("------------------------------------\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
void PlcCheckParam(int argc, char *argv[])
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
PlcSocketParamType *param = &plc_socket_demo_data;
|
||||||
|
plc_cmd_index = 0;
|
||||||
|
|
||||||
|
for(i = 0; i < argc; i++)
|
||||||
|
{
|
||||||
|
char *str = argv[i];
|
||||||
|
int is_tcp = 0;
|
||||||
|
char cmd_str[PLC_BIN_CMD_LEN] = {0};
|
||||||
|
|
||||||
|
plc_print("check %d %s\n", i, str);
|
||||||
|
|
||||||
|
if(sscanf(str, "ip=%d.%d.%d.%d",
|
||||||
|
¶m->ip[0],
|
||||||
|
¶m->ip[1],
|
||||||
|
¶m->ip[2],
|
||||||
|
¶m->ip[3]) == 4)
|
||||||
|
{
|
||||||
|
plc_print("find ip %d %d %d %d\n", param->ip[0], param->ip[1], param->ip[2], param->ip[3]);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(sscanf(str, "port=%d", ¶m->port) == 1)
|
||||||
|
{
|
||||||
|
plc_print("find port %d\n", param->port);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(sscanf(str, "tcp=%d", &is_tcp) == 1)
|
||||||
|
{
|
||||||
|
plc_print("find tcp %d\n", is_tcp);
|
||||||
|
param->socket_type = is_tcp ? SOCK_STREAM:SOCK_DGRAM;
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(sscanf(str, "plc=%d", ¶m->device_type) == 1)
|
||||||
|
{
|
||||||
|
plc_print("find device %d\n", param->device_type);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(sscanf(str, "cmd=%s", cmd_str) == 1)
|
||||||
|
{
|
||||||
|
plc_print("find cmd %s\n", cmd_str);
|
||||||
|
PlcGetParamCmd(cmd_str);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if(argc >= 2)
|
||||||
|
{
|
||||||
|
if(sscanf(argv[1], "%d.%d.%d.%d:%d",
|
||||||
|
¶m->ip[0],
|
||||||
|
¶m->ip[1],
|
||||||
|
¶m->ip[2],
|
||||||
|
¶m->ip[3],
|
||||||
|
¶m->port) != EOF)
|
||||||
|
{
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(sscanf(argv[1], "%d.%d.%d.%d",
|
||||||
|
¶m->ip[0],
|
||||||
|
¶m->ip[1],
|
||||||
|
¶m->ip[2],
|
||||||
|
¶m->ip[3]) != EOF)
|
||||||
|
{
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
PlcShowUsage();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void PlcSocketTask(int argc, char *argv[])
|
||||||
|
{
|
||||||
|
int result = 0;
|
||||||
|
pthread_t th_id;
|
||||||
|
|
||||||
|
pthread_attr_t attr;
|
||||||
|
attr.schedparam.sched_priority = LWIP_DEMO_TASK_PRIO;
|
||||||
|
attr.stacksize = LWIP_TASK_STACK_SIZE;
|
||||||
|
PlcSocketParamType *param = &plc_socket_demo_data;
|
||||||
|
|
||||||
|
PlcCheckParam(argc, argv);
|
||||||
|
|
||||||
|
lwip_config_net(lwip_ipaddr, lwip_netmask, param->ip);
|
||||||
|
PrivTaskCreate(&th_id, &attr, PlcSocketStart, param);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) | SHELL_CMD_PARAM_NUM(3),
|
||||||
|
PlcSocket, PlcSocketTask, Test PLC Socket);
|
||||||
|
|
|
@ -0,0 +1,67 @@
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2022 AIIT XUOS Lab
|
||||||
|
* XiUOS is licensed under Mulan PSL v2.
|
||||||
|
* You can use this software according to the terms and conditions of the Mulan PSL v2.
|
||||||
|
* You may obtain a copy of Mulan PSL v2 at:
|
||||||
|
* http://license.coscl.org.cn/MulanPSL2
|
||||||
|
* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
|
||||||
|
* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
|
||||||
|
* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
|
||||||
|
* See the Mulan PSL v2 for more details.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file plc_socket.h
|
||||||
|
* @brief Demo for PLC socket communication function
|
||||||
|
* @version 1.0
|
||||||
|
* @author AIIT XUOS Lab
|
||||||
|
* @date 2022.03.16
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __PLC_SOCKET_H_
|
||||||
|
#define __PLC_SOCKET_H_
|
||||||
|
|
||||||
|
#define PLC_BIN_CMD_LEN 512
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
uint8_t step;
|
||||||
|
uint16_t delay_ms;
|
||||||
|
uint8_t cmd_len;
|
||||||
|
uint8_t cmd[PLC_BIN_CMD_LEN];
|
||||||
|
}PlcBinCmdType;
|
||||||
|
|
||||||
|
enum PlcDeviceType {
|
||||||
|
PLC_DEV_TYPE_OML = 0,
|
||||||
|
PLC_DEV_TYPE_IPC,
|
||||||
|
PLC_DEV_TYPE_BRL,
|
||||||
|
PLC_DEV_TYPE_SIEMENS,
|
||||||
|
PLC_DEV_TYPE_SIEMENS_1200,
|
||||||
|
PLC_DEV_TYPE_JF_IPC,
|
||||||
|
PLC_DEV_TYPE_HG,
|
||||||
|
/* ...... */
|
||||||
|
PLC_DEV_TYPE_END,
|
||||||
|
};
|
||||||
|
|
||||||
|
#define PLC_IP_SIZE 16
|
||||||
|
#define PLC_DEV_SIZE 32
|
||||||
|
#define PLC_TEST_SIZE 65536
|
||||||
|
|
||||||
|
typedef struct PlcSocketParamStruct{
|
||||||
|
char ip[PLC_IP_SIZE];
|
||||||
|
uint32_t port;
|
||||||
|
uint32_t device_type; //PlcDeviceType
|
||||||
|
uint32_t socket_type; //UDP or TCP
|
||||||
|
char device[PLC_DEV_SIZE];
|
||||||
|
uint32_t step; // communication step
|
||||||
|
uint32_t cmd_num; // command number
|
||||||
|
uint32_t buf_size;
|
||||||
|
uint8_t *buf;
|
||||||
|
}PlcSocketParamType;
|
||||||
|
|
||||||
|
//debug command
|
||||||
|
#define plc_print //KPrintf
|
||||||
|
#define plc_error KPrintf
|
||||||
|
#define plc_notice KPrintf
|
||||||
|
|
||||||
|
#endif
|
|
@ -297,6 +297,7 @@ static x_err_t _DeleteMsgQueue(struct MsgQueue *mq)
|
||||||
KERNEL_FREE(mq->msg_buf);
|
KERNEL_FREE(mq->msg_buf);
|
||||||
|
|
||||||
lock = CriticalAreaLock();
|
lock = CriticalAreaLock();
|
||||||
|
IdRemoveObj(&k_mq_id_manager, mq->id.id);
|
||||||
DoubleLinkListRmNode(&(mq->link));
|
DoubleLinkListRmNode(&(mq->link));
|
||||||
CriticalAreaUnLock(lock);
|
CriticalAreaUnLock(lock);
|
||||||
KERNEL_FREE(mq);
|
KERNEL_FREE(mq);
|
||||||
|
|
|
@ -246,7 +246,7 @@ netconn_delete(struct netconn *conn)
|
||||||
} else
|
} else
|
||||||
#endif /* LWIP_NETCONN_FULLDUPLEX */
|
#endif /* LWIP_NETCONN_FULLDUPLEX */
|
||||||
{
|
{
|
||||||
// err = netconn_prepare_delete(conn);
|
err = netconn_prepare_delete(conn);
|
||||||
}
|
}
|
||||||
if (err == ERR_OK) {
|
if (err == ERR_OK) {
|
||||||
netconn_free(conn);
|
netconn_free(conn);
|
||||||
|
|
|
@ -74,7 +74,7 @@ a lot of data that needs to be copied, this should be set high. */
|
||||||
#define MEMP_NUM_TCP_PCB_LISTEN 2
|
#define MEMP_NUM_TCP_PCB_LISTEN 2
|
||||||
/* MEMP_NUM_TCP_SEG: the number of simultaneously queued TCP
|
/* MEMP_NUM_TCP_SEG: the number of simultaneously queued TCP
|
||||||
segments. */
|
segments. */
|
||||||
#define MEMP_NUM_TCP_SEG 120
|
#define MEMP_NUM_TCP_SEG 20
|
||||||
/* MEMP_NUM_SYS_TIMEOUT: the number of simulateously active
|
/* MEMP_NUM_SYS_TIMEOUT: the number of simulateously active
|
||||||
timeouts. */
|
timeouts. */
|
||||||
#define MEMP_NUM_SYS_TIMEOUT 6
|
#define MEMP_NUM_SYS_TIMEOUT 6
|
||||||
|
@ -212,26 +212,19 @@ The STM32F4x7 allows computing and verifying the IP, UDP, TCP and ICMP checksums
|
||||||
---------------------------------
|
---------------------------------
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define DEFAULT_RAW_RECVMBOX_SIZE 10
|
#define DEFAULT_RAW_RECVMBOX_SIZE 8
|
||||||
#define DEFAULT_UDP_RECVMBOX_SIZE 10
|
#define DEFAULT_UDP_RECVMBOX_SIZE 8
|
||||||
#define DEFAULT_TCP_RECVMBOX_SIZE 10
|
#define DEFAULT_TCP_RECVMBOX_SIZE 8
|
||||||
#define DEFAULT_ACCEPTMBOX_SIZE 10
|
#define DEFAULT_ACCEPTMBOX_SIZE 8
|
||||||
|
|
||||||
#define DEFAULT_THREAD_PRIO 20
|
#define DEFAULT_THREAD_PRIO 20
|
||||||
#define DEFAULT_THREAD_STACKSIZE 1024
|
#define DEFAULT_THREAD_STACKSIZE 1024
|
||||||
|
|
||||||
#define TCPIP_THREAD_NAME "tcp"
|
#define TCPIP_THREAD_NAME "tcp"
|
||||||
#define TCPIP_THREAD_STACKSIZE 8192
|
#define TCPIP_THREAD_STACKSIZE 8192
|
||||||
#define TCPIP_MBOX_SIZE 10
|
#define TCPIP_MBOX_SIZE 8
|
||||||
#define TCPIP_THREAD_PRIO 15
|
#define TCPIP_THREAD_PRIO 15
|
||||||
|
|
||||||
//#define IPERF_SERVER_THREAD_NAME "iperf_server"
|
|
||||||
//#define IPERF_SERVER_THREAD_STACKSIZE 1024
|
|
||||||
//#define IPERF_SERVER_THREAD_PRIO 0
|
|
||||||
|
|
||||||
//#define BLOCK_TIME 250
|
|
||||||
//#define BLOCK_TIME_WAITING_FOR_INPUT ( ( portTickType ) 100 )
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
----------------------------------------
|
----------------------------------------
|
||||||
---------- Lwip Debug options ----------
|
---------- Lwip Debug options ----------
|
||||||
|
@ -259,7 +252,8 @@ typedef unsigned int nfds_t;
|
||||||
#define lw_print //KPrintf
|
#define lw_print //KPrintf
|
||||||
#define lw_trace() //KPrintf("lw: [%s][%d] passed!\n", __func__, __LINE__)
|
#define lw_trace() //KPrintf("lw: [%s][%d] passed!\n", __func__, __LINE__)
|
||||||
#define lw_error() //KPrintf("lw: [%s][%d] failed!\n", __func__, __LINE__)
|
#define lw_error() //KPrintf("lw: [%s][%d] failed!\n", __func__, __LINE__)
|
||||||
#define lw_pr_info KPrintf
|
#define lw_debug KPrintf
|
||||||
|
#define lw_notice KPrintf
|
||||||
#endif /* __LWIPOPTS_H__ */
|
#endif /* __LWIPOPTS_H__ */
|
||||||
|
|
||||||
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
||||||
|
|
|
@ -513,16 +513,16 @@ void lwip_config_net(char *ip, char *mask, char *gw)
|
||||||
|
|
||||||
if(chk_lwip_bit(LWIP_PRINT_FLAG))
|
if(chk_lwip_bit(LWIP_PRINT_FLAG))
|
||||||
{
|
{
|
||||||
lw_pr_info("\r\n************************************************\r\n");
|
lw_notice("\r\n************************************************\r\n");
|
||||||
lw_pr_info(" Network Configuration\r\n");
|
lw_notice(" Network Configuration\r\n");
|
||||||
lw_pr_info("************************************************\r\n");
|
lw_notice("************************************************\r\n");
|
||||||
lw_pr_info(" IPv4 Address : %u.%u.%u.%u\r\n", ((u8_t *)&net_ipaddr)[0], ((u8_t *)&net_ipaddr)[1],
|
lw_notice(" IPv4 Address : %u.%u.%u.%u\r\n", ((u8_t *)&net_ipaddr)[0], ((u8_t *)&net_ipaddr)[1],
|
||||||
((u8_t *)&net_ipaddr)[2], ((u8_t *)&net_ipaddr)[3]);
|
((u8_t *)&net_ipaddr)[2], ((u8_t *)&net_ipaddr)[3]);
|
||||||
lw_pr_info(" IPv4 Subnet mask : %u.%u.%u.%u\r\n", ((u8_t *)&net_netmask)[0], ((u8_t *)&net_netmask)[1],
|
lw_notice(" IPv4 Subnet mask : %u.%u.%u.%u\r\n", ((u8_t *)&net_netmask)[0], ((u8_t *)&net_netmask)[1],
|
||||||
((u8_t *)&net_netmask)[2], ((u8_t *)&net_netmask)[3]);
|
((u8_t *)&net_netmask)[2], ((u8_t *)&net_netmask)[3]);
|
||||||
lw_pr_info(" IPv4 Gateway : %u.%u.%u.%u\r\n", ((u8_t *)&net_gw)[0], ((u8_t *)&net_gw)[1],
|
lw_notice(" IPv4 Gateway : %u.%u.%u.%u\r\n", ((u8_t *)&net_gw)[0], ((u8_t *)&net_gw)[1],
|
||||||
((u8_t *)&net_gw)[2], ((u8_t *)&net_gw)[3]);
|
((u8_t *)&net_gw)[2], ((u8_t *)&net_gw)[3]);
|
||||||
lw_pr_info("************************************************\r\n");
|
lw_notice("************************************************\r\n");
|
||||||
}
|
}
|
||||||
lwip_config_input(&gnetif);
|
lwip_config_input(&gnetif);
|
||||||
}
|
}
|
||||||
|
|
|
@ -81,18 +81,18 @@ void LwipShowIPTask(int argc, char *argv[])
|
||||||
{
|
{
|
||||||
char mac_addr[] = configMAC_ADDR;
|
char mac_addr[] = configMAC_ADDR;
|
||||||
|
|
||||||
lw_pr_info("\r\n************************************************\r\n");
|
lw_notice("\r\n************************************************\r\n");
|
||||||
lw_pr_info(" Network Configuration\r\n");
|
lw_notice(" Network Configuration\r\n");
|
||||||
lw_pr_info("************************************************\r\n");
|
lw_notice("************************************************\r\n");
|
||||||
lw_pr_info(" IPv4 Address : %u.%u.%u.%u\r\n", ((u8_t *)&lwip_ipaddr)[0], ((u8_t *)&lwip_ipaddr)[1],
|
lw_notice(" IPv4 Address : %u.%u.%u.%u\r\n", ((u8_t *)&lwip_ipaddr)[0], ((u8_t *)&lwip_ipaddr)[1],
|
||||||
((u8_t *)&lwip_ipaddr)[2], ((u8_t *)&lwip_ipaddr)[3]);
|
((u8_t *)&lwip_ipaddr)[2], ((u8_t *)&lwip_ipaddr)[3]);
|
||||||
lw_pr_info(" IPv4 Subnet mask : %u.%u.%u.%u\r\n", ((u8_t *)&lwip_netmask)[0], ((u8_t *)&lwip_netmask)[1],
|
lw_notice(" IPv4 Subnet mask : %u.%u.%u.%u\r\n", ((u8_t *)&lwip_netmask)[0], ((u8_t *)&lwip_netmask)[1],
|
||||||
((u8_t *)&lwip_netmask)[2], ((u8_t *)&lwip_netmask)[3]);
|
((u8_t *)&lwip_netmask)[2], ((u8_t *)&lwip_netmask)[3]);
|
||||||
lw_pr_info(" IPv4 Gateway : %u.%u.%u.%u\r\n", ((u8_t *)&lwip_gwaddr)[0], ((u8_t *)&lwip_gwaddr)[1],
|
lw_notice(" IPv4 Gateway : %u.%u.%u.%u\r\n", ((u8_t *)&lwip_gwaddr)[0], ((u8_t *)&lwip_gwaddr)[1],
|
||||||
((u8_t *)&lwip_gwaddr)[2], ((u8_t *)&lwip_gwaddr)[3]);
|
((u8_t *)&lwip_gwaddr)[2], ((u8_t *)&lwip_gwaddr)[3]);
|
||||||
lw_pr_info(" MAC Address : %x:%x:%x:%x:%x:%x\r\n", mac_addr[0], mac_addr[1], mac_addr[2],
|
lw_notice(" MAC Address : %x:%x:%x:%x:%x:%x\r\n", mac_addr[0], mac_addr[1], mac_addr[2],
|
||||||
mac_addr[3], mac_addr[4], mac_addr[5]);
|
mac_addr[3], mac_addr[4], mac_addr[5]);
|
||||||
lw_pr_info("************************************************\r\n");
|
lw_notice("************************************************\r\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) | SHELL_CMD_PARAM_NUM(0),
|
SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) | SHELL_CMD_PARAM_NUM(0),
|
||||||
|
|
|
@ -61,54 +61,54 @@ int LwipPrintDHCP(struct netif *netif)
|
||||||
{
|
{
|
||||||
dhcp_last_state = dhcp->state;
|
dhcp_last_state = dhcp->state;
|
||||||
|
|
||||||
lw_pr_info(" DHCP state : ");
|
lw_notice(" DHCP state : ");
|
||||||
switch (dhcp_last_state)
|
switch (dhcp_last_state)
|
||||||
{
|
{
|
||||||
case DHCP_STATE_OFF:
|
case DHCP_STATE_OFF:
|
||||||
lw_pr_info("OFF");
|
lw_notice("OFF");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_REQUESTING:
|
case DHCP_STATE_REQUESTING:
|
||||||
lw_pr_info("REQUESTING");
|
lw_notice("REQUESTING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_INIT:
|
case DHCP_STATE_INIT:
|
||||||
lw_pr_info("INIT");
|
lw_notice("INIT");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_REBOOTING:
|
case DHCP_STATE_REBOOTING:
|
||||||
lw_pr_info("REBOOTING");
|
lw_notice("REBOOTING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_REBINDING:
|
case DHCP_STATE_REBINDING:
|
||||||
lw_pr_info("REBINDING");
|
lw_notice("REBINDING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_RENEWING:
|
case DHCP_STATE_RENEWING:
|
||||||
lw_pr_info("RENEWING");
|
lw_notice("RENEWING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_SELECTING:
|
case DHCP_STATE_SELECTING:
|
||||||
lw_pr_info("SELECTING");
|
lw_notice("SELECTING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_INFORMING:
|
case DHCP_STATE_INFORMING:
|
||||||
lw_pr_info("INFORMING");
|
lw_notice("INFORMING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_CHECKING:
|
case DHCP_STATE_CHECKING:
|
||||||
lw_pr_info("CHECKING");
|
lw_notice("CHECKING");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_BOUND:
|
case DHCP_STATE_BOUND:
|
||||||
lw_pr_info("BOUND");
|
lw_notice("BOUND");
|
||||||
break;
|
break;
|
||||||
case DHCP_STATE_BACKING_OFF:
|
case DHCP_STATE_BACKING_OFF:
|
||||||
lw_pr_info("BACKING_OFF");
|
lw_notice("BACKING_OFF");
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
lw_pr_info("%u", dhcp_last_state);
|
lw_notice("%u", dhcp_last_state);
|
||||||
assert(0);
|
assert(0);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
lw_pr_info("\r\n");
|
lw_notice("\r\n");
|
||||||
|
|
||||||
if (dhcp_last_state == DHCP_STATE_BOUND)
|
if (dhcp_last_state == DHCP_STATE_BOUND)
|
||||||
{
|
{
|
||||||
lw_pr_info("\r\n IPv4 Address : %s\r\n", ipaddr_ntoa(&netif->ip_addr));
|
lw_notice("\r\n IPv4 Address : %s\r\n", ipaddr_ntoa(&netif->ip_addr));
|
||||||
lw_pr_info(" IPv4 Subnet mask : %s\r\n", ipaddr_ntoa(&netif->netmask));
|
lw_notice(" IPv4 Subnet mask : %s\r\n", ipaddr_ntoa(&netif->netmask));
|
||||||
lw_pr_info(" IPv4 Gateway : %s\r\n\r\n", ipaddr_ntoa(&netif->gw));
|
lw_notice(" IPv4 Gateway : %s\r\n\r\n", ipaddr_ntoa(&netif->gw));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
|
@ -60,7 +60,7 @@ void LwipPingTest(int argc, char *argv[])
|
||||||
{
|
{
|
||||||
if(sscanf(argv[1], "%d.%d.%d.%d", &lwip_gwaddr[0], &lwip_gwaddr[1], &lwip_gwaddr[2], &lwip_gwaddr[3]) == EOF)
|
if(sscanf(argv[1], "%d.%d.%d.%d", &lwip_gwaddr[0], &lwip_gwaddr[1], &lwip_gwaddr[2], &lwip_gwaddr[3]) == EOF)
|
||||||
{
|
{
|
||||||
lw_pr_info("input wrong ip\n");
|
lw_notice("input wrong ip\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
|
@ -27,52 +27,61 @@
|
||||||
|
|
||||||
#define MSG_SIZE 128
|
#define MSG_SIZE 128
|
||||||
|
|
||||||
|
typedef struct LwipTcpSocketStruct
|
||||||
|
{
|
||||||
|
char ip[6];
|
||||||
|
uint16_t port;
|
||||||
|
char *buf; // test buffer
|
||||||
|
}LwipTcpSocketParamType;
|
||||||
|
|
||||||
// this is for test in shell, in fact, shell restrict the length of input string, which is less then 128
|
// this is for test in shell, in fact, shell restrict the length of input string, which is less then 128
|
||||||
char tcp_send_msg[MSG_SIZE] = {0};
|
char tcp_send_msg[MSG_SIZE] = {0};
|
||||||
char tcp_target[] = {192, 168, 250, 252};
|
char tcp_target[] = {192, 168, 250, 252};
|
||||||
|
uint16_t tcp_port = LWIP_TARGET_PORT;
|
||||||
|
|
||||||
/******************************************************************************/
|
/******************************************************************************/
|
||||||
|
|
||||||
static void LwipTcpSendTask(void *arg)
|
static void LwipTcpSendTask(void *arg)
|
||||||
{
|
{
|
||||||
lw_print("LwipTcpSendTask start.\n");
|
lw_notice("LwipTcpSendTask start.\n");
|
||||||
|
|
||||||
int fd = -1;
|
int fd = -1;
|
||||||
fd = socket(AF_INET, SOCK_STREAM, 0);
|
fd = socket(AF_INET, SOCK_STREAM, 0);
|
||||||
if (fd < 0)
|
if (fd < 0)
|
||||||
{
|
{
|
||||||
lw_print("Socket error\n");
|
lw_notice("Socket error\n");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
LwipTcpSocketParamType *param = (LwipTcpSocketParamType *)arg;
|
||||||
|
|
||||||
struct sockaddr_in tcp_sock;
|
struct sockaddr_in tcp_sock;
|
||||||
tcp_sock.sin_family = AF_INET;
|
tcp_sock.sin_family = AF_INET;
|
||||||
tcp_sock.sin_port = htons(LWIP_TARGET_PORT);
|
tcp_sock.sin_port = htons(param->port);
|
||||||
tcp_sock.sin_addr.s_addr = PP_HTONL(LWIP_MAKEU32(tcp_target[0], tcp_target[1], tcp_target[2], tcp_target[3]));
|
tcp_sock.sin_addr.s_addr = PP_HTONL(LWIP_MAKEU32(param->ip[0], param->ip[1], param->ip[2], param->ip[3]));
|
||||||
memset(&(tcp_sock.sin_zero), 0, sizeof(tcp_sock.sin_zero));
|
memset(&(tcp_sock.sin_zero), 0, sizeof(tcp_sock.sin_zero));
|
||||||
|
|
||||||
if (connect(fd, (struct sockaddr *)&tcp_sock, sizeof(struct sockaddr)))
|
if (connect(fd, (struct sockaddr *)&tcp_sock, sizeof(struct sockaddr)))
|
||||||
{
|
{
|
||||||
lw_print("Unable to connect\n");
|
lw_notice("Unable to connect\n");
|
||||||
goto __exit;
|
closesocket(fd);
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
lw_print("tcp connect success, start to send.\n");
|
lw_notice("tcp connect success, start to send.\n");
|
||||||
lw_print("\n\nTarget Port:%d\n\n", tcp_sock.sin_port);
|
lw_notice("\n\nTarget Port:%d\n\n", tcp_sock.sin_port);
|
||||||
|
|
||||||
sendto(fd, tcp_send_msg, strlen(tcp_send_msg), 0, (struct sockaddr*)&tcp_sock, sizeof(struct sockaddr));
|
sendto(fd, tcp_send_msg, strlen(tcp_send_msg), 0, (struct sockaddr*)&tcp_sock, sizeof(struct sockaddr));
|
||||||
|
|
||||||
lw_print("Send tcp msg: %s ", tcp_send_msg);
|
lw_notice("Send tcp msg: %s ", tcp_send_msg);
|
||||||
|
|
||||||
__exit:
|
|
||||||
if (fd >= 0)
|
|
||||||
closesocket(fd);
|
closesocket(fd);
|
||||||
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
void LwipTcpSendTest(int argc, char *argv[])
|
void LwipTcpSendTest(int argc, char *argv[])
|
||||||
{
|
{
|
||||||
|
LwipTcpSocketParamType param;
|
||||||
memset(tcp_send_msg, 0, MSG_SIZE);
|
memset(tcp_send_msg, 0, MSG_SIZE);
|
||||||
if(argc >= 2)
|
if(argc >= 2)
|
||||||
{
|
{
|
||||||
|
@ -85,12 +94,21 @@ void LwipTcpSendTest(int argc, char *argv[])
|
||||||
strcat(tcp_send_msg, "\r\n");
|
strcat(tcp_send_msg, "\r\n");
|
||||||
|
|
||||||
if(argc >= 3)
|
if(argc >= 3)
|
||||||
|
{
|
||||||
|
if(sscanf(argv[2], "%d.%d.%d.%d:%d", &tcp_target[0], &tcp_target[1], &tcp_target[2], &tcp_target[3], &tcp_port) == EOK)
|
||||||
{
|
{
|
||||||
sscanf(argv[2], "%d.%d.%d.%d", &tcp_target[0], &tcp_target[1], &tcp_target[2], &tcp_target[3]);
|
sscanf(argv[2], "%d.%d.%d.%d", &tcp_target[0], &tcp_target[1], &tcp_target[2], &tcp_target[3]);
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
lw_notice("get ipaddr %d.%d.%d.%d:%d\n", tcp_target[0], tcp_target[1], tcp_target[2], tcp_target[3], tcp_port);
|
||||||
|
lwip_config_tcp(lwip_ipaddr, lwip_netmask, tcp_target);
|
||||||
|
|
||||||
lwip_config_tcp(lwip_ipaddr, lwip_netmask, lwip_gwaddr);
|
memcpy(param.ip, tcp_target, 4);
|
||||||
sys_thread_new("tcp send", LwipTcpSendTask, NULL, LWIP_TASK_STACK_SIZE, LWIP_DEMO_TASK_PRIO);
|
param.port = tcp_port;
|
||||||
|
param.buf = malloc(MSG_SIZE);
|
||||||
|
memcpy(param.buf, tcp_send_msg, MSG_SIZE);
|
||||||
|
|
||||||
|
sys_thread_new("tcp send", LwipTcpSendTask, ¶m, LWIP_TASK_STACK_SIZE, LWIP_DEMO_TASK_PRIO);
|
||||||
}
|
}
|
||||||
|
|
||||||
SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) | SHELL_CMD_PARAM_NUM(3),
|
SHELL_EXPORT_CMD(SHELL_CMD_PERMISSION(0) | SHELL_CMD_TYPE(SHELL_TYPE_CMD_MAIN) | SHELL_CMD_PARAM_NUM(3),
|
||||||
|
|
|
@ -30,7 +30,8 @@
|
||||||
#define PBUF_SIZE 27
|
#define PBUF_SIZE 27
|
||||||
|
|
||||||
static struct udp_pcb *udpecho_raw_pcb;
|
static struct udp_pcb *udpecho_raw_pcb;
|
||||||
char udp_target[] = {192, 168, 250, 252};
|
char udp_demo_ip[] = {192, 168, 250, 252};
|
||||||
|
uint16_t udp_demo_port = LWIP_TARGET_PORT;
|
||||||
char hello_str[] = {"hello world\r\n"};
|
char hello_str[] = {"hello world\r\n"};
|
||||||
char udp_send_msg[] = "\n\nThis one is UDP pkg. Congratulations on you.\n\n";
|
char udp_send_msg[] = "\n\nThis one is UDP pkg. Congratulations on you.\n\n";
|
||||||
|
|
||||||
|
@ -52,28 +53,23 @@ static void LwipUDPSendTask(void *arg)
|
||||||
|
|
||||||
struct sockaddr_in udp_sock;
|
struct sockaddr_in udp_sock;
|
||||||
udp_sock.sin_family = AF_INET;
|
udp_sock.sin_family = AF_INET;
|
||||||
udp_sock.sin_port = htons(LWIP_TARGET_PORT);
|
udp_sock.sin_port = htons(udp_demo_port);
|
||||||
udp_sock.sin_addr.s_addr = PP_HTONL(LWIP_MAKEU32(udp_target[0],udp_target[1],udp_target[2],udp_target[3]));
|
udp_sock.sin_addr.s_addr = PP_HTONL(LWIP_MAKEU32(udp_demo_ip[0], udp_demo_ip[1], udp_demo_ip[2], udp_demo_ip[3]));
|
||||||
memset(&(udp_sock.sin_zero), 0, sizeof(udp_sock.sin_zero));
|
memset(&(udp_sock.sin_zero), 0, sizeof(udp_sock.sin_zero));
|
||||||
|
|
||||||
if (connect(socket_fd, (struct sockaddr *)&udp_sock, sizeof(struct sockaddr)))
|
if (connect(socket_fd, (struct sockaddr *)&udp_sock, sizeof(struct sockaddr)))
|
||||||
{
|
{
|
||||||
lw_print("Unable to connect\n");
|
lw_print("Unable to connect\n");
|
||||||
goto __exit;
|
closesocket(socket_fd);
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
lw_print("UDP connect success, start to send.\n");
|
lw_print("UDP connect success, start to send.\n");
|
||||||
lw_print("\n\nTarget Port:%d\n\n", udp_sock.sin_port);
|
lw_print("\n\nTarget Port:%d\n\n", udp_sock.sin_port);
|
||||||
|
|
||||||
sendto(socket_fd, udp_send_msg, strlen(udp_send_msg), 0, (struct sockaddr*)&udp_sock, sizeof(struct sockaddr));
|
sendto(socket_fd, udp_send_msg, strlen(udp_send_msg), 0, (struct sockaddr*)&udp_sock, sizeof(struct sockaddr));
|
||||||
lw_pr_info("Send UDP msg: %s ", udp_send_msg);
|
lw_notice("Send UDP msg: %s ", udp_send_msg);
|
||||||
|
|
||||||
__exit:
|
|
||||||
if (socket_fd >= 0)
|
|
||||||
{
|
|
||||||
closesocket(socket_fd);
|
closesocket(socket_fd);
|
||||||
}
|
|
||||||
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -86,7 +82,7 @@ void *LwipUdpSendTest(int argc, char *argv[])
|
||||||
|
|
||||||
if(argc == 1)
|
if(argc == 1)
|
||||||
{
|
{
|
||||||
lw_print("lw: [%s] gw %d.%d.%d.%d\n", __func__, udp_target[0], udp_target[1], udp_target[2], udp_target[3]);
|
lw_print("lw: [%s] gw %d.%d.%d.%d\n", __func__, udp_demo_ip[0], udp_demo_ip[1], udp_demo_ip[2], udp_demo_ip[3]);
|
||||||
strncpy(udp_send_msg, hello_str, strlen(hello_str));
|
strncpy(udp_send_msg, hello_str, strlen(hello_str));
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
|
@ -95,12 +91,12 @@ void *LwipUdpSendTest(int argc, char *argv[])
|
||||||
strncat(udp_send_msg, "\r\n", 2);
|
strncat(udp_send_msg, "\r\n", 2);
|
||||||
if(argc == 3)
|
if(argc == 3)
|
||||||
{
|
{
|
||||||
sscanf(argv[2], "%d.%d.%d.%d", &udp_target[0], &udp_target[1], &udp_target[2], &udp_target[3]);
|
sscanf(argv[2], "%d.%d.%d.%d", &udp_demo_ip[0], &udp_demo_ip[1], &udp_demo_ip[2], &udp_demo_ip[3]);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
lw_print("lw: [%s] gw %d.%d.%d.%d\n", __func__, udp_target[0], udp_target[1], udp_target[2], udp_target[3]);
|
lw_print("lw: [%s] gw %d.%d.%d.%d\n", __func__, udp_demo_ip[0], udp_demo_ip[1], udp_demo_ip[2], udp_demo_ip[3]);
|
||||||
|
|
||||||
lwip_config_tcp(lwip_ipaddr, lwip_netmask, lwip_gwaddr);
|
lwip_config_net(lwip_ipaddr, lwip_netmask, lwip_gwaddr);
|
||||||
sys_thread_new("udp socket send", LwipUDPSendTask, NULL, LWIP_TASK_STACK_SIZE, LWIP_DEMO_TASK_PRIO);
|
sys_thread_new("udp socket send", LwipUDPSendTask, NULL, LWIP_TASK_STACK_SIZE, LWIP_DEMO_TASK_PRIO);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -121,11 +117,11 @@ static void LwipUdpRecvTask(void *arg, struct udp_pcb *upcb, struct pbuf *p,
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
udp_len = p->tot_len;
|
udp_len = p->tot_len;
|
||||||
lw_pr_info("Receive data :%dB\r\n", udp_len);
|
lw_notice("Receive data :%dB\r\n", udp_len);
|
||||||
|
|
||||||
if(udp_len <= 80)
|
if(udp_len <= 80)
|
||||||
{
|
{
|
||||||
lw_pr_info("%.*s\r\n", udp_len, (char *)(p->payload));
|
lw_notice("%.*s\r\n", udp_len, (char *)(p->payload));
|
||||||
}
|
}
|
||||||
|
|
||||||
udp_buf = pbuf_alloc(PBUF_TRANSPORT, PBUF_SIZE, PBUF_RAM);
|
udp_buf = pbuf_alloc(PBUF_TRANSPORT, PBUF_SIZE, PBUF_RAM);
|
||||||
|
|
|
@ -492,7 +492,7 @@ int get_url_ip(char* url)
|
||||||
/* convert URL to IP */
|
/* convert URL to IP */
|
||||||
if (lwip_getaddrinfo(url, NULL, &hint, &res) != 0)
|
if (lwip_getaddrinfo(url, NULL, &hint, &res) != 0)
|
||||||
{
|
{
|
||||||
lw_pr_info("ping: unknown host %s\n", url);
|
lw_notice("ping: unknown host %s\n", url);
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
memcpy(&h, &res->ai_addr, sizeof(struct sockaddr_in *));
|
memcpy(&h, &res->ai_addr, sizeof(struct sockaddr_in *));
|
||||||
|
@ -500,13 +500,13 @@ int get_url_ip(char* url)
|
||||||
lwip_freeaddrinfo(res);
|
lwip_freeaddrinfo(res);
|
||||||
if (inet_aton(inet_ntoa(ina), &target_addr) == 0)
|
if (inet_aton(inet_ntoa(ina), &target_addr) == 0)
|
||||||
{
|
{
|
||||||
lw_pr_info("ping: unknown host %s\n", url);
|
lw_notice("ping: unknown host %s\n", url);
|
||||||
return -2;
|
return -2;
|
||||||
}
|
}
|
||||||
/* new a socket */
|
/* new a socket */
|
||||||
if ((s = lwip_socket(AF_INET, SOCK_RAW, IP_PROTO_ICMP)) < 0)
|
if ((s = lwip_socket(AF_INET, SOCK_RAW, IP_PROTO_ICMP)) < 0)
|
||||||
{
|
{
|
||||||
lw_pr_info("ping: create socket failed\n");
|
lw_notice("ping: create socket failed\n");
|
||||||
return -3;
|
return -3;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -521,12 +521,12 @@ int get_url_ip(char* url)
|
||||||
#endif /* LWIP_DEBUG */
|
#endif /* LWIP_DEBUG */
|
||||||
if ((recv_len = lwip_ping_recv(s, &ttl)) >= 0)
|
if ((recv_len = lwip_ping_recv(s, &ttl)) >= 0)
|
||||||
{
|
{
|
||||||
lw_pr_info("%d bytes from %s icmp_seq=%d ttl=%d time=%d ms\n", recv_len, inet_ntoa(ina), cnt,
|
lw_notice("%d bytes from %s icmp_seq=%d ttl=%d time=%d ms\n", recv_len, inet_ntoa(ina), cnt,
|
||||||
ttl, sys_now() - ping_time);
|
ttl, sys_now() - ping_time);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
lw_pr_info("From %s icmp_seq=%d timeout\n", inet_ntoa(ina), cnt);
|
lw_notice("From %s icmp_seq=%d timeout\n", inet_ntoa(ina), cnt);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -159,9 +159,9 @@ tcpecho_raw_ack(struct tcp_pcb *tpcb, struct tcpecho_raw_state* es){
|
||||||
if((recv_len != TCP_MSS) || (recv_buf[recv_len - 1] == TCP_EOF_CH))
|
if((recv_len != TCP_MSS) || (recv_buf[recv_len - 1] == TCP_EOF_CH))
|
||||||
{
|
{
|
||||||
if(g_buf_size < MAX_TCP_SHOW_SIZE){
|
if(g_buf_size < MAX_TCP_SHOW_SIZE){
|
||||||
lw_pr_info("Received: %s\n", g_buf);
|
lw_notice("Received: %s\n", g_buf);
|
||||||
}else{
|
}else{
|
||||||
lw_pr_info("Received a string of length %d\n", g_buf_size);
|
lw_notice("Received a string of length %d\n", g_buf_size);
|
||||||
}
|
}
|
||||||
|
|
||||||
tcpecho_raw_ack_size(tpcb, g_buf_size);
|
tcpecho_raw_ack_size(tpcb, g_buf_size);
|
||||||
|
|
Loading…
Reference in New Issue