Skip to content

WD : Add WD_GetVendorSpecificIE, Add WD_GetSecurity & Fix WD_GetRadioLevel. #249

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Open
abdelali221 wants to merge 5 commits into
base: master
Choose a base branch
from
Open

WD : Add WD_GetVendorSpecificIE, Add WD_GetSecurity & Fix WD_GetRadioLevel. #249

Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
5 commits
Select commit Hold shift + click to select a range
599861d
Check description.
abdelali221 Jan 24, 2026
bbdf2c1
Add WD_GetSecurity and related functions.
abdelali221 Jan 25, 2026
1c19c89
Use one function for both WPA and RSN IEs.
abdelali221 Jan 26, 2026
6c7fb6e
Get the thing to compile correctly.
abdelali221 Jan 26, 2026
ffc9f74
Finalize WD_GetPCSList & WD_GetRSN_WPAEssentials
abdelali221 Jan 26, 2026
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
59 changes: 57 additions & 2 deletions gc/ogc/wd.h
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -58,15 +58,28 @@ enum WDIOCTLV
IOCTLV_WD_RECV_NOTIFICATION = 0x8001 // WD_ReceiveNotification
};

// Error Codes :

#define WD_SUCCESS 0
#define WD_UINITIALIZED -1
#define WD_INVALIDBUFF -2
#define WD_BUFFTOOSMALL -3
#define WD_NOTFOUND -4

// Capability flags :

#define CAPAB_SECURED_FLAG 0x10

// Information Elements IDs :

#define IEID_SSID 0x0
#define IEID_COUNTRY 0x7
#define IEID_SECURITY_RSN 0x30
#define IEID_VENDORSPECIFIC 0xDD
#define IEID_SECURITY 0x30

// OUI (Organization Unified ID) :

#define OUI_WPA 0x0050F201

// Signal Strength :

Expand Down Expand Up @@ -148,6 +161,36 @@ typedef struct IE_hdr
u8 len;
} IE_hdr;

// Security :

#define WPA_OFFSET 4
#define RSN_OFFSET 0

enum WD_SECURITY
{
WD_OPEN = 0x00,
WD_WEP = 0x01,
WD_WPA_TKIP = 0x02,
WD_WPA2_AES = 0x04,
WD_WPA_AES = 0x08,
WD_WPA2_TKIP = 0x10,
};

typedef struct IE_RSN_WPA
{
u16 Version;

u32 GDCS; // Group Data Cipher Suite

u16 PCS_Count; // Pairwise Cipher Suite

u16 AKMS_Count; // AKM Suite

u16 RSN_Capab;

u16 PMKID_Count;
} IE_RSN_WPA;

// General Purpose :

s32 NCD_LockWirelessDriver();
Expand All @@ -161,9 +204,21 @@ int WD_GetInfo(WDInfo* inf);
u8 WD_GetRadioLevel(BSSDescriptor* Bss);
int WD_Scan(ScanParameters *settings, u8* buff, u16 buffsize);
int WD_ScanOnce(ScanParameters *settings, u8* buff, u16 buffsize);
void WD_SetDefaultScanParameters(ScanParameters* set);

// IE related :

u8 WD_GetNumberOfIEs(BSSDescriptor* Bss);
int WD_GetIELength(BSSDescriptor* Bss, u8 ID);
int WD_GetIE(BSSDescriptor* Bss, u8 ID, u8* buff, u8 buffsize);
void WD_SetDefaultScanParameters(ScanParameters* set);
int WD_GetIEIDList(BSSDescriptor* Bss, u8* buff, u8 buffsize);
int WD_GetVendorSpecificIELength(BSSDescriptor* Bss, u32 OUI);
int WD_GetVendorSpecificIE(BSSDescriptor* Bss, u32 OUI, u8* buff, u8 buffsize);

// AP Security related :

int WD_GetPCSList(BSSDescriptor *Bss, u8* buff, u8 buffsize, u8 offset);
int WD_GetRSN_WPAEssentials(BSSDescriptor *Bss, IE_RSN_WPA *IE, u8 offset);
u8 WD_GetSecurity(BSSDescriptor *Bss);

