open_esplibs libnet80211: source code for sdk_wifi_softap_start paths.
The function sdk_wifi_softap_start is one of two paths that allocates a struct netif and also accesses the netif->hwaddr so is needed for lwip development. This function depends on static data and functions so a good bit so other code was needed.
This commit is contained in:
Our Air Quality
parent
0dadda86de
commit
1166b44ef7
1 changed files with 308 additions and 0 deletions
|
|
@ -7,4 +7,312 @@
|
|||
#if OPEN_LIBNET80211_HOSTAP
|
||||
// The contents of this file are only built if OPEN_LIBNET80211_HOSTAP is set to true
|
||||
|
||||
#include <string.h>
|
||||
#include "tcpip.h"
|
||||
#include "espressif/esp_wifi.h"
|
||||
#include "espressif/esp_misc.h"
|
||||
#include "etstimer.h"
|
||||
#include "esplibs/libmain.h"
|
||||
#include "esplibs/libnet80211.h"
|
||||
#include "esplibs/libpp.h"
|
||||
#include "esplibs/libwpa.h"
|
||||
|
||||
static uint8_t hostap_flags = 0;
|
||||
static ETSTimer hostap_timer;
|
||||
static struct esf_buf *hostap_timer_parg = NULL;
|
||||
|
||||
void IRAM *zalloc(size_t nbytes);
|
||||
|
||||
static void IRAM hostap_timer_func(struct esf_buf *esf_buf) {
|
||||
struct sdk_netif_conninfo *conninfo = sdk_g_ic.v.softap_netif_info->conninfo[0];
|
||||
int32_t mode = sdk_wifi_get_phy_mode();
|
||||
*(uint16_t *)(esf_buf->frame + 22) = (conninfo->_unknown9c - 1) << 4;
|
||||
uint8_t *ptr1 = esf_buf->frame + (mode == 1 ? 23 : 27);
|
||||
|
||||
conninfo->_unknown9c += 1;
|
||||
|
||||
uint8_t *ptr2 = ptr1 + sdk_g_ic.s._unknown288;
|
||||
|
||||
if (sdk_g_ic.s.wifi_led_enable) {
|
||||
uint32_t gpio = sdk_g_ic.s.wifi_led_gpio;
|
||||
uint32_t state = sdk_g_ic.s.wifi_led_state;
|
||||
sdk_gpio_output_set(state << gpio, (((state & 1) == 0) ? 1 : 0) << gpio,
|
||||
1 << gpio, 0);
|
||||
sdk_g_ic.s.wifi_led_state = (state & 1) ? 0 : 1;
|
||||
}
|
||||
|
||||
memcpy(ptr2 + 24 + 5, &sdk_g_ic.v._unknown1d2, 1);
|
||||
|
||||
uint32_t v1 = ptr2[24 + 2];
|
||||
if (v1 == 0)
|
||||
v1 = ptr2[24 + 3];
|
||||
|
||||
ptr2[24 + 2] = v1 - 1;
|
||||
uint32_t v2 = sdk_ieee80211_chan2ieee(sdk_g_ic.v._unknown14c);
|
||||
ptr2[23] = v2;
|
||||
sdk_g_ic.s._unknown30d = v2;
|
||||
|
||||
int32_t v3 = *((volatile int32_t *)0x3ff20c00); // mactime
|
||||
*(uint32_t *)(esf_buf->extra + 16) = v3;
|
||||
*(uint32_t *)(esf_buf->frame + 24) = v3;
|
||||
*(uint32_t *)(esf_buf->frame + 28) = 0;
|
||||
|
||||
if (sdk_chm_check_same_channel()) {
|
||||
hostap_flags |= 1;
|
||||
sdk_ppTxPkt(esf_buf);
|
||||
} else {
|
||||
sdk_ets_timer_disarm(&hostap_timer);
|
||||
sdk_ets_timer_arm(&hostap_timer, sdk_wDev_Get_Next_TBTT(), 0);
|
||||
}
|
||||
}
|
||||
|
||||
static void IRAM hostap_tx_callback() {
|
||||
uint32_t flags = hostap_flags & 0xfe;
|
||||
|
||||
if (sdk_TmpSTAAPCloseAP == 0) {
|
||||
hostap_flags = flags;
|
||||
sdk_ets_timer_disarm(&hostap_timer);
|
||||
sdk_ets_timer_arm(&hostap_timer, sdk_wDev_Get_Next_TBTT(), 0);
|
||||
return;
|
||||
}
|
||||
|
||||
sdk_PendFreeBcnEb = 1;
|
||||
|
||||
if ((flags & 2) != 0) {
|
||||
hostap_flags = flags & 0xfd;
|
||||
sdk_wifi_softap_start();
|
||||
return;
|
||||
}
|
||||
|
||||
hostap_flags = flags;
|
||||
}
|
||||
|
||||
static void hostap_attach_misc() {
|
||||
struct sdk_g_ic_netif_info *netif_info = sdk_g_ic.v.softap_netif_info;
|
||||
|
||||
struct _unknown_softap1 *ptr1 = zalloc(28); // 0x1c
|
||||
netif_info->_unknownb4 = ptr1;
|
||||
|
||||
struct _unknown_softap2 *ptr2 = zalloc(204); // 0xcc
|
||||
ptr1->_unknown04 = ptr2;
|
||||
|
||||
struct _unknown_wpa1 *ptr3 = zalloc(76); // 0x4c
|
||||
|
||||
uint32_t v1 = sdk_g_ic.s._unknown30e;
|
||||
if (v1 == 2) {
|
||||
ptr3->_unknown00 = 1;
|
||||
v1 = sdk_g_ic.s._unknown30e;
|
||||
}
|
||||
if (v1 == 3) {
|
||||
ptr3->_unknown00 = 2;
|
||||
v1 = sdk_g_ic.s._unknown30e;
|
||||
}
|
||||
if (v1 == 4) {
|
||||
ptr3->_unknown00 = 3;
|
||||
}
|
||||
|
||||
ptr3->_unknown28 = 2;
|
||||
ptr3->_unknown04 = 2;
|
||||
ptr3->_unknown0c = 2;
|
||||
ptr3->_unknown08 = 10;
|
||||
ptr3->_unknown20 = 10;
|
||||
|
||||
int s1 = (sdk_g_ic.s._unknown28a << 16) | sdk_g_ic.s._unknown288;
|
||||
memcpy(&ptr2->_unknown10, &sdk_g_ic.s._unknown28c, s1);
|
||||
ptr2->_unknown30 = s1;
|
||||
|
||||
uint8_t *ptr4 = zalloc(64); // 0x40
|
||||
ptr2->_unknown3c = ptr4;
|
||||
|
||||
char *str1 = sdk_g_ic.s._unknown2ac;
|
||||
memcpy(ptr4, str1, strlen(str1));
|
||||
|
||||
struct sdk_netif_conninfo *conninfo = netif_info->conninfo[0];
|
||||
|
||||
ptr2->_unknownb4 = 300;
|
||||
|
||||
netif_info->_unknown4c = 3;
|
||||
netif_info->_unknown48 |= 16;
|
||||
|
||||
conninfo->_unknown08 |= 1;
|
||||
|
||||
sdk_hostapd_setup_wpa_psk(ptr2);
|
||||
|
||||
struct netif *netif = netif_info->netif;
|
||||
|
||||
ptr1->_unknown18 = sdk_wpa_init(&netif->hwaddr, ptr3, 0);
|
||||
|
||||
free(ptr3);
|
||||
}
|
||||
|
||||
static void softap_stop_free() {
|
||||
struct sdk_g_ic_netif_info *netif_info = sdk_g_ic.v.softap_netif_info;
|
||||
netif_info->_unknown4c = 0;
|
||||
netif_info->_unknown48 &= 0xffffffef;
|
||||
netif_info->conninfo[0]->_unknown08 = 0;
|
||||
|
||||
struct _unknown_softap1 *unkb4 = netif_info->_unknownb4;
|
||||
if (!unkb4) return;
|
||||
|
||||
uint32_t *unk18 = unkb4->_unknown18;
|
||||
if (unk18) {
|
||||
uint32_t *ptr1 = ((uint32_t **)unk18)[20];
|
||||
if (ptr1)
|
||||
free(ptr1);
|
||||
|
||||
uint32_t *ptr2 = *(uint32_t **)unk18;
|
||||
if (ptr2)
|
||||
free(ptr2);
|
||||
|
||||
free(unk18);
|
||||
}
|
||||
|
||||
struct _unknown_softap2 *unk04 = unkb4->_unknown04;
|
||||
if (unk04) {
|
||||
uint32_t *unk38 = unk04->_unknown38;
|
||||
if (unk38)
|
||||
free(unk38);
|
||||
|
||||
uint8_t *unk3c = unk04->_unknown3c;
|
||||
if (unk3c)
|
||||
free(unk3c);
|
||||
|
||||
free(unk04);
|
||||
}
|
||||
|
||||
free(unkb4);
|
||||
netif_info->_unknownb4 = NULL;
|
||||
}
|
||||
|
||||
void sdk_ieee80211_hostap_attach(struct sdk_g_ic_st *ic) {
|
||||
uint32_t scratch[12]; // ??
|
||||
struct sdk_g_ic_netif_info *netif_info = ic->v.softap_netif_info;
|
||||
|
||||
uint32_t v1 = ic->s._unknown30e;
|
||||
if (v1 >= 2 && v1 < 5)
|
||||
hostap_attach_misc();
|
||||
|
||||
struct netif *netif = netif_info->netif;
|
||||
sdk_ic_bss_info_update(1, &netif->hwaddr, 2, 100);
|
||||
|
||||
ic->v._unknown1d0 = 0;
|
||||
netif_info->_unknown3c = 5;
|
||||
|
||||
sdk_ppRegisterTxCallback(hostap_tx_callback, 4);
|
||||
|
||||
hostap_timer_parg = sdk_ieee80211_beacon_alloc(netif_info, scratch);
|
||||
sdk_ets_timer_disarm(&hostap_timer);
|
||||
sdk_ets_timer_setfn(&hostap_timer, (ETSTimerFunc *)hostap_timer_func, hostap_timer_parg);
|
||||
sdk_wDev_Reset_TBTT();
|
||||
sdk_ets_timer_arm(&hostap_timer, sdk_wDev_Get_Next_TBTT(), 0);
|
||||
}
|
||||
|
||||
bool sdk_wifi_softap_start() {
|
||||
struct sdk_g_ic_netif_info *netif_info = sdk_g_ic.v.softap_netif_info;
|
||||
if (!netif_info) return 0;
|
||||
if (netif_info->started) return 1;
|
||||
|
||||
uint8_t flags = hostap_flags;
|
||||
if (flags & 1) {
|
||||
hostap_flags = flags | 2;
|
||||
return 1;
|
||||
}
|
||||
|
||||
uint8_t (*mac_addr)[6] = &sdk_info.softap_mac_addr;
|
||||
if (!netif_info->netif) {
|
||||
struct netif *netif = (struct netif *)malloc(sizeof(struct netif));
|
||||
netif_info->netif = netif;
|
||||
memcpy(&netif->hwaddr, mac_addr, 6);
|
||||
netif_add(netif, &sdk_info.softap_ipaddr, &sdk_info.softap_netmask,
|
||||
&sdk_info.softap_gw, netif_info, ethernetif_init, tcpip_input);
|
||||
}
|
||||
|
||||
sdk_ic_set_vif(1, 1, mac_addr, 1, 0);
|
||||
|
||||
netif_set_up(netif_info->netif);
|
||||
|
||||
if (sdk_wifi_get_opmode() != 3 ||
|
||||
!sdk_g_ic.v.station_netif_info ||
|
||||
sdk_g_ic.v.station_netif_info->_unknown3c < 2) {
|
||||
|
||||
uint32_t i1 = (sdk_g_ic.s._unknown30d - 1) & 0xff;
|
||||
|
||||
int nmi_on = sdk_NMIIrqIsOn;
|
||||
if (!nmi_on) {
|
||||
vPortEnterCritical();
|
||||
|
||||
do {
|
||||
DPORT.DPORT0 = DPORT.DPORT0 & 0xffffffe0;
|
||||
} while (DPORT.DPORT0 & 1);
|
||||
}
|
||||
|
||||
// current channel?
|
||||
uint32_t *chan = &sdk_g_ic.v._unknown84[i1 * 3];
|
||||
sdk_g_ic.v._unknown14c = chan;
|
||||
|
||||
if (!nmi_on) {
|
||||
DPORT.DPORT0 = (DPORT.DPORT0 & 0xffffffe0) | 1;
|
||||
vPortExitCritical();
|
||||
}
|
||||
|
||||
sdk_chm_set_current_channel(chan);
|
||||
}
|
||||
|
||||
sdk_ieee80211_hostap_attach(&sdk_g_ic);
|
||||
sdk_TmpSTAAPCloseAP = 0;
|
||||
netif_info->started = 1;
|
||||
return 1;
|
||||
}
|
||||
|
||||
bool sdk_wifi_softap_stop() {
|
||||
struct sdk_g_ic_netif_info *netif_info = sdk_g_ic.v.softap_netif_info;
|
||||
|
||||
if (!netif_info)
|
||||
return 0;
|
||||
|
||||
if (!netif_info->started)
|
||||
return 1;
|
||||
|
||||
|
||||
uint32_t end = sdk_g_ic.s._unknown310 + 2;
|
||||
uint32_t count = 1;
|
||||
|
||||
// Note this defensive test seems dead code, the value is loaded
|
||||
// as a uint8_t value so adding 2 ensures this test always passes.
|
||||
if (end >= 2) {
|
||||
do {
|
||||
struct sdk_netif_conninfo *conninfo = netif_info->conninfo[count];
|
||||
if (conninfo) {
|
||||
struct sdk_netif_conninfo *conninfo2 = netif_info->_unknown88;
|
||||
netif_info->_unknown88 = conninfo;
|
||||
|
||||
sdk_ieee80211_send_mgmt(netif_info, 160, 4);
|
||||
sdk_ieee80211_send_mgmt(netif_info, 192, 2);
|
||||
|
||||
netif_info->_unknown88 = conninfo2;
|
||||
|
||||
sdk_cnx_node_leave(netif_info, netif_info->conninfo[count]);
|
||||
|
||||
// Number of entries might have changed, perhaps
|
||||
// should have if one was removed above?
|
||||
end = sdk_g_ic.s._unknown310 + 2;
|
||||
}
|
||||
count++;
|
||||
} while (count < end);
|
||||
}
|
||||
|
||||
netif_set_down(netif_info->netif);
|
||||
sdk_TmpSTAAPCloseAP = 1;
|
||||
sdk_ets_timer_disarm(&hostap_timer);
|
||||
sdk_ic_bss_info_update(1, &sdk_info.softap_mac_addr, 2, 0);
|
||||
sdk_ic_set_vif(1, 0, NULL, 1, 0);
|
||||
softap_stop_free();
|
||||
|
||||
if ((hostap_flags & 1) == 0)
|
||||
sdk_esf_buf_recycle(hostap_timer_parg, 4);
|
||||
|
||||
netif_info->started = 0;
|
||||
return 1;
|
||||
}
|
||||
|
||||
#endif /* OPEN_LIBNET80211_HOSTAP */
|
||||
|
|
|
|||
Loading…
Reference in a new issue