ESP32 Forum

Code: Select all

static void oneshot_timer_callback2(void* arg){
	ESP_ERROR_CHECK(esp_timer_delete(oneshot_timer2));
	oneshot_timer2 = NULL;
	ESP_LOGI("TIMER", "timer2 timeout");
	s_retry_num = MAXIMUM_RETRY;
	ESP_ERROR_CHECK(wifi_stop());
   // need to wait until UART TX FIFO is empty:
	ESP_LOGI("CALLBACKTMR", "enter sleep mode");
	uart_wait_tx_idle_polling(0);	//UART_PLM);
 	msgFlags.sleep = 1;
	gpio_set_level(LED_G, LED_ON);
	esp_sleep_enable_timer_wakeup(180*1000000);
    /* Get timestamp before entering sleep */
    int64_t t_before_us = esp_timer_get_time();

    esp_err_t err = esp_light_sleep_start();

	if (err == ESP_ERR_INVALID_STATE) {
		ESP_LOGI("CALLBACKTMR", "ESP_ERR_INVALID_STATE");
	}
    /* Get timestamp after waking up from sleep */
    int64_t t_after_us = esp_timer_get_time();
	gpio_set_level(LED_G, LED_OFF);
	ESP_LOGI("CALLBACKTMR", "wake up");
	ESP_LOGI("CALLBACKTMR", "Returned from light sleep, t=%lld ms, slept for %lld ms\n",
            t_after_us / 1000, (t_after_us - t_before_us) / 1000);
	wifi_init_sta();
}

static void event_handler(void* arg, esp_event_base_t event_base, int32_t event_id, void* event_data){
    if (event_base == WIFI_EVENT && event_id == WIFI_EVENT_STA_START) {
        ESP_LOGI("event_handler", "Event - wifi_connect");
        esp_err_t err = esp_wifi_connect();
        ESP_LOGI("event_handler", "wifi connect result %i", err);
    }
    else if (event_base == WIFI_EVENT && event_id == WIFI_EVENT_STA_DISCONNECTED) {
        if (s_retry_num < MAXIMUM_RETRY) {
        	gpio_set_level(LED_Y, LED_ON);
            esp_wifi_connect();
            s_retry_num++;
            ESP_LOGI(TAG, "retry to connect to the AP");
        }
        else {
        	gpio_set_level(LED_Y, LED_OFF);
            xEventGroupSetBits(s_wifi_event_group, WIFI_FAIL_BIT);
        }
        ESP_LOGI(TAG,"connect to the AP fail");
    }
    else if (event_base == IP_EVENT && event_id == IP_EVENT_STA_GOT_IP) {
        ip_event_got_ip_t* event = (ip_event_got_ip_t*) event_data;
        ESP_LOGI(TAG, "got ip:" IPSTR, IP2STR(&event->ip_info.ip));
        s_retry_num = 0;
    	gpio_set_level(LED_Y, LED_ON);
        xEventGroupSetBits(s_wifi_event_group, WIFI_CONNECTED_BIT);
    }
}

esp_err_t wifi_stop(void){
	ESP_ERROR_CHECK(esp_event_handler_unregister(WIFI_EVENT, ESP_EVENT_ANY_ID, &event_handler));
	ESP_ERROR_CHECK(esp_event_handler_unregister(IP_EVENT, IP_EVENT_STA_GOT_IP, &event_handler));
	vEventGroupDelete(s_wifi_event_group);
    esp_err_t err = esp_wifi_stop();
    if (err == ESP_ERR_WIFI_NOT_INIT) {
        return ESP_ERR_WIFI_NOT_INIT;
    }
    ESP_ERROR_CHECK(esp_wifi_deinit());
    ESP_ERROR_CHECK(esp_wifi_clear_default_wifi_driver_and_handlers(sta_netif));
    esp_netif_destroy(sta_netif);
	sta_netif = NULL;

	ESP_LOGI("STOP", "Disconnected from %s", WIFI_SSID);
	gpio_set_level(LED_Y, LED_OFF);
    esp_event_loop_delete_default();
	return ESP_OK;
}

void wifi_init_sta(){
	s_retry_num = 0;
	s_wifi_event_group = xEventGroupCreate();
	esp_base_mac_addr_set(wifi_mac_addr);
    ESP_ERROR_CHECK(esp_netif_init());
    ESP_ERROR_CHECK(esp_event_loop_create_default());
    sta_netif = esp_netif_create_default_wifi_sta();
	assert(sta_netif);
	wifi_init_config_t cfg = WIFI_INIT_CONFIG_DEFAULT();
    ESP_ERROR_CHECK(esp_wifi_init(&cfg));
    esp_event_handler_instance_t instance_any_id;
    esp_event_handler_instance_t instance_got_ip;
    ESP_ERROR_CHECK(esp_event_handler_instance_register(WIFI_EVENT, ESP_EVENT_ANY_ID, &event_handler, NULL, &instance_any_id));
    ESP_ERROR_CHECK(esp_event_handler_instance_register(IP_EVENT, IP_EVENT_STA_GOT_IP, &event_handler, NULL, &instance_got_ip));
    wifi_config_t wifi_config = {
        .sta = {
            .ssid = WIFI_SSID,
            .password = WIFI_PASS,
			.threshold.authmode = WIFI_AUTH_WPA2_PSK,
			.channel = 11,
            .pmf_cfg = {
                .capable = true,
                .required = false
            },
        },
    };
    ESP_ERROR_CHECK(esp_wifi_set_mode(WIFI_MODE_STA) );
    ESP_ERROR_CHECK(esp_wifi_set_config(ESP_IF_WIFI_STA, &wifi_config) );
    ESP_ERROR_CHECK(esp_wifi_start() );

    ESP_LOGI(TAG, "wifi_init_sta finished.");
    EventBits_t bits = xEventGroupWaitBits(s_wifi_event_group, WIFI_CONNECTED_BIT | WIFI_FAIL_BIT, pdFALSE, pdFALSE, portMAX_DELAY);

    if (bits & WIFI_CONNECTED_BIT) {
        ESP_LOGI(TAG, "connected to ap SSID:%s password:%s", WIFI_SSID, WIFI_PASS);
		xTaskCreate(udp_server_task, "udp_server", 4096, (void*)AF_INET, 5, NULL);
		msgFlags.wifiConnected = 1;
    	gpio_set_level(LED_Y, LED_ON);
    }
    else if (bits & WIFI_FAIL_BIT) {
        ESP_LOGI(TAG, "Failed to connect to SSID:%s, password:%s", WIFI_SSID, WIFI_PASS);
        msgFlags.wifiConnected = 0;
    	gpio_set_level(LED_Y, LED_OFF);
    }
    else {
        ESP_LOGE(TAG, "UNEXPECTED EVENT");
    }
}