#endif
222 changes: 206 additions & 16 deletions libogc/wd.c
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -103,9 +103,9 @@ void WD_SetDefaultScanParameters(ScanParameters* set) {
int WD_Init(u8 mode) {
if(wd_fd < 0) {
wd_fd = IOS_Open("/dev/net/wd/command", 0x10000 | mode);
if (wd_fd < 0) return -1;
if (wd_fd < 0) return WD_UINITIALIZED;
}
return 0;
return WD_SUCCESS;
}

void WD_Deinit() {
Expand All @@ -116,13 +116,13 @@ void WD_Deinit() {
}

u8 WD_GetRadioLevel(BSSDescriptor* Bss) {
if (Bss->RSSI >= 0xc4)
if ((u8)Bss->RSSI >= 0xc4)
return WD_SIGNAL_STRONG; // Strong

if (Bss->RSSI >= 0xb5)
if ((u8)Bss->RSSI >= 0xb5)
return WD_SIGNAL_NORMAL; // Normal

if (Bss->RSSI >= 0xab)
if ((u8)Bss->RSSI >= 0xab)
return WD_SIGNAL_FAIR; // Fair

return WD_SIGNAL_WEAK; // Weak
Expand All @@ -131,7 +131,7 @@ u8 WD_GetRadioLevel(BSSDescriptor* Bss) {
int WD_GetInfo(WDInfo* info) {
s32 lockid = NCD_LockWirelessDriver();

if(WD_Init(AOSSAPScan) < 0) return -1;
if(WD_Init(AOSSAPScan) < 0) return WD_UINITIALIZED;

u8 inf[sizeof(WDInfo)] __attribute__((aligned(32)));

Expand All @@ -145,11 +145,11 @@ int WD_GetInfo(WDInfo* info) {
WD_Deinit();
NCD_UnlockWirelessDriver(lockid);

return 0;
return WD_SUCCESS;
}

int WD_Scan(ScanParameters *settings, u8* buff, u16 buffsize) {
if(wd_fd < 0) return -1;
if(wd_fd < 0) return WD_UINITIALIZED;

u8 buf[buffsize + 2] __attribute__((aligned(32)));
u8 settingsbuf[0x4e] __attribute__((aligned(32)));
Expand All @@ -168,20 +168,20 @@ int WD_Scan(ScanParameters *settings, u8* buff, u16 buffsize) {
usleep(100000);
memcpy(buff, buf, buffsize);

return 0;
return WD_SUCCESS;
}

int WD_ScanOnce(ScanParameters *settings, u8* buff, u16 buffsize) {
s32 lockid = NCD_LockWirelessDriver();

if(WD_Init(AOSSAPScan) < 0) return -1;
if(WD_Init(AOSSAPScan) < 0) return WD_UINITIALIZED;

WD_Scan(settings, buff, buffsize);

WD_Deinit();
NCD_UnlockWirelessDriver(lockid);

return 0;
return WD_SUCCESS;
}

u8 WD_GetNumberOfIEs(BSSDescriptor* Bss) {
Expand Down Expand Up @@ -214,32 +214,222 @@ int WD_GetIELength(BSSDescriptor* Bss, u8 ID) {
offset += hdr->len + sizeof(IE_hdr);
}

if(hdr->ID != ID) return -1;
if(hdr->ID != ID) return WD_NOTFOUND;

return hdr->len;
}

int WD_GetIE(BSSDescriptor* Bss, u8 ID, u8* buff, u8 buffsize) {
if(!buff) return -2;
if(!buff) return WD_INVALIDBUFF;

u16 IEslen = Bss->IEs_length;

u8* ptr = (u8*)Bss;
IE_hdr* hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor) + 1];
u16 offset = 0;

while((offset + hdr->len) < IEslen)
{
hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor) + offset];
if(hdr->ID == ID) break;
offset += hdr->len + sizeof(IE_hdr);
}

if(hdr->ID != ID) return WD_NOTFOUND;
if(buffsize < WD_GetIELength(Bss, ID)) return WD_BUFFTOOSMALL;

memset(buff, 0, buffsize);
memcpy(buff, &ptr[offset + sizeof(BSSDescriptor) + sizeof(IE_hdr)], hdr->len);

return WD_SUCCESS;
}

int WD_GetIEIDList(BSSDescriptor* Bss, u8* buff, u8 buffsize) {
if(!buff) return WD_INVALIDBUFF;
if(buffsize < WD_GetNumberOfIEs(Bss)) return WD_BUFFTOOSMALL;

u8 n = 0;

u8* ptr = (u8*)Bss;
IE_hdr* hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor)];
u16 offset = 0;

while(hdr->ID != ID && (offset + hdr->len) < IEslen && hdr->len != 0)
while(offset < Bss->IEs_length && hdr->len != 0)
{
buff[n] = hdr->ID;
hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor) + offset];
offset += hdr->len + sizeof(IE_hdr);
n++;
}

