ESP32 Forum

Code: Select all

/**
 * Copyright (c) 2018, xiaojixun <jason@rdyheath.com>
 * ESP32
 * esp_wifi_80211_tx.
 */
#include <stdlib.h>
#include <string.h>
#include "freertos/FreeRTOS.h"
#include "esp_wifi.h"
#include "esp_wifi_types.h"
#include "esp_system.h"
#include "esp_event.h"
#include "esp_event_loop.h"
#include "nvs_flash.h"
#include "driver/gpio.h"
#include "lwip/err.h"
#include "esp_log.h"

#define USERDATASTZE 961
#define PACK_NUM_PER_FRAME 120

//rates:
/*
0 - B 1Mb CCK
1 - B 2Mb CCK
2 - B 5.5Mb CCK
3 - B 11Mb CCK
4 - XXX Not working. Should be B 1Mb CCK SP
5 - B 2Mb CCK SP
6 - B 5.5Mb CCK SP
7 - B 11Mb CCK SP

8 - G 48Mb ODFM
9 - G 24Mb ODFM
10 - G 12Mb ODFM
11 - G 6Mb ODFM
12 - G 54Mb ODFM
13 - G 36Mb ODFM
14 - G 18Mb ODFM
15 - G 9Mb ODFM

16 - N 6.5Mb MCS0
17 - N 13Mb MCS1
18 - N 19.5Mb MCS2
19 - N 26Mb MCS3
20 - N 39Mb MCS4
21 - N 52Mb MCS5
22 - N 58Mb MCS6
23 - N 65Mb MCS7

24 - N 7.2Mb MCS0 SP
25 - N 14.4Mb MCS1 SP
26 - N 21.7Mb MCS2 SP
27 - N 28.9Mb MCS3 SP
28 - N 43.3Mb MCS4 SP
29 - N 57.8Mb MCS5 SP
30 - N 65Mb MCS6 SP
31 - N 72Mb MCS7 SP
*/
#define RATE_MCS4_SP 28
typedef union {
     uint8_t fix_rate;
     uint8_t b5;
     uint8_t b4;
 
     struct {
         uint8_t b3;
         uint8_t b2;
     } b1;
 
     struct {
         uint32_t a1;
         uint8_t  a2;
         uint8_t  a3;
         uint8_t  a4;
         uint8_t  a5;
         struct {
             uint8_t a6;
             uint8_t a7;
         } a8[4];
         uint8_t a9;
         uint8_t a10;
         uint8_t a11;
         uint8_t a12;
     } a13;
 
 } wifi_internal_rate_t;


uint8_t packetH[32+USERDATASTZE]={
0x80, 0x00, //Frame Control 
0x00, 0x00, //Duration
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, //Receiver Address= Destination Address 
0x30, 0xAE, 0xA4, 0x05, 0x17, 0x64, //Transmitter Address= Source Address
0x01, 0x02, 0x03, 0x04, 0x05, 0x06, //BSSID
0x00, 0x00,                         //Sequence control
0x01, 0x02, 0x02, 0x03,0x03,0x03,0x04,0x04, //Body
};


extern	esp_err_t esp_wifi_80211_tx(wifi_interface_t ifx, const void *buffer, int len, bool en_sys_seq);  
extern	esp_err_t esp_wifi_internal_set_rate(int a, int b, int c, wifi_internal_rate_t *d);


static esp_err_t event_handler(void *ctx, system_event_t *event);




static void wifi_init(void)
{
	nvs_flash_init();
    tcpip_adapter_init();
    ESP_ERROR_CHECK( esp_event_loop_init(event_handler, NULL) );
    wifi_init_config_t cfg = WIFI_INIT_CONFIG_DEFAULT();
	ESP_ERROR_CHECK( esp_wifi_init(&cfg) );
	//ESP_ERROR_CHECK( esp_wifi_set_country(&wifi_country) ); /* set country for channel range [1, 13] */
	ESP_ERROR_CHECK( esp_wifi_set_storage(WIFI_STORAGE_RAM) );
    ESP_ERROR_CHECK( esp_wifi_set_mode(WIFI_MODE_NULL) );
    ESP_ERROR_CHECK( esp_wifi_start() );
	wifi_internal_rate_t rate;  
	rate.fix_rate = RATE_MCS4_SP;
	esp_wifi_internal_set_rate(100, 1, 4, &rate);
}


void app_main(void)
{
	//esp_log_level_set("*", ESP_LOG_NONE);
	static unsigned int fail_count=0;
	struct timeval time_start;
	struct timeval time_end;
	struct timeval result_time;
	static uint8_t data[USERDATASTZE];
	/* setup */
	wifi_init();
	while(true)
	{
		gettimeofday(&time_start,NULL);
		for(uint8_t i=0;i<PACK_NUM_PER_FRAME;i++)
		{
			data[0]=i;
			memcpy(packetH+32,data,sizeof(data));
			int result = esp_wifi_80211_tx(WIFI_MODE_STA, packetH, sizeof(packetH), true);
	
			switch (result) 
			{
			/*
				case ERR_OK:
					//Serial.println("ERR_OK"); 
					printf("ESPOK\n");
					break;
			*/
				case ERR_MEM:
					//Serial.println("ERR_MEM"); 
					printf("ERR_MEM\n");
					fail_count++;
					break;
				case ERR_IF:
					printf("ERR_IF\n");
					break;
				case ERR_ARG: 
					printf("ERR_ARG\n");
					break;
				//default:
			//		printf("result=%d",result);
			}
		
		}
		
		gettimeofday(&time_end,NULL);
		//caculat the time of sending 115200 bytes(921kbits)
		timersub(&time_end, &time_start, &result_time);
		printf("result_time usec is %ld\n",result_time.tv_usec);
	}
}

esp_err_t
event_handler(void *ctx, system_event_t *event)
{
	return ESP_OK;
}