Bluetooth структура PWSAQUERYSET

#define WIN32_LEAN_AND_MEAN
 
#include <windows.h>
#include <winsock2.h>
#include <ws2tcpip.h>
#include <ws2bth.h>
#include <iostream>
#include <string.h>
using namespace std;
 
wchar_t g_szRemoteName[BTH_MAX_NAME_SIZE + 1] = {0};
 
ULONG NameToBthAddr(_In_ const LPWSTR pszRemoteName, _Out_ PSOCKADDR_BTH pRemoteBtAddr);
//ULONG RunClientMode (_In_SOCKADDR_BTH ululRemoteBthAddr, _In_ int iMaxCxnCycles = 1 );
 
int __cdecl main() {
 
    WORD wVersionRequested;
    WSADATA wsaData;
    int err;
 
    ULONG ulRetCode = 0;
    SOCKADDR_BTH RemoteBthAddr = {0};
 
    wVersionRequested = MAKEWORD(2, 2);
 
    err = WSAStartup(wVersionRequested, &wsaData);
    cout << "инициализация: ";
    switch (err) {
        case 0:
            cout << "Ошибок не обнаружено\n";
            break;
        case WSASYSNOTREADY:
            cout << "Базовая сетевая подсистема не готова к сетевому обмену данными.\n";
            break;
        case WSAVERNOTSUPPORTED:
            cout << "Запрошенная версия поддержки сокетов Windows не предоставляется этой конкретной реализацией сокетов Windows.\n";
            break;
        case WSAEINPROGRESS:
            cout << "Выполняется операция блокировки Windows Sockets 1.1.\n";
            break;
        case WSAEPROCLIM:
            cout << "Достигнуто ограничение на количество задач, поддерживаемых реализацией Windows Sockets.\n";
            break;
        case WSAEFAULT:
            cout << "Параметр lpWSAData не является допустимым указателем.\n";
            break;
        default:
            cout << "Не известная ошибка\nКод ошибки: ";
            int err1 = WSAGetLastError();
            cout << err1 << endl;
            break;
    }
    if (err == 0) {
        ulRetCode = NameToBthAddr(g_szRemoteName, &RemoteBthAddr);
        if (ulRetCode != 0) {
            cout << "Невозможно получить адрес удаленного радио с именем " << g_szRemoteName << endl;
        }
    }
    cout << "END\n";
}
 