return WD_SUCCESS;
}

int WD_GetVendorSpecificIE(BSSDescriptor* Bss, u32 OUI, u8* buff, u8 buffsize) {
if(!buff) return WD_INVALIDBUFF;
u16 IEslen = Bss->IEs_length;

u8* ptr = (u8*)Bss;
IE_hdr* hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor)];
u16 offset = 0;

u32 tgtOUI = 0;

while((offset + hdr->len) < IEslen && hdr->len != 0)
{
hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor) + offset];
tgtOUI = ptr[sizeof(BSSDescriptor) + offset + 2] << 24 |
ptr[sizeof(BSSDescriptor) + offset + 3] << 16 |
ptr[sizeof(BSSDescriptor) + offset + 4] << 8 |
ptr[sizeof(BSSDescriptor) + offset + 5];
if (hdr->ID == IEID_VENDORSPECIFIC && tgtOUI == OUI) break;
offset += hdr->len + sizeof(IE_hdr);
}

if(hdr->ID != ID) return -1;
if(hdr->ID != IEID_VENDORSPECIFIC ||
tgtOUI != OUI) return WD_NOTFOUND;
if(buffsize < hdr->len) return WD_BUFFTOOSMALL;

memset(buff, 0, buffsize);
memcpy(buff, &ptr[offset + sizeof(BSSDescriptor) + sizeof(IE_hdr)], hdr->len);

return 0;
return WD_SUCCESS;
}

int WD_GetVendorSpecificIELength(BSSDescriptor* Bss, u32 OUI) {
u16 IEslen = Bss->IEs_length;

u8* ptr = (u8*)Bss;
IE_hdr* hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor)];
u16 offset = 0;

u32 tgtOUI = 0;

while((offset + hdr->len) < IEslen && hdr->len != 0)
{
hdr = (IE_hdr*)&ptr[sizeof(BSSDescriptor) + offset];
tgtOUI = ptr[sizeof(BSSDescriptor) + offset + 2] << 24 |
ptr[sizeof(BSSDescriptor) + offset + 3] << 16 |
ptr[sizeof(BSSDescriptor) + offset + 4] << 8 |
ptr[sizeof(BSSDescriptor) + offset + 5];
if (hdr->ID == IEID_VENDORSPECIFIC && tgtOUI == OUI) break;
offset += hdr->len + sizeof(IE_hdr);
}

if(hdr->ID != IEID_VENDORSPECIFIC ||
tgtOUI != OUI) return WD_NOTFOUND;

return hdr->len;
}

