ESP32 Forum

Code: Select all

static void
local_lan_socket(void *arg)
{
	//LWIP_UNUSED_ARG(arg);
	ESP_LOGI(TAG, ":::::::::arg: %04X", (uint32_t)arg);
#ifdef IPV6_LL
	struct sockaddr_in6 dest_addr_ll;
	bzero(&dest_addr_ll.sin6_addr.un, sizeof(dest_addr_ll.sin6_addr.un));
	dest_addr_ll.sin6_family = AF_INET6;
	dest_addr_ll.sin6_port = htons(PORT);
	struct sockaddr_in6 source_addr_ll; // Large enough for both IPv4 or IPv6
#else
	struct sockaddr_in dest_addr_ll;
	dest_addr_ll.sin_addr.s_addr = htonl(INADDR_ANY);
	dest_addr_ll.sin_family = AF_INET;
	dest_addr_ll.sin_port = htons(PORT);
	struct sockaddr_in source_addr_ll;
#endif

	uint addr_len_ll = sizeof(source_addr_ll);
	static fd_set fd_ll;
	struct timeval tv_ll;

	while(1){
		if(ERR_OK != LL_task(initialise_ll)){
			ESP_LOGE(TAG, "LL_task ERR!");
			vTaskDelay(1000 / portTICK_PERIOD_MS);
			continue;
		}
#ifdef IPV6_LL
		if(0 > (ptr_s_var_ll->s_conn_ll.listen_sock_ll = lwip_socket(AF_INET6, SOCK_STREAM, IPPROTO_IPV6))){
#else
		if(0 > (ptr_s_var_ll->s_conn_ll.listen_sock_ll = lwip_socket(AF_INET, SOCK_STREAM, IPPROTO_IP))){
#endif
			LL_task(deinitialise_ll);
			ESP_LOGE(TAG, "Unable to create socket: errno %d", errno);
			vTaskDelay(1000 / portTICK_PERIOD_MS);
			continue;
		}
		if(0 != (ptr_s_var_ll->s_conn_ll.err_ll = lwip_bind(ptr_s_var_ll->s_conn_ll.listen_sock_ll, (struct sockaddr *)&dest_addr_ll, sizeof(dest_addr_ll)))){
			LL_task(deinitialise_ll);
			lwip_close(ptr_s_var_ll->s_conn_ll.listen_sock_ll);
			ESP_LOGE(TAG, "Socket unable to bind: errno %d", errno);
			vTaskDelay(3000 / portTICK_PERIOD_MS);
			continue;
		}
		if(0 != (ptr_s_var_ll->s_conn_ll.err_ll = lwip_listen(ptr_s_var_ll->s_conn_ll.listen_sock_ll, 1))){
			LL_task(deinitialise_ll);
			lwip_close(ptr_s_var_ll->s_conn_ll.listen_sock_ll);
			ESP_LOGE(TAG, "Error occurred during listen: errno %d", errno);
			vTaskDelay(3000 / portTICK_PERIOD_MS);
			continue;
		}
		while(1){
			vTaskDelay(3000 / portTICK_PERIOD_MS);

			if(0 > (ptr_s_var_ll->s_conn_ll.sock_ll = lwip_accept(ptr_s_var_ll->s_conn_ll.listen_sock_ll, (struct sockaddr *)&source_addr_ll, &addr_len_ll))){
				lwip_close(ptr_s_var_ll->s_conn_ll.listen_sock_ll);
				ESP_LOGE(TAG, "Unable to accept connection LL: errno %d", errno);
				vTaskDelay(3000 / portTICK_PERIOD_MS);
				continue;
			}

			do{
				FD_ZERO(&fd_ll);
				FD_SET(ptr_s_var_ll->s_conn_ll.sock_ll, &fd_ll);
				tv_ll.tv_sec = 15;
				lwip_setsockopt(ptr_s_var_ll->s_conn_ll.sock_ll, SOL_SOCKET, SO_RCVTIMEO, (struct timeval *)&tv_ll, sizeof(struct timeval));
				ptr_s_var_ll->s_conn_ll.len_ll = lwip_recv(ptr_s_var_ll->s_conn_ll.sock_ll, ptr_s_var_ll->s_proc_ll.ptr_buff_ll, BUFF_SIZE_LL - 1, 0);
				if(0 > ptr_s_var_ll->s_conn_ll.len_ll){
					lwip_close(ptr_s_var_ll->s_conn_ll.sock_ll);
					ESP_LOGW(TAG, "Recv timeout [errno %d]", errno);
					break;
				}
				else if(0 == ptr_s_var_ll->s_conn_ll.len_ll){
					lwip_close(ptr_s_var_ll->s_conn_ll.sock_ll);
					ESP_LOGI(TAG, "Other side closed connection");
					break;
				}
				if(ERR_OK != (ptr_s_var_ll->s_conn_ll.err_ll = Process_LL(ptr_s_var_ll->s_proc_ll.ptr_buff_ll))){
					lwip_close(ptr_s_var_ll->s_conn_ll.sock_ll);
					ESP_LOGI(TAG, "Error ProcesLL: %d", ptr_s_var_ll->s_conn_ll.err_ll);
					break;
				}
				FD_ZERO(&fd_ll);
				FD_SET(ptr_s_var_ll->s_conn_ll.sock_ll, &fd_ll);
				tv_ll.tv_sec = 3;
				lwip_setsockopt(ptr_s_var_ll->s_conn_ll.sock_ll, SOL_SOCKET, SO_SNDTIMEO,(struct timeval *)&tv_ll,sizeof(struct timeval));
				if(0 > lwip_send(ptr_s_var_ll->s_conn_ll.sock_ll, ptr_s_var_ll->s_proc_ll.ptr_buff_ll, ptr_s_var_ll->s_conn_ll.len_ll, 0)){
					lwip_close(ptr_s_var_ll->s_conn_ll.sock_ll);
					ESP_LOGE(TAG, "Send timeout [errno %d]", errno);
					break;
				}
			}while(1);
		}
		vTaskDelay(3000 / portTICK_PERIOD_MS);
	}
	vTaskDelete(NULL);
}


static err_t LL_task(e_init_ll init_ll)
{
	err_t err_init = ERR_OK;	
	if(deinitialise_ll == init_ll)
	{		
		lwip_close(ptr_s_var_ll->s_conn_ll.listen_sock_ll);
		sys_delay_ms(1000);		
		lwip_close(ptr_s_var_ll->s_conn_ll.sock_ll);
		sys_delay_ms(1000);
		if(NULL != ptr_s_var_ll)
		{
			free(ptr_s_var_ll);		
		}		
		return err_init;
	}
	if(NULL == (ptr_s_var_ll = (s_variable_ll *)malloc(sizeof(s_variable_ll))))
	{
																			
		return ERR_MEM;
	}	
	return err_init;
}


void
InitSockLL(void *arg)
{
	xTaskCreate(local_lan_socket, "local_lan_socket", 5*1024 + BUFF_SIZE_LL, arg, 5, &ll_Handle);
}

Code: Select all

int pass;
setsockopt(listen_sock, SOL_SOCKET, SO_REUSEADDR, &pass, sizeof(pass));