udpserver.c 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374
  1. #include <rtthread.h>
  2. #include <lwip/sockets.h>
  3. void udpserv(void* paramemter)
  4. {
  5. int sock;
  6. int bytes_read;
  7. char *recv_data;
  8. rt_uint32_t addr_len;
  9. struct sockaddr_in server_addr , client_addr;
  10. recv_data = rt_malloc(1024);
  11. if (recv_data == RT_NULL)
  12. {
  13. rt_kprintf("No memory\n");
  14. return;
  15. }
  16. /* create socket */
  17. if ((sock = socket(AF_INET, SOCK_DGRAM, 0)) == -1)
  18. {
  19. rt_kprintf("Socket error\n");
  20. /* release recv buffer */
  21. rt_free(recv_data);
  22. return;
  23. }
  24. /* init server socket address */
  25. server_addr.sin_family = AF_INET;
  26. server_addr.sin_port = htons(5000);
  27. server_addr.sin_addr.s_addr = INADDR_ANY;
  28. rt_memset(&(server_addr.sin_zero),0, sizeof(server_addr.sin_zero));
  29. if (bind(sock,(struct sockaddr *)&server_addr,
  30. sizeof(struct sockaddr)) == -1)
  31. {
  32. rt_kprintf("Bind error\n");
  33. /* release recv buffer */
  34. rt_free(recv_data);
  35. return;
  36. }
  37. addr_len = sizeof(struct sockaddr);
  38. rt_kprintf("UDPServer Waiting for client on port 5000...\n");
  39. while (1)
  40. {
  41. bytes_read = recvfrom(sock, recv_data, 1024, 0,
  42. (struct sockaddr *)&client_addr, &addr_len);
  43. recv_data[bytes_read] = '\0';
  44. rt_kprintf("\n(%s , %d) said : ",inet_ntoa(client_addr.sin_addr),
  45. ntohs(client_addr.sin_port));
  46. rt_kprintf("%s", recv_data);
  47. if (strcmp(recv_data, "exit") == 0)
  48. {
  49. lwip_close(sock);
  50. /* release recv buffer */
  51. rt_free(recv_data);
  52. break;
  53. }
  54. }
  55. return;
  56. }
  57. #ifdef RT_USING_FINSH
  58. #include <finsh.h>
  59. FINSH_FUNCTION_EXPORT(udpserv, startup udp server);
  60. #endif