ULONG NameToBthAddr(_In_ const LPWSTR pszRemoteName, _Out_ PSOCKADDR_BTH pRemoteBtAddr) {
    cout << "start ToBtnAddr" << endl;
 
    INT iResult = 0;
    BOOL bContinueLookup = FALSE, bRemoteDeviceFound = FALSE;
    ULONG ulFlags = 0, ulPQSSize = sizeof (WSAQUERYSET);
    HANDLE hLookup = NULL;
    PWSAQUERYSET pWSAQuerySet = NULL;
 
    ZeroMemory(pRemoteBtAddr, sizeof (*pRemoteBtAddr));
    pWSAQuerySet = (PWSAQUERYSET) HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY, ulPQSSize);
 
    if (pWSAQuerySet == NULL) {
        iResult = STATUS_NO_MEMORY;
        cout << "Не возможно выделить память\n";
    }
    if (iResult == 0) {
        for (INT iRetryCount = 0; !bRemoteDeviceFound && (iRetryCount < 3); iRetryCount++) {
            //
            // WSALookupService используется как для поиска службы, так и для запроса устройства
            // LUP_CONTAINERS — это флаг, сигнализирующий о том, что мы делаем запрос устройства.
            //
            ulFlags = LUP_CONTAINERS;
 
            //
            // Понятное имя устройства (если доступно) будет возвращено в lpszServiceInstanceName
            //
            ulFlags |= LUP_RETURN_NAME;
 
            //
            // BTH_ADDR будет возвращен в элементе lpcsaBuffer WSAQUERYSET
            //
            ulFlags |= LUP_RETURN_ADDR;
 
            if (iRetryCount == 0) {
                cout << "*INFO* | Запрос устройства из кеша... \n";
            } else {
                //
                // Очистить кеш устройства для всех запросов, кроме первого запроса
                //
                // Установив флаг LUP_FLUSHCACHE, мы просим службу поиска выполнить
                // новый поиск вместо извлечения информации из кеша устройства.
                //
                ulFlags |= LUP_FLUSHCACHE;
 
                //
                // Пауза на некоторое время перед всеми запросами после первого запроса
                //
                // Запросы удаленного имени будут поступать после запроса устройства
                // завершено. Без окна для получения IN_RANGE уведомлений,
                // у нас нет прямого механизма для определения удаленности
                // запросы имени завершены.
                //
                cout << "*INFO* | Невозможно найти устройство. Ожидание " << 15 << " секунд перед повторным запросом...\n";
                Sleep(15 * 1000);
 
                cout << "*INFO* | Запрос устройства...\n";
            }
            //
            // Запуск службы поиска
            //
            iResult = 0;
            hLookup = 0;
            bContinueLookup = FALSE;
            ZeroMemory(pWSAQuerySet, ulPQSSize);
            pWSAQuerySet->dwNameSpace = NS_BTH;
            pWSAQuerySet->dwSize = sizeof (WSAQUERYSET);
            iResult = WSALookupServiceBegin(pWSAQuerySet, ulFlags, &hLookup);
 
            //
            // Даже если у нас есть ошибка, мы хотим продолжить, пока не
            // достигаем CXN_MAX_INQUIRY_RETRY
            //
            if (iResult == NO_ERROR && hLookup != NULL) {
                bContinueLookup = TRUE;
            } else if (iRetryCount > 0) {
                cout << "WSALookupServiceBegin() завершился с ошибкой с кодом " << iResult << ", WSAGetLastError = " << WSAGetLastError() << endl;
                break;
            }
 
            while (bContinueLookup) {
                //
                // Получить информацию о следующем bluetooth-устройстве
                //
                // Обратите внимание, что вы можете передать тот же WSAQUERYSET из LookupBegin
                // до тех пор, пока вам не нужно изменять какой-либо указатель
                // члены структуры и т.д.
                //
                // ZeroMemory(pWSAQuerySet, ulPQSSize);
                // pWSAQuerySet->dwNameSpace = NS_BTH;
                // pWSAQuerySet->dwSize = sizeof(WSAQUERYSET);
                //
                // Сравните имя, чтобы убедиться, что это именно то устройство, которое мы ищем.
                //
                if (WSALookupServiceNext(hLookup, ulFlags, &ulPQSSize, pWSAQuerySet) == NO_ERROR) {
                    //
                    // Сравните имя, чтобы убедиться, что это именно то устройство, которое мы ищем.
                    //
 
                    char *lps1 = pWSAQuerySet->lpszServiceInstanceName;
                    const size_t cSize = strlen(lps1) + 1;
                    wchar_t * wc = new wchar_t [cSize];
                    mbstowcs(wc, lps1, cSize);
 
                    wchar_t * wc1 = pszRemoteName;
 
                    if (pWSAQuerySet->lpszServiceInstanceName != NULL)
                        cout << "Найдено устройство: " << wc << endl;
                    //char *lps1 = pWSAQuerySet->lpszServiceInstanceName;
                    if (pWSAQuerySet->lpszServiceInstanceName != NULL && wcsncmp(wc, wc1, cSize) == 0) {
                        //
                        // Найдено удаленное устройство Bluetooth с совпадающим именем.
                        // Получаем адрес устройства и выходим из поиска.
                        //
                        CopyMemory(pRemoteBtAddr, (PSOCKADDR_BTH) pWSAQuerySet->lpcsaBuffer->RemoteAddr.lpSockaddr, sizeof (*pRemoteBtAddr));
                        bRemoteDeviceFound = TRUE;
                        bContinueLookup = FALSE;
                        cout << "Найдено удаленное устройство Bluetooth с совпадающим именем\n";
                    }
                } else {
                    iResult = WSAGetLastError();
                    if (WSA_E_NO_MORE == iResult) { // Больше нет данных
                        //
                        // Больше устройств не найдено. Выход из поиска.
                        //
                        cout << "Устройство не найдено\n";
                        bContinueLookup = FALSE;
                    } else if (WSAEFAULT == iResult) {
                        //
                        // Недостаточно буфера для QUERYSET.
                        // В таком случае принимается 3-й параметр "ulPQSSize" функции "WSALookupServiceNext()"
                        // требуемый размер. Таким образом, мы можем использовать этот параметр для перераспределения памяти для QUERYSET.
                        //
                        cout << "Недостаточно буфера для QUERYSET\n";
                        HeapFree(GetProcessHeap(), 0, pWSAQuerySet);
                        pWSAQuerySet = (PWSAQUERYSET) HeapAlloc(GetProcessHeap(), HEAP_ZERO_MEMORY, ulPQSSize);
                        if (pWSAQuerySet == NULL) {
                            cout << "!ERROR! | WSALookupServiceNext() не удалось с кодом ошибки " << iResult << endl;
                            iResult = STATUS_NO_MEMORY;
                            bContinueLookup = FALSE;
                        }
                    } else {
                        cout << "=CRITICAL= | WSALookupServiceNext() другая ошибка с кодом ошибки " << iResult << endl;
                        bContinueLookup = FALSE;
                    }
                }
            }
            //
            // Завершить службу поиска
            //
            WSALookupServiceEnd(hLookup);
            if (iResult == STATUS_NO_MEMORY) {
                break;
            }
        }
    }
    if (NULL != pWSAQuerySet) {
        HeapFree(GetProcessHeap(), 0, pWSAQuerySet);
        pWSAQuerySet = NULL;
    }
 
    if (bRemoteDeviceFound) {
        iResult = 0;
    } else {
        iResult = 1;
    }
    cout << "END ToBtnAddr\n\n";
    return iResult;
}