xref: /drivers/peripheral/wlan/test/hdi_service/wlan_callback_impl.c

/*
 * Copyright (c) 2022-2023 Huawei Device Co., Ltd.
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include "wlan_callback_impl.h"
#include <securec.h>
#include <hdf_base.h>
#include <hdf_log.h>
#include <osal_mem.h>

#define WLAN_EID_SSID 0
#define MAX_SSID_LEN 32

struct ElementHeader {
    uint8_t id;
    uint8_t datalen;
};

static int32_t WlanCallbackResetDriver(struct IWlanCallback *self, uint32_t event, int32_t code, const char *ifName)
{
    (void)self;
    HDF_LOGE("WlanCallbackResetDriver: receive resetStatus=%{public}d", code);
    return HDF_SUCCESS;
}

static void PrintSsid(const uint8_t *ie, uint32_t len)
{
    char ssid[MAX_SSID_LEN] = {0};
    uint8_t *pos = NULL;
    struct ElementHeader *hdr = (struct ElementHeader *)ie;

    if (ie == NULL || len < sizeof(struct ElementHeader)) {
        return;
    }
    while ((ie + len) >= ((uint8_t *)hdr + sizeof(*hdr) + hdr->datalen)) {
        pos = (uint8_t *)hdr + sizeof(*hdr);
        if (hdr->id == WLAN_EID_SSID) {
            if (hdr->datalen < MAX_SSID_LEN && memcpy_s(ssid, MAX_SSID_LEN, pos, hdr->datalen) == EOK) {
                HDF_LOGE("ssid: %{public}s", ssid);
            }
            return;
        }
        hdr = (struct ElementHeader *)(pos + hdr->datalen);
    }
}

static int32_t WlanCallbackScanResult(struct IWlanCallback *self, uint32_t event,
    const struct HdfWifiScanResult *scanResult, const char *ifName)
{
    (void)self;
    if (scanResult == NULL || ifName == NULL) {
        HDF_LOGE("%{public}s: input parameter invalid!", __func__);
        return HDF_ERR_INVALID_PARAM;
    }
    HDF_LOGE("HdiProcessScanResult: flags=%{public}d, caps=%{public}d, freq=%{public}d, beaconInt=%{public}d",
        scanResult->flags, scanResult->caps, scanResult->freq, scanResult->beaconInt);
    HDF_LOGE("HdiProcessScanResult: qual=%{public}d, beaconIeLen=%{public}d, level=%{public}d", scanResult->qual,
        scanResult->beaconIeLen, scanResult->level);
    HDF_LOGE("HdiProcessScanResult: age=%{public}d, ieLen=%{public}d", scanResult->age, scanResult->ieLen);
    PrintSsid(scanResult->ie, scanResult->ieLen);
    return HDF_SUCCESS;
}

static int32_t WlanCallbackScanResults(struct IWlanCallback *self, uint32_t event,
    const struct HdfWifiScanResults *scanResults, const char *ifName)
{
    uint32_t i;
    (void)self;
    if (scanResults == NULL || ifName == NULL) {
        HDF_LOGE("%{public}s: input parameter invalid!", __func__);
        return HDF_ERR_INVALID_PARAM;
    }
    HDF_LOGI("%{public}s: Receive %u scan results!", __func__, scanResults->resLen);
    for (i = 0; i < scanResults->resLen; i++) {
        struct HdfWifiScanResultExt *scanResult = &scanResults->res[i];
        HDF_LOGI("HdiProcessScanResult: flags=%{public}d, caps=%{public}d, freq=%{public}d, beaconInt=%{public}d",
            scanResult->flags, scanResult->caps, scanResult->freq, scanResult->beaconInt);
        HDF_LOGI("HdiProcessScanResult: qual=%{public}d, beaconIeLen=%{public}d, level=%{public}d", scanResult->qual,
            scanResult->beaconIeLen, scanResult->level);
        HDF_LOGI("HdiProcessScanResult: age=%{public}d, ieLen=%{public}d", scanResult->age, scanResult->ieLen);
        PrintSsid(scanResult->ie, scanResult->ieLen);
    }
    return HDF_SUCCESS;
}

static int32_t WlanCallbackNetlinkMessage(struct IWlanCallback *self, const uint8_t *msg, uint32_t msgLen)
{
    uint32_t i;
    (void)self;
    if (msg == NULL) {
        HDF_LOGE("%{public}s: input parameter invalid!", __func__);
        return HDF_ERR_INVALID_PARAM;
    }

    HDF_LOGI("%{public}s: receive message from netlink", __func__);
    for (i = 0; i < msgLen; i++) {
        HDF_LOGI("%02x", msg[i]);
    }
    return HDF_SUCCESS;
}

struct IWlanCallback *WlanCallbackServiceGet(void)
{
    struct WlanCallbackService *service =
        (struct WlanCallbackService *)OsalMemCalloc(sizeof(struct WlanCallbackService));
    if (service == NULL) {
        HDF_LOGE("%{public}s: malloc WlanCallbackService obj failed!", __func__);
        return NULL;
    }

    service->interface.ResetDriverResult = WlanCallbackResetDriver;
    service->interface.ScanResult = WlanCallbackScanResult;
    service->interface.WifiNetlinkMessage = WlanCallbackNetlinkMessage;
    service->interface.ScanResults = WlanCallbackScanResults;
    return &service->interface;
}

void WlanCallbackServiceRelease(struct IWlanCallback *instance)
{
    struct WlanCallbackService *service = (struct WlanCallbackService *)instance;
    if (service == NULL) {
        return;
    }

    OsalMemFree(service);
}