int WD_GetPCSList(BSSDescriptor *Bss, u8* destbuff, u8 buffsize, u8 offset) {
if(!Bss) return WD_INVALIDBUFF;
if(!destbuff) return WD_INVALIDBUFF;

IE_RSN_WPA IE;

int ret = WD_GetRSN_WPAEssentials(Bss, &IE, offset);

if(ret < 0) return WD_INVALIDBUFF;
if(IE.PCS_Count * 4 > buffsize) return WD_BUFFTOOSMALL;

u8 IE_len;
if(offset == RSN_OFFSET) {
IE_len = WD_GetIELength(Bss, IEID_SECURITY_RSN);
} else {
IE_len = WD_GetVendorSpecificIELength(Bss, OUI_WPA);
}


u8 buff[IE_len];
if(offset == RSN_OFFSET) {
WD_GetIE(Bss, IEID_SECURITY_RSN, buff, IE_len);
} else {
WD_GetVendorSpecificIE(Bss, OUI_WPA, buff, IE_len);
}


memset(destbuff, 0, buffsize);
memcpy(destbuff, &buff[8 + offset], IE.PCS_Count * 4);

return WD_SUCCESS;
}

int WD_GetRSN_WPAEssentials(BSSDescriptor *Bss, IE_RSN_WPA *IE, u8 offset) {
if(!Bss) return WD_INVALIDBUFF;
if(!IE) return WD_INVALIDBUFF;

u8 IE_len;
if(offset == RSN_OFFSET) {
IE_len = WD_GetIELength(Bss, IEID_SECURITY_RSN);
} else {
IE_len = WD_GetVendorSpecificIELength(Bss, OUI_WPA);
}
if(IE_len < 0) return WD_NOTFOUND;

u8 buff[IE_len];

if(offset == RSN_OFFSET) {
WD_GetIE(Bss, IEID_SECURITY_RSN, buff, IE_len);
} else {
WD_GetVendorSpecificIE(Bss, OUI_WPA, buff, IE_len);
}

IE->Version = buff[0 + offset] | buff[1 + offset] << 8;
offset += 2;
IE->GDCS = buff[0 + offset] << 24 | buff[1 + offset] << 16 | buff[2 + offset] << 8 | buff[3 + offset];
offset += 4;
IE->PCS_Count = buff[0 + offset] | buff[1 + offset] << 8;
offset += 2 + IE->PCS_Count * 4;
IE->AKMS_Count = buff[0 + offset] | buff[1 + offset] << 8;
offset += 2 + IE->AKMS_Count * 4;

return WD_SUCCESS;
}

u8 WD_GetSecurity(BSSDescriptor *Bss) {
if(!Bss) return WD_INVALIDBUFF;
if(!(Bss->Capabilities & CAPAB_SECURED_FLAG)) return WD_OPEN;

int ie_len = WD_GetVendorSpecificIELength(Bss, OUI_WPA);
u8 ret = 0;

if (ie_len != WD_NOTFOUND && ie_len > 0) { // WPA
IE_RSN_WPA IE;
WD_GetRSN_WPAEssentials(Bss, &IE, WPA_OFFSET);

u8 buff[IE.PCS_Count * 4];
WD_GetPCSList(Bss, buff, IE.PCS_Count * 4, WPA_OFFSET);

u8 offset = 0;

for (int i = 0; i < IE.PCS_Count; i++) {
if (buff[offset + 3] == 0x02) ret |= WD_WPA_TKIP;
else if (buff[offset + 3] == 0x04) ret |= WD_WPA_AES;
offset += 4;
}
}

ie_len = WD_GetIELength(Bss, IEID_SECURITY_RSN);

if(ie_len != WD_NOTFOUND && ie_len > 0) { // WPA2
IE_RSN_WPA IE;
WD_GetRSN_WPAEssentials(Bss, &IE, RSN_OFFSET);

u8 buff[IE.PCS_Count * 4];
WD_GetPCSList(Bss, buff, IE.PCS_Count * 4, RSN_OFFSET);
u8 offset = 0;

for (int i = 0; i < IE.PCS_Count; i++) {
if (buff[offset + 3] == 0x02) ret |= WD_WPA2_TKIP;
if (buff[offset + 3] == 0x04) ret |= WD_WPA2_AES;
offset += 4;
}
}

if(!ret) return WD_WEP;

return ret;
}

#endif