support plc socket and optimize LWIP test demo cases

This commit is contained in:
wlyu 2022-03-16 18:34:55 +08:00
parent 68e5436aae
commit e5d124231c
26 changed files with 2442 additions and 158 deletions

View File

@ -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: closesocket(fd);
if (fd >= 0)
closesocket(fd);
return; return;
} }

View File

@ -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);
} }

View File

@ -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;
} }
} }

View File

@ -2,5 +2,9 @@
menuconfig USING_CONTROL_PLC_OPCUA menuconfig USING_CONTROL_PLC_OPCUA
bool "PLC support OPCUA" bool "PLC support 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

View File

@ -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

View File

@ -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);

View File

@ -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 */
} }

View File

@ -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[];

View File

@ -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);
} }

View File

@ -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)

View File

@ -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

View File

@ -0,0 +1,4 @@
SRC_FILES := plc_socket.c
include $(KERNEL_ROOT)/compiler.mk

File diff suppressed because it is too large Load Diff

View File

@ -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",
&param->ip[0],
&param->ip[1],
&param->ip[2],
&param->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", &param->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", &param->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",
&param->ip[0],
&param->ip[1],
&param->ip[2],
&param->ip[3],
&param->port) != EOF)
{
return;
}
if(sscanf(argv[1], "%d.%d.%d.%d",
&param->ip[0],
&param->ip[1],
&param->ip[2],
&param->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);

View File

@ -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

View File

@ -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);

View File

@ -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);

View File

@ -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****/

View 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);
} }

View File

@ -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),

View File

@ -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;
} }
} }

View File

@ -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;
} }
} }

View File

@ -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)
{ {
@ -86,11 +95,20 @@ void LwipTcpSendTest(int argc, char *argv[])
if(argc >= 3) if(argc >= 3)
{ {
sscanf(argv[2], "%d.%d.%d.%d", &tcp_target[0], &tcp_target[1], &tcp_target[2], &tcp_target[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]);
}
} }
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, &param, 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),

View File

@ -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);
closesocket(socket_fd);
__exit:
if (socket_fd >= 0)
{
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);

View File

@ -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);
} }
} }

View File

@ -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);