lib/wfa_cs.c

/****************************************************************************
Copyright (c) 2016 Wi-Fi Alliance.  All Rights Reserved

Permission to use, copy, modify, and/or distribute this software for any purpose with or
without fee is hereby granted, provided that the above copyright notice and this permission
notice appear in all copies.

THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH
REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING
FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH
THE USE OR PERFORMANCE OF THIS SOFTWARE.

******************************************************************************/

/*
 *   File: wfa_cs.c -- configuration and setup
 *   This file contains all implementation for the dut setup and control
 *   functions, such as network interfaces, ip address and wireless specific
 *   setup with its supplicant.
 *
 *   The current implementation is to show how these functions
 *   should be defined in order to support the Agent Control/Test Manager
 *   control commands. To simplify the current work and avoid any GPL licenses,
 *   the functions mostly invoke shell commands by calling linux system call,
 *   system("<commands>").
 *
 *   It depends on the differnt device and platform, vendors can choice their
 *   own ways to interact its systems, supplicants and process these commands
 *   such as using the native APIs.
 *
 *
 */
#include <stdio.h>
#include <unistd.h>
#include <string.h>
#include <stdlib.h>
#include <stdbool.h>
#include <stdarg.h>
#include <sys/socket.h>
#include <arpa/inet.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <poll.h>

#include "wfa_portall.h"
#include "wfa_debug.h"
#include "wfa_ver.h"
#include "wfa_main.h"
#include "wfa_types.h"
#include "wfa_ca.h"
#include "wfa_tlv.h"
#include "wfa_sock.h"
#include "wfa_tg.h"
#include "wfa_cmds.h"
#include "wfa_rsp.h"
#include "wfa_utils.h"
#ifdef WFA_WMM_PS_EXT
#include "wfa_wmmps.h"
#endif

#define CERTIFICATES_PATH "/etc/wpa_supplicant"

/* Some device may only support UDP ECHO, activate this line */
//#define WFA_PING_UDP_ECHO_ONLY 1

#define WFA_ENABLED 1

extern unsigned short wfa_defined_debug;
int wfaExecuteCLI(char* CLI);

/* Since the two definitions are used all over the CA function */
char gCmdStr[WFA_CMD_STR_SZ];
dutCmdResponse_t gGenericResp;
int wfaTGSetPrio(int sockfd, int tgClass);
void create_apts_msg(int msg, unsigned int txbuf[], int id);

int sret = 0;

extern char e2eResults[];

#define RETURN_STA_CMD_ERROR(resp, statusCode, ...)                           \
  resp->status = statusCode;                                                  \
  wfaEncodeTLV(WFA_STA_ASSOCIATE_RESP_TLV, sizeof(resp->status), (BYTE*)resp, \
               respBuf);                                                      \
  *respLen = WFA_TLV_HDR_LEN + sizeof(resp->status);                          \
  DPRINT_ERR(WFA_ERR, __VA_ARGS__);                                           \
  return WFA_FAILURE;

FILE* e2efp = NULL;
int chk_ret_status() {
  char* ret = getenv(WFA_RET_ENV);

  if (*ret == '1')
    return WFA_SUCCESS;
  else
    return WFA_FAILURE;
}

static int systemWithLog(char* command) {
  DPRINT_INFO(WFA_OUT, "exec: %s\n", command);
  int ret = system(command);
  if (ret != 0) {
    DPRINT_INFO(WFA_OUT, "exit code %d\n", ret);
  }
  return ret;
}

// Read a line from a file.
// It reads at most bufSize-1 bytes to buf.
bool readLine(const char* filename, char* buf, const int bufSize) {
  FILE* fp = NULL;
  fp = fopen(filename, "r+");
  if (fp == NULL) {
    return false;
  }
  char* ret = fgets(buf, bufSize, fp);
  fclose(fp);

  if (ret == NULL) {
    return false;
  }

  if (buf[strlen(buf) - 1] == '\n') {
    buf[strlen(buf) - 1] = 0;
  }
  return true;
}

/*
 * agtCmdProcGetVersion(): response "ca_get_version" command to controller
 *  input:  cmd --- not used
 *          valLen -- not used
 *  output: parms -- a buffer to store the version info response.
 */
int agtCmdProcGetVersion(int len, BYTE* parms, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* getverResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "entering agtCmdProcGetVersion ...\n");

  getverResp->status = STATUS_COMPLETE;
  wSTRNCPY(getverResp->cmdru.version, WFA_SYSTEM_VER, WFA_VERNAM_LEN);

  wfaEncodeTLV(WFA_GET_VERSION_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)getverResp, respBuf);

  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/*
 * getNetworkId():
 *   This function gets the first network ID of interface ifname. If ssid is
 *   specified, restricts to search networks with the SSID. Empty ssid is
 *   treated as unspecified. If no network entry is found, returns -1.
 */
int getNetworkId(char* ifname, char* ssid) {
  int cmdLen;
  cmdLen = snprintf(gCmdStr, WFA_CMD_STR_SZ,
                    "wpa_cli.sh -i %s list_networks | tail -n +2", ifname);
  if (ssid && *ssid != 0) {
    // grep SSID with space boundary to avoid partial match.
    cmdLen += snprintf(gCmdStr + cmdLen, WFA_CMD_STR_SZ - cmdLen,
                       " | grep \"\\s%s\\s\"", ssid);
  }

  const char* tmpfile = "/tmp/.wfaListNetworkTmp";
  char cmdResult[32];
  snprintf(gCmdStr + cmdLen, WFA_CMD_STR_SZ - cmdLen, " | cut -f1 > %s",
           tmpfile);
  sret = systemWithLog(gCmdStr);
  if (sret != 0 || !readLine(tmpfile, cmdResult, sizeof(cmdResult))) {
    return -1;
  }
  return atoi(cmdResult);
}

/*
 * wfaStaAssociate():
 *    The function is to force the station wireless I/F to re/associate
 *    with the AP.
 */
int wfaStaAssociate(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* assoc = (dutCommand_t*)caCmdBuf;
  char* ifname = assoc->intf;
  dutCmdResponse_t* staAssocResp = &gGenericResp;
  char cmdResult[32];
  const char* tmpfile = "/tmp/.wfaStaAssociateTmp";

  DPRINT_INFO(WFA_OUT, "entering wfaStaAssociate ...\n");

  // verify parameters
  if (assoc->cmdsu.assoc.bssid[0] != '\0' || assoc->cmdsu.assoc.wps != 0) {
    RETURN_STA_CMD_ERROR(staAssocResp, STATUS_INVALID,
                         "unsupported command parameter\n");
  }

  if (assoc->cmdsu.assoc.ssid[0] != '\0') {
    int networkid = getNetworkId(ifname, assoc->cmdsu.assoc.ssid);
    if (networkid == -1) {
      RETURN_STA_CMD_ERROR(staAssocResp, STATUS_ERROR,
                           "network not configured\n");
    } else {
      // enable the network and disable all others
      sprintf(gCmdStr, "wpa_cli.sh -i %s select_network %d > %s", ifname,
              networkid, tmpfile);
      sret = systemWithLog(gCmdStr);
    }
  } else {
    // reassociate to current connected network
    sprintf(gCmdStr, "wpa_cli.sh -i%s reassociate > %s", ifname, tmpfile);
    sret = systemWithLog(gCmdStr);
  }

  // check wpa_cli response
  if (!readLine(tmpfile, cmdResult, sizeof(cmdResult))) {
    RETURN_STA_CMD_ERROR(staAssocResp, STATUS_ERROR,
                         "unable to read command output\n");
  }

  if (strcmp(cmdResult, "OK") != 0) {
    RETURN_STA_CMD_ERROR(staAssocResp, STATUS_ERROR,
                         "associate network failed, error: %s\n", cmdResult);
  }

  staAssocResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_ASSOCIATE_RESP_TLV, 4, (BYTE*)staAssocResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaReAssociate():
 *    The function is to force the station wireless I/F to re/associate
 *    with the AP.
 */
int wfaStaReAssociate(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* assoc = (dutCommand_t*)caCmdBuf;
  char* ifname = assoc->intf;
  dutCmdResponse_t* staAssocResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "entering wfaStaAssociate ...\n");
  /*
     * if bssid appears, station should associate with the specific
     * BSSID AP at its initial association.
     * If it is different to the current associating AP, it will be forced to
     * roam the new AP
     */
  if (assoc->cmdsu.assoc.bssid[0] != '\0') {
    /* if (the first association) */
    /* just do initial association to the BSSID */

    /* else (station already associate to an AP) */
    /* Do forced roaming */

  } else {
    /* use 'ifconfig' command to bring down the interface (linux specific) */
    sprintf(gCmdStr, "ifconfig %s down", ifname);
    sret = systemWithLog(gCmdStr);

    /* use 'ifconfig' command to bring up the interface (linux specific) */
    sprintf(gCmdStr, "ifconfig %s up", ifname);

    /*
         *  use 'wpa_cli' command to force a 802.11 re/associate
         *  (wpa_supplicant specific)
         */
    sprintf(gCmdStr, "wpa_cli.sh -i%s reassociate", ifname);
    sret = systemWithLog(gCmdStr);
  }

  /*
     * Then report back to control PC for completion.
     * This does not have failed/error status. The result only tells
     * a completion.
     */
  staAssocResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_ASSOCIATE_RESP_TLV, 4, (BYTE*)staAssocResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaIsConnected():
 *    The function is to check whether the station's wireless I/F has
 *    already connected to an AP.
 */
int wfaStaIsConnected(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* connStat = (dutCommand_t*)caCmdBuf;
  dutCmdResponse_t* staConnectResp = &gGenericResp;
  char* ifname = connStat->intf;
  FILE* tmpfile = NULL;
  char result[32];

  DPRINT_INFO(WFA_OUT, "Entering isConnected ...\n");

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_chkconnect %s\n", ifname);
  sret = systemWithLog(gCmdStr);

  if (chk_ret_status() == WFA_SUCCESS)
    staConnectResp->cmdru.connected = 1;
  else
    staConnectResp->cmdru.connected = 0;
#else
  /*
     * use 'wpa_cli' command to check the interface status
     * none, scanning or complete (wpa_supplicant specific)
     */
  sprintf(gCmdStr,
          "wpa_cli.sh -i%s status | grep ^wpa_state= | cut -f2- -d= > "
          "/tmp/.isConnected",
          ifname);
  sret = systemWithLog(gCmdStr);

  /*
     * the status is saved in a file.  Open the file and check it.
     */
  tmpfile = fopen("/tmp/.isConnected", "r+");
  if (tmpfile == NULL) {
    staConnectResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_IS_CONNECTED_RESP_TLV, 4, (BYTE*)staConnectResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    DPRINT_ERR(WFA_ERR, "file open failed\n");
    return WFA_FAILURE;
  }

  sret = fscanf(tmpfile, "%s", (char*)result);
  fclose(tmpfile);

  if (strncmp(result, "COMPLETED", 9) == 0)
    staConnectResp->cmdru.connected = 1;
  else
    staConnectResp->cmdru.connected = 0;
#endif

  /*
     * Report back the status: Complete or Failed.
     */
  staConnectResp->status = STATUS_COMPLETE;

  wfaEncodeTLV(WFA_STA_IS_CONNECTED_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)staConnectResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/*
 * wfaStaGetIpConfig():
 * This function is to retriev the ip info including
 *     1. dhcp enable
 *     2. ip address
 *     3. mask
 *     4. primary-dns
 *     5. secondary-dns
 *
 *     The current implementation is to use a script to find these information
 *     and store them in a file.
 */
int wfaStaGetIpConfig(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  int slen, i = 0;
  dutCommand_t* getIpConf = (dutCommand_t*)caCmdBuf;
  dutCmdResponse_t* ipconfigResp = &gGenericResp;
  char* ifname = getIpConf->intf;
  caStaGetIpConfigResp_t* ifinfo = &ipconfigResp->cmdru.getIfconfig;

  FILE* tmpfd;
  char string[256];
  char* str;

  strcpy(ifinfo->dns[0], "0");
  strcpy(ifinfo->dns[1], "0");

  /*
     * Run the script file "getipconfig.sh" to check the ip status
     * (current implementation  specific).
     * note: "getipconfig.sh" is only defined for the current implementation
     *
     * Example output:
     * dhcpcli=/sbin/dhcpcd
     *
     * mac=50:e0:85:5f:e9:93
     * ipaddr=192.168.0.116
     * bcast=192.168.0.255
     * mask=255.255.255.0
     * nameserver 192.168.0.1
     */
  sprintf(gCmdStr, "getipconfig.sh /tmp/ipconfig.txt %s\n", ifname);

  sret = systemWithLog(gCmdStr);
  if (sret != 0) {
    ipconfigResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_GET_IP_CONFIG_RESP_TLV, 4, (BYTE*)ipconfigResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    DPRINT_ERR(WFA_ERR, "error from getipconfig exec: %d\n", sret);
    return WFA_FAILURE;
  }

  /* open the output result and scan/retrieve the info */
  tmpfd = fopen("/tmp/ipconfig.txt", "r+");

  if (tmpfd == NULL) {
    ipconfigResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_GET_IP_CONFIG_RESP_TLV, 4, (BYTE*)ipconfigResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    DPRINT_ERR(WFA_ERR, "file open failed\n");
    return WFA_FAILURE;
  }

  for (;;) {
    if (fgets(string, 256, tmpfd) == NULL)
      break;

    /* check dhcp enabled */
    if (strncmp(string, "dhcpcli", 7) == 0) {
      str = strtok(string, "=");
      str = strtok(NULL, "=");
      if (str != NULL)
        ifinfo->isDhcp = 1;
      else
        ifinfo->isDhcp = 0;
    }

    if (strncmp(string, "ipaddr", 6) == 0) {
      str = strchr(string, '=');
      if (str != NULL) {
        strcpy(ifinfo->ipaddr, str + 1);
        slen = strlen(ifinfo->ipaddr);
        ifinfo->ipaddr[slen - 1] = '\0';
      } else
        strcpy(ifinfo->ipaddr, "none");
    }

    /* check the mask */
    if (strncmp(string, "mask", 4) == 0) {
      str = strchr(string, '=');
      if (str != NULL) {
        strcpy(ifinfo->mask, str + 1);
        slen = strlen(ifinfo->mask);
        ifinfo->mask[slen - 1] = '\0';
      } else
        strcpy(ifinfo->mask, "none");
    }

    /* find out the dns server ip address */
    if (strncmp(string, "nameserv", 8) == 0) {
      str = strchr(string, ' ');
      if (str != NULL && i < 2) {
        strcpy(ifinfo->dns[i], str + 1);
        slen = strlen(ifinfo->dns[i]);
        ifinfo->dns[i][slen - 1] = '\0';
      } else
        strcpy(ifinfo->dns[i], "none");

      i++;
    }
  }

  /*
     * Report back the results
     */
  ipconfigResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GET_IP_CONFIG_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)ipconfigResp, respBuf);

  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

#if 0
    DPRINT_INFO(WFA_OUT, "%i %i %s %s %s %s %i\n", ipconfigResp->status,
                ifinfo->isDhcp, ifinfo->ipaddr, ifinfo->mask,
                ifinfo->dns[0], ifinfo->dns[1], *respLen);
#endif

  fclose(tmpfd);
  return WFA_SUCCESS;
}

/*
 * wfaStaSetIpConfig():
 *   The function is to set the ip configuration to a wireless I/F.
 *   1. IP address
 *   2. Mac address
 *   3. default gateway
 *   4. dns nameserver (pri and sec).
 */
int wfaStaSetIpConfig(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* setIpConf = (dutCommand_t*)caCmdBuf;
  caStaSetIpConfig_t* ipconfig = &setIpConf->cmdsu.ipconfig;
  dutCmdResponse_t* staSetIpResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "entering wfaStaSetIpConfig ...\n");

  if (ipconfig->isDhcp) {
    DPRINT_INFO(WFA_OUT, "error: dhcp not supported\n");
    staSetIpResp->status = STATUS_INVALID;
    wfaEncodeTLV(WFA_STA_SET_IP_CONFIG_RESP_TLV, 4, (BYTE*)staSetIpResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    return WFA_FAILURE;
  }

  /*
     * Use command 'ifconfig' to configure the interface ip address, mask.
     * (Linux specific).
     */
  sprintf(gCmdStr, "ifconfig %s %s netmask %s >/tmp/ifconfig.log 2>&1",
          ipconfig->intf, ipconfig->ipaddr, ipconfig->mask);
  DPRINT_INFO(WFA_OUT, "exec: %s\n", gCmdStr);
  sret = systemWithLog(gCmdStr);
  if (sret != 0) {
    DPRINT_INFO(WFA_OUT, "exit code %d\n", sret);
  }

  /* use command 'route add' to set set gatewway (linux specific) */
  if (ipconfig->defGateway[0] != '\0') {
    sprintf(gCmdStr, "route add default gw %s >/tmp/route.log 2>&1",
            ipconfig->defGateway);
    DPRINT_INFO(WFA_OUT, "exec: %s\n", gCmdStr);
    sret = systemWithLog(gCmdStr);
    if (sret != 0) {
      DPRINT_INFO(WFA_OUT, "exit code %d\n", sret);
    }
  }

  /* set dns (linux specific) */
  sprintf(gCmdStr, "cp /etc/resolv.conf /tmp/resolv.conf.bk");
  DPRINT_INFO(WFA_OUT, "exec: %s\n", gCmdStr);
  sret = systemWithLog(gCmdStr);
  if (sret != 0) {
    DPRINT_INFO(WFA_OUT, "exit code %d backing up resolv.conf\n", sret);
  }
  sprintf(gCmdStr, "echo nameserver %s > /etc/resolv.conf", ipconfig->pri_dns);
  DPRINT_INFO(WFA_OUT, "exec: %s\n", gCmdStr);
  sret = systemWithLog(gCmdStr);
  if (sret != 0) {
    DPRINT_INFO(WFA_OUT, "exit code %d writing resolv.conf\n", sret);
  }
  if (strlen(ipconfig->sec_dns) > 0) {
    sprintf(gCmdStr, "echo nameserver %s >> /etc/resolv.conf",
            ipconfig->sec_dns);
    DPRINT_INFO(WFA_OUT, "exec: %s\n", gCmdStr);
    sret = systemWithLog(gCmdStr);
    if (sret != 0) {
      DPRINT_INFO(WFA_OUT, "exit code %d writing resolv.conf\n", sret);
    }
  }

  /*
     * report status
     */
  staSetIpResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_IP_CONFIG_RESP_TLV, 4, (BYTE*)staSetIpResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaVerifyIpConnection():
 * The function is to verify if the station has IP connection with an AP by
 * send ICMP/pings to the AP.
 */
int wfaStaVerifyIpConnection(int len,
                             BYTE* caCmdBuf,
                             int* respLen,
                             BYTE* respBuf) {
  dutCommand_t* verip = (dutCommand_t*)caCmdBuf;
  dutCmdResponse_t* verifyIpResp = &gGenericResp;

#ifndef WFA_PING_UDP_ECHO_ONLY
  char strout[64], *pcnt;
  FILE* tmpfile;

  DPRINT_INFO(WFA_OUT, "Entering wfaStaVerifyIpConnection ...\n");

  /* set timeout value in case not set */
  if (verip->cmdsu.verifyIp.timeout <= 0) {
    verip->cmdsu.verifyIp.timeout = 10;
  }

  /* execute the ping command  and pipe the result to a tmp file */
  sprintf(gCmdStr,
          "ping %s -c 3 -W %u | grep loss | cut -f3 -d, 1>& /tmp/pingout.txt",
          verip->cmdsu.verifyIp.dipaddr, verip->cmdsu.verifyIp.timeout);
  sret = systemWithLog(gCmdStr);

  /* scan/check the output */
  tmpfile = fopen("/tmp/pingout.txt", "r+");
  if (tmpfile == NULL) {
    verifyIpResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_VERIFY_IP_CONNECTION_RESP_TLV, 4, (BYTE*)verifyIpResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    DPRINT_ERR(WFA_ERR, "file open failed\n");
    return WFA_FAILURE;
  }

  verifyIpResp->status = STATUS_COMPLETE;
  if (fscanf(tmpfile, "%s", strout) == EOF)
    verifyIpResp->cmdru.connected = 0;
  else {
    pcnt = strtok(strout, "%");

    /* if the loss rate is 100%, not able to connect */
    if (atoi(pcnt) == 100)
      verifyIpResp->cmdru.connected = 0;
    else
      verifyIpResp->cmdru.connected = 1;
  }

  fclose(tmpfile);
#else
  int btSockfd;
  struct pollfd fds[2];
  int timeout = 2000;
  char anyBuf[64];
  struct sockaddr_in toAddr;
  int done = 1, cnt = 0, ret, nbytes;

  verifyIpResp->status = STATUS_COMPLETE;
  verifyIpResp->cmdru.connected = 0;

  btSockfd = wfaCreateUDPSock("127.0.0.1", WFA_UDP_ECHO_PORT);

  if (btSockfd == -1) {
    verifyIpResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_VERIFY_IP_CONNECTION_RESP_TLV, 4, (BYTE*)verifyIpResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;
    return WFA_FAILURE;
    ;
  }

  toAddr.sin_family = AF_INET;
  toAddr.sin_addr.s_addr = inet_addr(verip->cmdsu.verifyIp.dipaddr);
  toAddr.sin_port = htons(WFA_UDP_ECHO_PORT);

  while (done) {
    wfaTrafficSendTo(btSockfd, (char*)anyBuf, 64, (struct sockaddr*)&toAddr);
    cnt++;

    fds[0].fd = btSockfd;
    fds[0].events = POLLIN | POLLOUT;

    ret = poll(fds, 1, timeout);
    switch (ret) {
      case 0:
        /* it is time out, count a packet lost*/
        break;
      case -1:
      /* it is an error */
      default: {
        switch (fds[0].revents) {
          case POLLIN:
          case POLLPRI:
          case POLLOUT:
            nbytes = wfaTrafficRecv(btSockfd, (char*)anyBuf,
                                    (struct sockaddr*)&toAddr);
            if (nbytes != 0)
              verifyIpResp->cmdru.connected = 1;
            done = 0;
            break;
          default:
              /* errors but not care */
              ;
        }
      }
    }
    if (cnt == 3) {
      done = 0;
    }
  }

#endif

  wfaEncodeTLV(WFA_STA_VERIFY_IP_CONNECTION_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)verifyIpResp, respBuf);

  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/*
 * wfaStaGetMacAddress()
 *    This function is to retrieve the MAC address of a wireless I/F.
 */
int wfaStaGetMacAddress(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* getMac = (dutCommand_t*)caCmdBuf;
  dutCmdResponse_t* getmacResp = &gGenericResp;
  char* str;
  char* ifname = getMac->intf;

  FILE* tmpfd;
  char string[257];

  DPRINT_INFO(WFA_OUT, "Entering wfaStaGetMacAddress ...\n");
  /*
     * run the script "getipconfig.sh" to find out the mac
     */
  sprintf(gCmdStr, "ifconfig %s > /tmp/ipconfig.txt ", ifname);
  sret = systemWithLog(gCmdStr);

  tmpfd = fopen("/tmp/ipconfig.txt", "r+");
  if (tmpfd == NULL) {
    getmacResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_GET_MAC_ADDRESS_RESP_TLV, 4, (BYTE*)getmacResp,
                 respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    DPRINT_ERR(WFA_ERR, "file open failed\n");
    return WFA_FAILURE;
  }

  if (fgets((char*)&string[0], 256, tmpfd) == NULL) {
    getmacResp->status = STATUS_ERROR;
  }

  str = strtok(string, " ");
  while (str && ((strcmp(str, "HWaddr")) != 0)) {
    str = strtok(NULL, " ");
  }

  /* get mac */
  if (str) {
    str = strtok(NULL, " ");
    strcpy(getmacResp->cmdru.mac, str);
    getmacResp->status = STATUS_COMPLETE;
  }

  wfaEncodeTLV(WFA_STA_GET_MAC_ADDRESS_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)getmacResp, respBuf);

  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  fclose(tmpfd);
  return WFA_SUCCESS;
}

/*
 * wfaStaGetStats():
 * The function is to retrieve the statistics of the I/F's layer 2 txFrames,
 * rxFrames, txMulticast, rxMulticast, fcsErrors/crc, and txRetries.
 * Currently there is not definition how to use these info.
 */
int wfaStaGetStats(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* statsResp = &gGenericResp;

  /* this is never used, you can skip this call */

  statsResp->status = STATUS_ERROR;
  wfaEncodeTLV(WFA_STA_GET_STATS_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)statsResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/*
 * ensureNetworkId():
 *    It tries to get network ID of the given SSID first. If so, returns it.
 *    Otherwise, adds one and returns the added network ID. Note that SSID can
 *    be NULL, meaning any existing network ID is okay.
 *    Returns -1 for any error.
 */
int ensureNetworkId(char* ifname, char* ssid) {
  int networkId = getNetworkId(ifname, ssid);
  if (networkId >= 0) {
    return networkId;
  }

  const char* tmpfile = "/tmp/.wfaAddNetworkTmp";
  char cmdResult[32];

  // Network ID not found, try creating one and return the newly added network ID.
  snprintf(gCmdStr, WFA_CMD_STR_SZ, "wpa_cli.sh -i%s add_network > %s", ifname,
           tmpfile);
  sret = systemWithLog(gCmdStr);
  if (sret != 0 || !readLine(tmpfile, cmdResult, sizeof(cmdResult))) {
    return -1;
  }

  return atoi(cmdResult);
}

// Helper function to return "wpa_cli.sh -i<ifname> <op>_network <networkId>".
// Note that the caller is responsible to provide char buffer.
char* networkCmd(char* buf, const char* ifname, int networkId, const char* op) {
  sprintf(buf, "wpa_cli.sh -i%s %s_network %d", ifname, op, networkId);
  return buf;
}

/*
 * wfaSetEncryption():
 *   The function is to set the wireless interface with WEP or none.
 *
 *   Since WEP is optional test, current function is only used for
 *   resetting the Security to NONE/Plaintext (OPEN). To test WEP,
 *   this function should be replaced by the next one (wfaSetEncryption1())
 *
 *   Input parameters:
 *     1. I/F
 *     2. ssid
 *     3. encpType - wep or none
 *     Optional:
 *     4. key1
 *     5. key2
 *     6. key3
 *     7. key4
 *     8. activeKey Index
 */

int wfaSetEncryption1(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEncryption_t* setEncryp = (caStaSetEncryption_t*)caCmdBuf;
  dutCmdResponse_t* setEncrypResp = &gGenericResp;
  char* ifname = setEncryp->intf;
  char* ssid = setEncryp->ssid;

  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEncrypResp, STATUS_ERROR,
                         "unable to get network id");
  }

  // Disable the network first.
  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  // Set SSID.
  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, ssid);
  sret = systemWithLog(gCmdStr);

  // Tell the supplicant for infrastructure mode (1).
  sprintf(gCmdStr, "%s mode 0", setCmd);
  sret = systemWithLog(gCmdStr);

  // Set Key management to NONE (NO WPA) for plaintext or WEP.
  sprintf(gCmdStr, "%s key_mgmt NONE", setCmd);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));

  setEncrypResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_ENCRYPTION_RESP_TLV, 4, (BYTE*)setEncrypResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 *  Since WEP is optional, this function could be used to replace
 *  wfaSetEncryption() if necessary.
 */
int wfaSetEncryption(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEncryption_t* setEncryp = (caStaSetEncryption_t*)caCmdBuf;
  dutCmdResponse_t* setEncrypResp = &gGenericResp;
  char* ifname = setEncryp->intf;
  char* ssid = setEncryp->ssid;

  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEncrypResp, STATUS_ERROR,
                         "unable to get network id");
  }

  // Disable the network first.
  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  // Set SSID.
  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, ssid);
  sret = systemWithLog(gCmdStr);

  // Tell the supplicant for infrastructure mode (1).
  sprintf(gCmdStr, "%s mode 0", setCmd);
  sret = systemWithLog(gCmdStr);

  // Set Key management to NONE (NO WPA) for plaintext or WEP.
  sprintf(gCmdStr, "%s key_mgmt NONE", setCmd);
  sret = systemWithLog(gCmdStr);

  // Set keys.
  int i;
  if (setEncryp->encpType == 1) {
    for (i = 0; i < 4; i++) {
      if (setEncryp->keys[i][0] != '\0') {
        sprintf(gCmdStr, "%s wep_key %i %s", setCmd, i, setEncryp->keys[i]);
        systemWithLog(gCmdStr);
      }
    }

    // Set the active key.
    i = setEncryp->activeKeyIdx;
    if (setEncryp->keys[i][0] != '\0') {
      sprintf(gCmdStr, "%s wep_tx_keyidx %i", setCmd, i);
      systemWithLog(gCmdStr);
    }
  } else {
    // Clearly remove the keys -- reported by p.schwann.
    for (i = 0; i < 4; i++) {
      sprintf(gCmdStr, "%s wep_key%i \"\"", setCmd, i);
      systemWithLog(gCmdStr);
    }
  }

  // Enable the network.
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));

  setEncrypResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_ENCRYPTION_RESP_TLV, 4, (BYTE*)setEncrypResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSetSecurity(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  int ret = WFA_SUCCESS;

  return ret;
}

/*
 * wfaStaSetEapTLS():
 *   This is to set
 *   1. ssid
 *   2. encrypType - tkip or aes-ccmp
 *   3. keyManagementType - wpa or wpa2
 *   4. trustedRootCA
 *   5. clientCertificate
 */
int wfaStaSetEapTLS(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEapTLS_t* setTLS = (caStaSetEapTLS_t*)caCmdBuf;
  char* ifname = setTLS->intf;
  char* ssid = setTLS->ssid;
  dutCmdResponse_t* setEapTlsResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "Entering wfaStaSetEapTLS ...\n");

  // Need to store the trustedROOTCA and clientCertificate into a file first.
#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_eaptls -i %s %s %s %s", ifname, ssid,
          setTLS->trustedRootCA, setTLS->clientCertificate);
  sret = systemWithLog(gCmdStr);
#else

  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEapTlsResp, STATUS_ERROR,
                         "unable to get network id");
  }

  // Disable the network first.
  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  // Set SSID.
  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, setTLS->ssid);
  sret = systemWithLog(gCmdStr);

  // Set key management.
  if (strcasecmp(setTLS->keyMgmtType, "wpa2-sha256") == 0) {
  } else if (strcasecmp(setTLS->keyMgmtType, "wpa2-eap") == 0) {
  } else if (strcasecmp(setTLS->keyMgmtType, "wpa2-ft") == 0) {
  } else if (strcasecmp(setTLS->keyMgmtType, "wpa") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setTLS->keyMgmtType, "wpa2") == 0) {
    // to take all and device to pick any one supported.
  } else {
    // ??
  }
  sret = systemWithLog(gCmdStr);

  // Protocol WPA.
  sprintf(gCmdStr, "%s proto WPA", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s eap TLS", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s ca_cert '\"%s\"'", setCmd, setTLS->trustedRootCA);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s identity '\"wifi-user@wifilabs.local\"'", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s private_key '\"%s/%s\"'", setCmd, CERTIFICATES_PATH,
          setTLS->clientCertificate);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s private_key_passwd '\"wifi\"'", setCmd);
  sret = systemWithLog(gCmdStr);

  // Enable network.
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));
#endif

  setEapTlsResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_EAPTLS_RESP_TLV, 4, (BYTE*)setEapTlsResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * The function is to set
 *   1. ssid
 *   2. passPhrase
 *   3. keyMangementType - wpa/wpa2
 *   4. encrypType - tkip or aes-ccmp
 */
int wfaStaSetPSK(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  /*Incompleted function*/
  dutCmdResponse_t* setPskResp = &gGenericResp;

#ifndef WFA_PC_CONSOLE
  caStaSetPSK_t* setPSK = (caStaSetPSK_t*)caCmdBuf;
  char* ifname = setPSK->intf;
  char* ssid = setPSK->ssid;

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_psk %s %s %s", ifname, ssid, setPSK->passphrase);
  sret = systemWithLog(gCmdStr);
#else
  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setPskResp, STATUS_ERROR, "unable to get network id");
  }

  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, setPSK->ssid);
  sret = systemWithLog(gCmdStr);

  if (strcasecmp(setPSK->keyMgmtType, "wpa2-sha256") == 0)
    sprintf(gCmdStr, "%s key_mgmt WPA2-SHA256", setCmd);
  else if (strcasecmp(setPSK->keyMgmtType, "wpa2") == 0) {
    // take all and device to pick it supported.
  } else if (strcasecmp(setPSK->keyMgmtType, "wpa2-psk") == 0) {
  } else if (strcasecmp(setPSK->keyMgmtType, "wpa2-ft") == 0) {
  } else if (strcasecmp(setPSK->keyMgmtType, "wpa2-wpa-psk") == 0) {
  } else {
    sprintf(gCmdStr, "%s key_mgmt WPA-PSK", setCmd);
  }
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s psk '\"%s\"'", setCmd, setPSK->passphrase);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));

  /* if PMF enable */
  if (setPSK->pmf == WFA_ENABLED || setPSK->pmf == WFA_OPTIONAL) {
  } else if (setPSK->pmf == WFA_REQUIRED) {
  } else if (setPSK->pmf == WFA_F_REQUIRED) {
  } else if (setPSK->pmf == WFA_F_DISABLED) {
  } else {
    /* Disable PMF */
  }

#endif

#endif

  setPskResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_PSK_RESP_TLV, 4, (BYTE*)setPskResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaGetInfo():
 * Get vendor specific information in name/value pair by a wireless I/F.
 */
int wfaStaGetInfo(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  dutCommand_t* getInfo = (dutCommand_t*)caCmdBuf;
  FILE* tmpfd;
  char vendor[256];
  const char* vendorFileName = "/tmp/ifvendor.txt";

  sprintf(gCmdStr, "getifvendor.sh %s %s\n", getInfo->intf, vendorFileName);

  if (systemWithLog(gCmdStr) == -1) {
    infoResp.status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_GET_INFO_RESP_TLV, sizeof(infoResp.status),
                 (BYTE*)&infoResp, respBuf);
    *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp.status);

    DPRINT_ERR(WFA_ERR, "script %s failed\n", vendorFileName);
    return WFA_FAILURE;
  }

  /* open the output result and scan/retrieve the info */
  tmpfd = fopen(vendorFileName, "r+");

  if (tmpfd == NULL || fgets(vendor, 256, tmpfd) == NULL) {
    infoResp.status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_GET_INFO_RESP_TLV, sizeof(infoResp.status),
                 (BYTE*)&infoResp, respBuf);
    *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp.status);

    DPRINT_ERR(WFA_ERR, "file read failed\n");

    if (tmpfd != NULL) {
      fclose(tmpfd);
      remove(vendorFileName);
    }

    return WFA_FAILURE;
  }

  snprintf(infoResp.cmdru.info, sizeof(infoResp.cmdru.info),
           "interface,%s,description,%s", getInfo->intf, vendor);

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GET_INFO_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  fclose(tmpfd);
  remove(vendorFileName);

  return WFA_SUCCESS;
}

/*
 * wfaStaSetEapTTLS():
 *   This is to set
 *   1. ssid
 *   2. username
 *   3. passwd
 *   4. encrypType - tkip or aes-ccmp
 *   5. keyManagementType - wpa or wpa2
 *   6. trustedRootCA
 */
int wfaStaSetEapTTLS(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEapTTLS_t* setTTLS = (caStaSetEapTTLS_t*)caCmdBuf;
  char* ifname = setTTLS->intf;
  char* ssid = setTTLS->ssid;
  dutCmdResponse_t* setEapTtlsResp = &gGenericResp;

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_eapttls %s %s %s %s %s", ifname, ssid,
          setTTLS->username, setTTLS->passwd, setTTLS->trustedRootCA);
  sret = systemWithLog(gCmdStr);
#else
  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEapTtlsResp, STATUS_ERROR,
                         "unable to get network id");
  }

  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, setTTLS->ssid);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s identity '\"%s\"'", setCmd, setTTLS->username);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s password '\"%s\"'", setCmd, setTTLS->passwd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  sret = systemWithLog(gCmdStr);

  /* This may not need to set. if it is not set, default to take all */
  //   sprintf(cmdStr, "%s pairwise '\"%s\"", setCmd, setTTLS->encrptype);
  if (strcasecmp(setTTLS->keyMgmtType, "wpa2-sha256") == 0) {
  } else if (strcasecmp(setTTLS->keyMgmtType, "wpa2-eap") == 0) {
  } else if (strcasecmp(setTTLS->keyMgmtType, "wpa2-ft") == 0) {
  } else if (strcasecmp(setTTLS->keyMgmtType, "wpa") == 0) {
  } else if (strcasecmp(setTTLS->keyMgmtType, "wpa2") == 0) {
    // to take all and device to pick one it supported
  } else {
    // ??
  }
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s eap TTLS", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s ca_cert '\"%s/%s\"'", setCmd, CERTIFICATES_PATH,
          setTTLS->trustedRootCA);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s proto WPA", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s phase2 '\"auth=MSCHAPV2\"'", setCmd);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));
#endif

  setEapTtlsResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_EAPTTLS_RESP_TLV, 4, (BYTE*)setEapTtlsResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaSetEapSIM():
 *   This is to set
 *   1. ssid
 *   2. user name
 *   3. passwd
 *   4. encrypType - tkip or aes-ccmp
 *   5. keyMangementType - wpa or wpa2
 */
int wfaStaSetEapSIM(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEapSIM_t* setSIM = (caStaSetEapSIM_t*)caCmdBuf;
  char* ifname = setSIM->intf;
  char* ssid = setSIM->ssid;
  dutCmdResponse_t* setEapSimResp = &gGenericResp;

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_eapsim %s %s %s %s", ifname, ssid, setSIM->username,
          setSIM->encrptype);
  sret = systemWithLog(gCmdStr);
#else

  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEapSimResp, STATUS_ERROR,
                         "unable to get network id");
  }

  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, ssid);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s identity '\"%s\"'", setCmd, setSIM->username);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s pairwise '\"%s\"'", setCmd, setSIM->encrptype);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s eap SIM", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s proto WPA", setCmd);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));

  if (strcasecmp(setSIM->keyMgmtType, "wpa2-sha256") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-SHA256", setCmd);
  } else if (strcasecmp(setSIM->keyMgmtType, "wpa2-eap") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setSIM->keyMgmtType, "wpa2-ft") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-FT", setCmd);
  } else if (strcasecmp(setSIM->keyMgmtType, "wpa") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setSIM->keyMgmtType, "wpa2") == 0) {
    // take all and device to pick one which is supported.
  } else {
    // ??
  }
  sret = systemWithLog(gCmdStr);

#endif

  setEapSimResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_EAPSIM_RESP_TLV, 4, (BYTE*)setEapSimResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaSetPEAP()
 *   This is to set
 *   1. ssid
 *   2. user name
 *   3. passwd
 *   4. encryType - tkip or aes-ccmp
 *   5. keyMgmtType - wpa or wpa2
 *   6. trustedRootCA
 *   7. innerEAP
 *   8. peapVersion
 */
int wfaStaSetPEAP(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEapPEAP_t* setPEAP = (caStaSetEapPEAP_t*)caCmdBuf;
  char* ifname = setPEAP->intf;
  char* ssid = setPEAP->ssid;
  dutCmdResponse_t* setPeapResp = &gGenericResp;

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_peap %s %s %s %s %s %s %i %s", ifname, ssid,
          setPEAP->username, setPEAP->passwd, setPEAP->trustedRootCA,
          setPEAP->encrptype, setPEAP->peapVersion, setPEAP->innerEAP);
  sret = systemWithLog(gCmdStr);
#else
  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setPeapResp, STATUS_ERROR, "unable to get network id");
  }

  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, ssid);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s eap PEAP", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s anonymous_identity '\"anonymous\"' ", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s identity '\"%s\"'", setCmd, setPEAP->username);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s password '\"%s\"'", setCmd, setPEAP->passwd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s ca_cert '\"%s/%s\"'", setCmd, CERTIFICATES_PATH,
          setPEAP->trustedRootCA);
  sret = systemWithLog(gCmdStr);

  if (strcasecmp(setPEAP->keyMgmtType, "wpa2-sha256") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-SHA256", setCmd);
  } else if (strcasecmp(setPEAP->keyMgmtType, "wpa2-eap") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setPEAP->keyMgmtType, "wpa2-ft") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-FT", setCmd);
  } else if (strcasecmp(setPEAP->keyMgmtType, "wpa") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setPEAP->keyMgmtType, "wpa2") == 0) {
    // take all and device to pick one which is supported.
  } else {
    // ??
  }
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s phase1 '\"peaplabel=%i\"'", setCmd,
          setPEAP->peapVersion);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s phase2 '\"auth=%s\"'", setCmd, setPEAP->innerEAP);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));
#endif

  setPeapResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_PEAP_RESP_TLV, 4, (BYTE*)setPeapResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaSetUAPSD()
 *    This is to set
 *    1. acBE
 *    2. acBK
 *    3. acVI
 *    4. acVO
 */
int wfaStaSetUAPSD(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* setUAPSDResp = &gGenericResp;
#if 0 /* used for only one specific device, need to update to reflect yours */
    caStaSetUAPSD_t *setUAPSD = (caStaSetUAPSD_t *)caCmdBuf;
    char *ifname = setUAPSD->intf;
    char tmpStr[10];
    char line[100];
    char *pathl="/etc/Wireless/RT61STA";
    BYTE acBE=1;
    BYTE acBK=1;
    BYTE acVO=1;
    BYTE acVI=1;
    BYTE APSDCapable;
    FILE *pipe;

    /*
     * A series of setting need to be done before doing WMM-PS
     * Additional steps of configuration may be needed.
     */

    /*
     * bring down the interface
     */
    sprintf(gCmdStr, "ifconfig %s down",ifname);
    sret = systemWithLog(gCmdStr);
    /*
     * Unload the Driver
     */
    sprintf(gCmdStr, "rmmod rt61");
    sret = systemWithLog(gCmdStr);
#ifndef WFA_WMM_AC
    if(setUAPSD->acBE != 1)
        acBE=setUAPSD->acBE = 0;
    if(setUAPSD->acBK != 1)
        acBK=setUAPSD->acBK = 0;
    if(setUAPSD->acVO != 1)
        acVO=setUAPSD->acVO = 0;
    if(setUAPSD->acVI != 1)
        acVI=setUAPSD->acVI = 0;
#else
    acBE=setUAPSD->acBE;
    acBK=setUAPSD->acBK;
    acVO=setUAPSD->acVO;
    acVI=setUAPSD->acVI;
#endif

    APSDCapable = acBE||acBK||acVO||acVI;
    /*
     * set other AC parameters
     */

    sprintf(tmpStr,"%d;%d;%d;%d",setUAPSD->acBE,setUAPSD->acBK,setUAPSD->acVI,setUAPSD->acVO);
    sprintf(gCmdStr, "sed -e \"s/APSDCapable=.*/APSDCapable=%d/g\" -e \"s/APSDAC=.*/APSDAC=%s/g\" %s/rt61sta.dat >/tmp/wfa_tmp",APSDCapable,tmpStr,pathl);
    sret = systemWithLog(gCmdStr);

    sprintf(gCmdStr, "mv /tmp/wfa_tmp %s/rt61sta.dat",pathl);
    sret = systemWithLog(gCmdStr);
    pipe = popen("uname -r", "r");
    /* Read into line the output of uname*/
    fscanf(pipe,"%s",line);
    pclose(pipe);

    /*
     * load the Driver
     */
    sprintf(gCmdStr, "insmod /lib/modules/%s/extra/rt61.ko",line);
    sret = systemWithLog(gCmdStr);

    sprintf(gCmdStr, "ifconfig %s up",ifname);
    sret = systemWithLog(gCmdStr);
#endif

  setUAPSDResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_UAPSD_RESP_TLV, 4, (BYTE*)setUAPSDResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}

int wfaDeviceGetInfo(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* dutCmd = (dutCommand_t*)caCmdBuf;
  caDevInfo_t* devInfo = &dutCmd->cmdsu.dev;
  dutCmdResponse_t* infoResp = &gGenericResp;
  /*a vendor can fill in the proper info or anything non-disclosure */
  caDeviceGetInfoResp_t dinfo = {"WFA Lab", "DemoUnit", WFA_SYSTEM_VER};

  DPRINT_INFO(WFA_OUT, "Entering wfaDeviceGetInfo ...\n");

  if (devInfo->fw == 0)
    memcpy(&infoResp->cmdru.devInfo, &dinfo, sizeof(caDeviceGetInfoResp_t));
  else {
    // Call internal API to pull the version ID */
    strncpy(infoResp->cmdru.devInfo.firmware, "NOVERSION", 15);
  }

  infoResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_DEVICE_GET_INFO_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/*
 * This funciton is to retrieve a list of interfaces and return
 * the list back to Agent control.
 * ********************************************************************
 * Note: We intend to make this WLAN interface name as a hardcode name.
 * Therefore, for a particular device, you should know and change the name
 * for that device while doing porting. The MACRO "WFA_STAUT_IF" is defined in
 * the file "inc/wfa_ca.h". If the device OS is not linux-like, this most
 * likely is hardcoded just for CAPI command responses.
 * *******************************************************************
 *
 */
int wfaDeviceListIF(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* infoResp = &gGenericResp;
  dutCommand_t* ifList = (dutCommand_t*)caCmdBuf;
  caDeviceListIFResp_t* ifListResp = &infoResp->cmdru.ifList;

  DPRINT_INFO(WFA_OUT, "Entering wfaDeviceListIF ...\n");

  switch (ifList->cmdsu.iftype) {
    case IF_80211:
      infoResp->status = STATUS_COMPLETE;
      ifListResp->iftype = IF_80211;
      strcpy(ifListResp->ifs[0], WFA_STAUT_IF);
      strcpy(ifListResp->ifs[1], "NULL");
      strcpy(ifListResp->ifs[2], "NULL");
      break;
    case IF_ETH:
      infoResp->status = STATUS_COMPLETE;
      ifListResp->iftype = IF_ETH;
      strcpy(ifListResp->ifs[0], "eth0");
      strcpy(ifListResp->ifs[1], "NULL");
      strcpy(ifListResp->ifs[2], "NULL");
      break;
    default: {
      infoResp->status = STATUS_ERROR;
      wfaEncodeTLV(WFA_DEVICE_LIST_IF_RESP_TLV, 4, (BYTE*)infoResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + 4;

      return WFA_SUCCESS;
    }
  }

  wfaEncodeTLV(WFA_DEVICE_LIST_IF_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

int wfaStaDebugSet(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* debugResp = &gGenericResp;
  dutCommand_t* debugSet = (dutCommand_t*)caCmdBuf;

  DPRINT_INFO(WFA_OUT, "Entering wfaStaDebugSet ...\n");

  if (debugSet->cmdsu.dbg.state == 1) /* enable */
    wfa_defined_debug |= debugSet->cmdsu.dbg.level;
  else
    wfa_defined_debug = (~debugSet->cmdsu.dbg.level & wfa_defined_debug);

  debugResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GET_INFO_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)debugResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/*
 *   wfaStaGetBSSID():
 *     This function is to retrieve BSSID of a specific wireless I/F.
 */
int wfaStaGetBSSID(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  char string[64];
  char* str;
  FILE* tmpfd;
  dutCmdResponse_t* bssidResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "Entering wfaStaGetBSSID ...\n");
  /* retrieve the BSSID */
  sprintf(gCmdStr, "wpa_cli.sh status > /tmp/bssid.txt");

  systemWithLog(gCmdStr);

  tmpfd = fopen("/tmp/bssid.txt", "r+");
  if (tmpfd == NULL) {
    bssidResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_GET_BSSID_RESP_TLV, 4, (BYTE*)bssidResp, respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;

    DPRINT_ERR(WFA_ERR, "file open failed\n");
    return WFA_FAILURE;
  }

  for (;;) {
    if (fscanf(tmpfd, "%s", string) == EOF) {
      bssidResp->status = STATUS_COMPLETE;
      strcpy(bssidResp->cmdru.bssid, "00:00:00:00:00:00");
      break;
    }

    if (strncmp(string, "bssid", 5) == 0) {
      str = strtok(string, "=");
      str = strtok(NULL, "=");
      if (str != NULL) {
        strcpy(bssidResp->cmdru.bssid, str);
        bssidResp->status = STATUS_COMPLETE;
        break;
      }
    }
  }

  wfaEncodeTLV(WFA_STA_GET_BSSID_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)bssidResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  fclose(tmpfd);
  return WFA_SUCCESS;
}

/*
 * wfaStaSetIBSS()
 *    This is to set
 *    1. ssid
 *    2. channel
 *    3. encrypType - none or wep
 *    optional
 *    4. key1
 *    5. key2
 *    6. key3
 *    7. key4
 *    8. activeIndex - 1, 2, 3, or 4
 */
int wfaStaSetIBSS(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetIBSS_t* setIBSS = (caStaSetIBSS_t*)caCmdBuf;
  dutCmdResponse_t* setIbssResp = &gGenericResp;

  char* ifname = setIBSS->intf;
  char* ssid = setIBSS->ssid;

  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setIbssResp, STATUS_ERROR, "unable to get network id");
  }

  // Disable the network first.
  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  // Set SSID.
  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, ssid);
  sret = systemWithLog(gCmdStr);

  // Set channel for IBSS.
  sprintf(gCmdStr, "iwconfig %s channel %i", setCmd, setIBSS->channel);
  sret = systemWithLog(gCmdStr);

  // Tell the supplicant for IBSS mode (1).
  sprintf(gCmdStr, "%s mode 1", setCmd);
  sret = systemWithLog(gCmdStr);

  // Set Key management to NONE (NO WPA) for plaintext or WEP.
  sprintf(gCmdStr, "%s key_mgmt NONE", setCmd);
  sret = systemWithLog(gCmdStr);

  int i;
  if (setIBSS->encpType == 1) {
    for (i = 0; i < 4; i++) {
      if (strlen(setIBSS->keys[i]) == 5 || strlen(setIBSS->keys[i]) == 13) {
        sprintf(gCmdStr, "%s wep_key%i \"%s\"", setCmd, i, setIBSS->keys[i]);
        sret = systemWithLog(gCmdStr);
      }
    }

    i = setIBSS->activeKeyIdx;
    if (strlen(setIBSS->keys[i]) == 5 || strlen(setIBSS->keys[i]) == 13) {
      sprintf(gCmdStr, "%s wep_tx_keyidx %i", setCmd, setIBSS->activeKeyIdx);
      sret = systemWithLog(gCmdStr);
    }
  }

  // Enable the network.
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));
  setIbssResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_IBSS_RESP_TLV, 4, (BYTE*)setIbssResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 *  wfaSetMode():
 *  The function is to set the wireless interface with a given mode (possible
 *  adhoc)
 *  Input parameters:
 *    1. I/F
 *    2. ssid
 *    3. mode adhoc or managed
 *    4. encType
 *    5. channel
 *    6. key(s)
 *    7. active  key
 */
int wfaStaSetMode(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetMode_t* setmode = (caStaSetMode_t*)caCmdBuf;
  dutCmdResponse_t* SetModeResp = &gGenericResp;
  int i;

  /*
     * bring down the interface
     */
  sprintf(gCmdStr, "ifconfig %s down", setmode->intf);
  sret = systemWithLog(gCmdStr);

  /*
     * distroy the interface
     */
  sprintf(gCmdStr, "wlanconfig %s destroy", setmode->intf);
  sret = systemWithLog(gCmdStr);

  /*
     * re-create the interface with the given mode
     */
  if (setmode->mode == 1)
    sprintf(gCmdStr, "wlanconfig %s create wlandev wifi0 wlanmode adhoc",
            setmode->intf);
  else
    sprintf(gCmdStr, "wlanconfig %s create wlandev wifi0 wlanmode managed",
            setmode->intf);

  sret = systemWithLog(gCmdStr);
  if (setmode->encpType == ENCRYPT_WEP) {
    int j = setmode->activeKeyIdx;
    for (i = 0; i < 4; i++) {
      if (setmode->keys[i][0] != '\0') {
        sprintf(gCmdStr, "iwconfig  %s key  s:%s", setmode->intf,
                setmode->keys[i]);
        sret = systemWithLog(gCmdStr);
      }
      /* set active key */
      if (setmode->keys[j][0] != '\0')
        sprintf(gCmdStr, "iwconfig  %s key  s:%s", setmode->intf,
                setmode->keys[j]);
      sret = systemWithLog(gCmdStr);
    }
  }
  /*
     * Set channel for IBSS
     */
  if (setmode->channel) {
    sprintf(gCmdStr, "iwconfig %s channel %i", setmode->intf, setmode->channel);
    sret = systemWithLog(gCmdStr);
  }

  /*
     * set SSID
     */
  sprintf(gCmdStr, "iwconfig %s essid %s", setmode->intf, setmode->ssid);
  sret = systemWithLog(gCmdStr);

  /*
     * bring up the interface
     */
  sprintf(gCmdStr, "ifconfig %s up", setmode->intf);
  sret = systemWithLog(gCmdStr);

  SetModeResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_MODE_RESP_TLV, 4, (BYTE*)SetModeResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSetPwrSave(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetPwrSave_t* setps = (caStaSetPwrSave_t*)caCmdBuf;
  dutCmdResponse_t* SetPSResp = &gGenericResp;

  sprintf(gCmdStr, "iwconfig %s power %s", setps->intf, setps->mode);
  sret = systemWithLog(gCmdStr);

  SetPSResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_PWRSAVE_RESP_TLV, 4, (BYTE*)SetPSResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaUpload(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaUpload_t* upload = &((dutCommand_t*)caCmdBuf)->cmdsu.upload;
  dutCmdResponse_t* upLoadResp = &gGenericResp;
  caStaUploadResp_t* upld = &upLoadResp->cmdru.uld;

  if (upload->type == WFA_UPLOAD_VHSO_RPT) {
    int rbytes;
    /*
         * if asked for the first packet, always to open the file
         */
    if (upload->next == 1) {
      if (e2efp != NULL) {
        fclose(e2efp);
        e2efp = NULL;
      }

      e2efp = fopen(e2eResults, "r");
    }

    if (e2efp == NULL) {
      upLoadResp->status = STATUS_ERROR;
      wfaEncodeTLV(WFA_STA_UPLOAD_RESP_TLV, 4, (BYTE*)upLoadResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + 4;
      return WFA_FAILURE;
    }

    rbytes = fread(upld->bytes, 1, 256, e2efp);

    if (rbytes < 256) {
      /*
             * this means no more bytes after this read
             */
      upld->seqnum = 0;
      fclose(e2efp);
      e2efp = NULL;
    } else {
      upld->seqnum = upload->next;
    }

    upld->nbytes = rbytes;

    upLoadResp->status = STATUS_COMPLETE;
    wfaEncodeTLV(WFA_STA_UPLOAD_RESP_TLV, sizeof(dutCmdResponse_t),
                 (BYTE*)upLoadResp, respBuf);
    *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
  } else {
    upLoadResp->status = STATUS_ERROR;
    wfaEncodeTLV(WFA_STA_UPLOAD_RESP_TLV, 4, (BYTE*)upLoadResp, respBuf);
    *respLen = WFA_TLV_HDR_LEN + 4;
  }

  return WFA_SUCCESS;
}
/*
 * wfaStaSetWMM()
 *  TO be ported on a specific plaform for the DUT
 *  This is to set the WMM related parameters at the DUT.
 *  Currently the function is used for GROUPS WMM-AC and WMM general configuration for setting RTS Threshhold, Fragmentation threshold and wmm (ON/OFF)
 *  It is expected that this function will set all the WMM related parametrs for a particular GROUP .
 */
int wfaStaSetWMM(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
#ifdef WFA_WMM_AC
  caStaSetWMM_t* setwmm = (caStaSetWMM_t*)caCmdBuf;
  char* ifname = setwmm->intf;
  dutCmdResponse_t* setwmmResp = &gGenericResp;

  switch (setwmm->group) {
    case GROUP_WMMAC:
      if (setwmm->send_trig) {
        int Sockfd;
        struct sockaddr_in psToAddr;
        unsigned int TxMsg[512];

        Sockfd = wfaCreateUDPSock(setwmm->dipaddr, 12346);
        memset(&psToAddr, 0, sizeof(psToAddr));
        psToAddr.sin_family = AF_INET;
        psToAddr.sin_addr.s_addr = inet_addr(setwmm->dipaddr);
        psToAddr.sin_port = htons(12346);

        switch (setwmm->trig_ac) {
          case WMMAC_AC_VO:
            wfaTGSetPrio(Sockfd, 7);
            create_apts_msg(APTS_CK_VO, TxMsg, 0);
            printf("\r\nSending AC_VO trigger packet\n");
            break;

          case WMMAC_AC_VI:
            wfaTGSetPrio(Sockfd, 5);
            create_apts_msg(APTS_CK_VI, TxMsg, 0);
            printf("\r\nSending AC_VI trigger packet\n");
            break;

          case WMMAC_AC_BK:
            wfaTGSetPrio(Sockfd, 2);
            create_apts_msg(APTS_CK_BK, TxMsg, 0);
            printf("\r\nSending AC_BK trigger packet\n");
            break;

          default:
          case WMMAC_AC_BE:
            wfaTGSetPrio(Sockfd, 0);
            create_apts_msg(APTS_CK_BE, TxMsg, 0);
            printf("\r\nSending AC_BE trigger packet\n");
            break;
        }

        sendto(Sockfd, TxMsg, 256, 0, (struct sockaddr*)&psToAddr,
               sizeof(struct sockaddr));
        close(Sockfd);
        usleep(1000000);
      } else if (setwmm->action == WMMAC_ADDTS) {
        printf(
            "ADDTS AC PARAMS: dialog id: %d, TID: %d, "
            "DIRECTION: %d, PSB: %d, UP: %d, INFOACK: %d BURST SIZE DEF: %d"
            "Fixed %d, MSDU Size: %d, Max MSDU Size %d, "
            "MIN SERVICE INTERVAL: %d, MAX SERVICE INTERVAL: %d, "
            "INACTIVITY: %d, SUSPENSION %d, SERVICE START TIME: %d, "
            "MIN DATARATE: %d, MEAN DATA RATE: %d, PEAK DATA RATE: %d, "
            "BURSTSIZE or MSDU Aggreg: %d, DELAY BOUND: %d, PHYRATE: %d, "
            "SPLUSBW: %f, "
            "MEDIUM TIME: %d, ACCESSCAT: %d\n",
            setwmm->actions.addts.dialog_token,
            setwmm->actions.addts.tspec.tsinfo.TID,
            setwmm->actions.addts.tspec.tsinfo.direction,
            setwmm->actions.addts.tspec.tsinfo.PSB,
            setwmm->actions.addts.tspec.tsinfo.UP,
            setwmm->actions.addts.tspec.tsinfo.infoAck,
            setwmm->actions.addts.tspec.tsinfo.bstSzDef,
            setwmm->actions.addts.tspec.Fixed, setwmm->actions.addts.tspec.size,
            setwmm->actions.addts.tspec.maxsize,
            setwmm->actions.addts.tspec.min_srvc,
            setwmm->actions.addts.tspec.max_srvc,
            setwmm->actions.addts.tspec.inactivity,
            setwmm->actions.addts.tspec.suspension,
            setwmm->actions.addts.tspec.srvc_strt_tim,
            setwmm->actions.addts.tspec.mindatarate,
            setwmm->actions.addts.tspec.meandatarate,
            setwmm->actions.addts.tspec.peakdatarate,
            setwmm->actions.addts.tspec.burstsize,
            setwmm->actions.addts.tspec.delaybound,
            setwmm->actions.addts.tspec.PHYrate,
            setwmm->actions.addts.tspec.sba,
            setwmm->actions.addts.tspec.medium_time,
            setwmm->actions.addts.accesscat);

        //tspec should be set here.

        sret = systemWithLog(gCmdStr);
      } else if (setwmm->action == WMMAC_DELTS) {
        // send del tspec
      }

      setwmmResp->status = STATUS_COMPLETE;
      break;

    case GROUP_WMMCONF:
      sprintf(gCmdStr, "iwconfig %s rts %d", ifname,
              setwmm->actions.config.rts_thr);

      sret = systemWithLog(gCmdStr);
      sprintf(gCmdStr, "iwconfig %s frag %d", ifname,
              setwmm->actions.config.frag_thr);

      sret = systemWithLog(gCmdStr);
      sprintf(gCmdStr, "iwpriv %s wmmcfg %d", ifname,
              setwmm->actions.config.wmm);

      sret = systemWithLog(gCmdStr);
      setwmmResp->status = STATUS_COMPLETE;
      break;

    default:
      DPRINT_ERR(WFA_ERR, "The group %d is not supported\n", setwmm->group);
      setwmmResp->status = STATUS_ERROR;
      break;
  }

  wfaEncodeTLV(WFA_STA_SET_WMM_RESP_TLV, 4, (BYTE*)setwmmResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
#endif

  return WFA_SUCCESS;
}

int wfaStaSendNeigReq(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* sendNeigReqResp = &gGenericResp;

  /*
     *  run your device to send NEIGREQ
     */

  sendNeigReqResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SEND_NEIGREQ_RESP_TLV, 4, (BYTE*)sendNeigReqResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSetEapFAST(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEapFAST_t* setFAST = (caStaSetEapFAST_t*)caCmdBuf;
  char* ifname = setFAST->intf;
  char* ssid = setFAST->ssid;
  dutCmdResponse_t* setEapFastResp = &gGenericResp;

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_eapfast %s %s %s %s %s %s", ifname, ssid,
          setFAST->username, setFAST->passwd, setFAST->pacFileName,
          setFAST->innerEAP);
  sret = systemWithLog(gCmdStr);
#else
  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEapFastResp, STATUS_ERROR,
                         "unable to get network id");
  }

  // Disable the network first.
  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, setFAST->ssid);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s identity '\"%s\"'", setCmd, setFAST->username);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s password '\"%s\"'", setCmd, setFAST->passwd);
  sret = systemWithLog(gCmdStr);

  if (strcasecmp(setFAST->keyMgmtType, "wpa2-sha256") == 0) {
  } else if (strcasecmp(setFAST->keyMgmtType, "wpa2-eap") == 0) {
  } else if (strcasecmp(setFAST->keyMgmtType, "wpa2-ft") == 0) {
  } else if (strcasecmp(setFAST->keyMgmtType, "wpa") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setFAST->keyMgmtType, "wpa2") == 0) {
    // take all and device to pick one which is supported.
  } else {
    // ??
  }
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s eap FAST", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s pac_file '\"%s/%s\"'", setCmd, CERTIFICATES_PATH,
          setFAST->pacFileName);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s anonymous_identity '\"anonymous\"'", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s phase1 '\"fast_provisioning=1\"'", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s phase2 '\"auth=%s\"'", setCmd, setFAST->innerEAP);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));
#endif

  setEapFastResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_EAPFAST_RESP_TLV, 4, (BYTE*)setEapFastResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSetEapAKA(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetEapAKA_t* setAKA = (caStaSetEapAKA_t*)caCmdBuf;
  char* ifname = setAKA->intf;
  char* ssid = setAKA->ssid;
  dutCmdResponse_t* setEapAkaResp = &gGenericResp;

#ifdef WFA_NEW_CLI_FORMAT
  sprintf(gCmdStr, "wfa_set_eapaka %s %s %s %s", ifname, ssid, setAKA->username,
          setAKA->passwd);
  sret = systemWithLog(gCmdStr);
#else
  int networkId = ensureNetworkId(ifname, ssid);
  if (networkId < 0) {
    RETURN_STA_CMD_ERROR(setEapAkaResp, STATUS_ERROR,
                         "unable to get network id");
  }

  // Disable the network first.
  char cmd[64];
  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "disable"));

  char setCmd[64];
  networkCmd(setCmd, ifname, networkId, "set");

  sprintf(gCmdStr, "%s ssid '\"%s\"'", setCmd, setAKA->ssid);
  sret = systemWithLog(gCmdStr);

  if (strcasecmp(setAKA->keyMgmtType, "wpa2-sha256") == 0) {
  } else if (strcasecmp(setAKA->keyMgmtType, "wpa2-eap") == 0) {
  } else if (strcasecmp(setAKA->keyMgmtType, "wpa2-ft") == 0) {
  } else if (strcasecmp(setAKA->keyMgmtType, "wpa") == 0) {
    sprintf(gCmdStr, "%s key_mgmt WPA-EAP", setCmd);
  } else if (strcasecmp(setAKA->keyMgmtType, "wpa2") == 0) {
    // take all and device to pick one which is supported.
  } else {
    // ??
  }
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s proto WPA2", setCmd);
  sret = systemWithLog(gCmdStr);
  sprintf(gCmdStr, "%s proto CCMP", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s eap AKA", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s phase1 \"result_ind=1\"", setCmd);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s identity '\"%s\"'", setCmd, setAKA->username);
  sret = systemWithLog(gCmdStr);

  sprintf(gCmdStr, "%s password '\"%s\"'", setCmd, setAKA->passwd);
  sret = systemWithLog(gCmdStr);

  sret = systemWithLog(networkCmd(cmd, ifname, networkId, "enable"));
#endif

  setEapAkaResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_EAPAKA_RESP_TLV, 4, (BYTE*)setEapAkaResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSetSystime(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetSystime_t* systime = (caStaSetSystime_t*)caCmdBuf;
  dutCmdResponse_t* setSystimeResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "Entering wfaStaSetSystime ...\n");

  sprintf(gCmdStr, "date %02d%02d%02d%02d%04d.%02d", systime->month,
          systime->date, systime->hours, systime->minutes, systime->year,
          systime->seconds);
  sret = systemWithLog(gCmdStr);
  if (sret != 0) {
    RETURN_STA_CMD_ERROR(setSystimeResp, STATUS_ERROR,
                         "error running date command, exit code: %d\n", sret);
  }

  setSystimeResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_SYSTIME_RESP_TLV, 4, (BYTE*)setSystimeResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

#ifdef WFA_STA_TB
int wfaStaPresetParams(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* PresetParamsResp = &gGenericResp;
  caStaPresetParameters_t* presetParams = (caStaPresetParameters_t*)caCmdBuf;
  BYTE presetDone = 1;
  int st = 0;
  char cmdStr[128];
  char string[256];
  FILE* tmpfd = NULL;
  long val;
  char* endptr;

  DPRINT_INFO(WFA_OUT, "Inside wfaStaPresetParameters function ...\n");

  if (presetParams->supplicant == eWpaSupplicant) {
    st = access("/tmp/processid.txt", F_OK);
    if (st != -1) {
      st = remove("/tmp/processid.txt");
    }

    sprintf(cmdStr, "/usr/local/sbin/findprocess.sh %s /tmp/processid.txt\n",
            "wpa_supplicant");
    st = systemWithLog(cmdStr);

    tmpfd = fopen("/tmp/processid.txt", "r+");
    if (tmpfd == NULL) {
      DPRINT_ERR(WFA_ERR, "process id file not exist\n");
      return WFA_FAILURE;
    }

    for (;;) {
      if (fgets(string, 256, tmpfd) == NULL)
        break;

      errno = 0;
      val = strtol(string, &endptr, 10);
      if (errno != 0 && val == 0) {
        DPRINT_ERR(WFA_ERR, "strtol error\n");
        return WFA_FAILURE;
      }

      if (endptr == string) {
        DPRINT_ERR(WFA_ERR, "No wpa_supplicant instance was found\n");
      }

      presetDone = 1;
    }
  }

  if (presetParams->wmmFlag) {
    st = wfaExecuteCLI(gCmdStr);
    switch (st) {
      case 0:
        presetDone = 1;
        break;
      case 1:
        presetDone = 0;
        break;
      case 2:
        presetDone = 0;
        break;
    }
  }

  if (presetParams->modeFlag != 0) {
    switch (presetParams->wirelessMode) {
      default:
        printf("other mode does not need to support\n");
    }

    st = wfaExecuteCLI(gCmdStr);
    switch (st) {
      case 0:
        presetDone = 1;
        break;
      case 1:
        presetDone = 0;
      case 2:
        presetDone = 0;
        break;
    }
  }

  if (presetParams->psFlag) {
    printf("%s\n", gCmdStr);
    sret = systemWithLog(gCmdStr);
  }

  /************the followings are used for Voice Enterprise **************/
  if (presetParams->program == PROG_TYPE_VENT) {
    if (presetParams->ftoa == eEnable) {
      // enable Fast BSS Transition Over the Air
    } else {
      // disable Fast BSS Transition Over the Air
    }

    if (presetParams->ftds == eEnable) {
      // enable Fast BSS Transition Over the DS
    } else {
      // disable Fast BSS Transition Over the DS
    }

    if (presetParams->activescan == eEnable) {
      // Enable Active Scan on STA
    } else {
      // disable Active Scan on STA
    }
  }

  /************the followings are used for Wi-Fi Display *************/
  if (presetParams->program == PROG_TYPE_WFD) {
    if (presetParams->tdlsFlag) {
      // enable / disable tdls based on tdls
    }
    if (presetParams->wfdDevTypeFlag) {
      // set WFD device type to source/sink/dual based on wfdDevType
    }
    if (presetParams->wfdUibcGenFlag) {
      // enable / disable the feature
    }
    if (presetParams->wfdUibcHidFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdUiInputFlag) {
      // set the UI input as mentioned
    }
    if (presetParams->wfdHdcpFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdFrameSkipFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdAvChangeFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdStandByFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdInVideoFlag) {
      // select the input vide as protecteed or non-protetcted or protected audio
      // or unprotected audio etc.
    }

    if (presetParams->wfdVideoFmatFlag) {
      // set the video format as requested

      //switch(presetParams->wfdVideoFmt )
      //{
      // case e640x480p60:
      //   ;
      // default:
      // set the mandatory
      // }
    }
    if (presetParams->wfdAudioFmatFlag) {
      // set the Audio format as requested

      //switch(presetParams->wfdAudioFmt )
      //{
      // case eMandatoryAudioMode:
      //	;
      // case eDefaultAudioMode:
      //  ;

      // default:
      // set the mandatory
      // }
    }

    if (presetParams->wfdI2cFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdVideoRecoveryFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdPrefDisplayFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdServiceDiscoveryFlag) {
      // enable / disable feature
    }
    if (presetParams->wfd3dVideoFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdMultiTxStreamFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdTimeSyncFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdEDIDFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdUIBCPrepareFlag) {
      // Provdes information to start valid WFD session to check UIBC operation.
    }
    if (presetParams->wfdCoupledCapFlag) {
      // enable / disable feature
    }
    if (presetParams->wfdOptionalFeatureFlag) {
      // disable all program specific optional features
    }
    if (presetParams->wfdSessionAvailFlag) {
      // enable / disable session available bit
    }
    if (presetParams->wfdDeviceDiscoverabilityFlag) {
      // enable / disable feature
    }
  }

  if (presetParams->program == PROG_TYPE_WFDS) {
    if (presetParams->wfdsType == eAcceptPD) {
      // preset to accept PD request
      if (presetParams->wfdsConnectionCapabilityFlag == 1) {
        // use  presetParams->wfdsConnectionCapability and set role accordingly
      }
    }
    if (presetParams->wfdsType == eRejectPD) {
      // preset to Reject PD request
    }
    if (presetParams->wfdsType == eIgnorePD) {
      // preset to Ignore PD request
    }
    if (presetParams->wfdsType == eRejectSession) {
      // preset to reject Session request
    }
  }

  if (presetDone) {
    PresetParamsResp->status = STATUS_COMPLETE;
  } else {
    PresetParamsResp->status = STATUS_INVALID;
  }

  wfaEncodeTLV(WFA_STA_PRESET_PARAMETERS_RESP_TLV, 4, (BYTE*)PresetParamsResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSet11n(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* v11nParamsResp = &gGenericResp;

  v11nParamsResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, 4, (BYTE*)v11nParamsResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}
int wfaStaSetWireless(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* staWirelessResp = &gGenericResp;

  staWirelessResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_WIRELESS_RESP_TLV, 4, (BYTE*)staWirelessResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}

int wfaStaSendADDBA(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* staSendADDBAResp = &gGenericResp;

  wfaEncodeTLV(WFA_STA_SET_SEND_ADDBA_RESP_TLV, 4, (BYTE*)staSendADDBAResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}

int wfaStaSetRIFS(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* staSetRIFSResp = &gGenericResp;

  wfaEncodeTLV(WFA_STA_SET_RIFS_TEST_RESP_TLV, 4, (BYTE*)staSetRIFSResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaSendCoExistMGMT(int len,
                          BYTE* caCmdBuf,
                          int* respLen,
                          BYTE* respBuf) {
  dutCmdResponse_t* staSendMGMTResp = &gGenericResp;

  wfaEncodeTLV(WFA_STA_SEND_COEXIST_MGMT_RESP_TLV, 4, (BYTE*)staSendMGMTResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaResetDefault(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaResetDefault_t* reset = (caStaResetDefault_t*)caCmdBuf;
  dutCmdResponse_t* ResetResp = &gGenericResp;

  // need to make your own command available for this, here is only an example
  sprintf(gCmdStr, "myresetdefault %s program %s", reset->intf, reset->prog);
  sret = systemWithLog(gCmdStr);

  ResetResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_RESET_DEFAULT_RESP_TLV, 4, (BYTE*)ResetResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

#else

int wfaStaSetRIFS(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  caStaSetRIFS_t* setRifs = (caStaSetRIFS_t*)caCmdBuf;
  dutCmdResponse_t* staSetRIFSResp = &gGenericResp;

  DPRINT_INFO(WFA_OUT, "entering wfaStaSetRIFS ...\n");
  DPRINT_INFO(WFA_OUT, "%s %d\n", setRifs->intf, setRifs->action);

  if (setRifs->action) {
    DPRINT_INFO(WFA_WNG,
                "command sta_set_rifs_test is deprecated and not implemented "
                "for action=enable\n");

    staSetRIFSResp->status = STATUS_INVALID;
    wfaEncodeTLV(WFA_STA_SET_RIFS_TEST_RESP_TLV, sizeof(staSetRIFSResp->status),
                 (BYTE*)staSetRIFSResp, respBuf);
    *respLen = WFA_TLV_HDR_LEN + sizeof(staSetRIFSResp->status);

    return WFA_FAILURE;
  }

  DPRINT_INFO(WFA_WNG,
              "command sta_set_rifs_test is deprecated and will be ignored for "
              "action=disable\n");

  staSetRIFSResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_RIFS_TEST_RESP_TLV, sizeof(staSetRIFSResp->status),
               (BYTE*)staSetRIFSResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(staSetRIFSResp->status);

  return WFA_SUCCESS;
}

int wfaStaTestBedCmd(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* staCmdResp = &gGenericResp;

  wfaEncodeTLV(WFA_STA_DISCONNECT_RESP_TLV, 4, (BYTE*)staCmdResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}
#endif

/*
 * This is used to send a frame or action frame
 */
int wfaStaDevSendFrame(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* cmd = (dutCommand_t*)caCmdBuf;
  /* uncomment it if needed */
  // char *ifname = cmd->intf;
  dutCmdResponse_t* devSendResp = &gGenericResp;
  caStaDevSendFrame_t* sf = &cmd->cmdsu.sf;

  DPRINT_INFO(WFA_OUT, "Inside wfaStaDevSendFrame function ...\n");
  /* processing the frame */

  switch (sf->program) {
    case PROG_TYPE_PMF: {
      pmfFrame_t* pmf = &sf->frameType.pmf;
      switch (pmf->eFrameName) {
        case PMF_TYPE_DISASSOC: {
          /* use the protected to set what type of key to send */

        } break;
        case PMF_TYPE_DEAUTH: {
        } break;
        case PMF_TYPE_SAQUERY: {
        } break;
        case PMF_TYPE_AUTH: {
        } break;
        case PMF_TYPE_ASSOCREQ: {
        } break;
        case PMF_TYPE_REASSOCREQ: {
        } break;
      }
    } break;
    case PROG_TYPE_TDLS: {
      tdlsFrame_t* tdls = &sf->frameType.tdls;
      switch (tdls->eFrameName) {
        case TDLS_TYPE_DISCOVERY:
          /* use the peer mac address to send the frame */
          break;
        case TDLS_TYPE_SETUP:
          break;
        case TDLS_TYPE_TEARDOWN:
          break;
        case TDLS_TYPE_CHANNELSWITCH:
          break;
        case TDLS_TYPE_NULLFRAME:
          break;
      }
    } break;
    case PROG_TYPE_VENT: {
      ventFrame_t* vent = &sf->frameType.vent;
      switch (vent->type) {
        case VENT_TYPE_NEIGREQ:
          break;
        case VENT_TYPE_TRANSMGMT:
          break;
      }
    } break;
    case PROG_TYPE_WFD: {
      wfdFrame_t* wfd = &sf->frameType.wfd;
      switch (wfd->eframe) {
        case WFD_FRAME_PRBREQ: {
          /* send probe req */
        } break;

        case WFD_FRAME_PRBREQ_TDLS_REQ: {
          /* send tunneled tdls probe req  */
        } break;

        case WFD_FRAME_11V_TIMING_MSR_REQ: {
          /* send 11v timing mearurement request */
        } break;

        case WFD_FRAME_RTSP: {
          /* send WFD RTSP messages*/
          // fetch the type of RTSP message and send it.
          switch (wfd->eRtspMsgType) {
            case WFD_RTSP_PAUSE:
              break;
            case WFD_RTSP_PLAY:
              //send RTSP PLAY
              break;
            case WFD_RTSP_TEARDOWN:
              //send RTSP TEARDOWN
              break;
            case WFD_RTSP_TRIG_PAUSE:
              //send RTSP TRIGGER PAUSE
              break;
            case WFD_RTSP_TRIG_PLAY:
              //send RTSP TRIGGER PLAY
              break;
            case WFD_RTSP_TRIG_TEARDOWN:
              //send RTSP TRIGGER TEARDOWN
              break;
            case WFD_RTSP_SET_PARAMETER:
              //send RTSP SET PARAMETER
              if (wfd->eSetParams == WFD_CAP_UIBC_KEYBOARD) {
                //send RTSP SET PARAMETER message for UIBC keyboard
              }
              if (wfd->eSetParams == WFD_CAP_UIBC_MOUSE) {
                //send RTSP SET PARAMETER message for UIBC Mouse
              } else if (wfd->eSetParams == WFD_CAP_RE_NEGO) {
                //send RTSP SET PARAMETER message Capability re-negotiation
              } else if (wfd->eSetParams == WFD_STANDBY) {
                //send RTSP SET PARAMETER message for standby
              } else if (wfd->eSetParams == WFD_UIBC_SETTINGS_ENABLE) {
                //send RTSP SET PARAMETER message for UIBC settings enable
              } else if (wfd->eSetParams == WFD_UIBC_SETTINGS_DISABLE) {
                //send RTSP SET PARAMETER message for UIBC settings disable
              } else if (wfd->eSetParams == WFD_ROUTE_AUDIO) {
                //send RTSP SET PARAMETER message for route audio
              } else if (wfd->eSetParams == WFD_3D_VIDEOPARAM) {
                //send RTSP SET PARAMETER message for 3D video parameters
              } else if (wfd->eSetParams == WFD_2D_VIDEOPARAM) {
                //send RTSP SET PARAMETER message for 2D video parameters
              }
              break;
          }
        } break;
      }
    } break;
    /* not need to support HS2 release 1, due to very short time period  */
    case PROG_TYPE_HS2_R2: {
      /* type of frames */
      hs2Frame_t* hs2 = &sf->frameType.hs2_r2;
      switch (hs2->eframe) {
        case HS2_FRAME_ANQPQuery: {
        } break;
        case HS2_FRAME_DLSRequest: {
        } break;
        case HS2_FRAME_GARPReq: {
        } break;
        case HS2_FRAME_GARPRes: {
        } break;
        case HS2_FRAME_NeighAdv: {
        }
        case HS2_FRAME_ARPProbe: {
        }
        case HS2_FRAME_ARPAnnounce: {
        } break;
        case HS2_FRAME_NeighSolicitReq: {
        } break;
        case HS2_FRAME_ARPReply: {
        } break;
      }

    } /*  PROG_TYPE_HS2-R2  */
    case PROG_TYPE_GEN: {
      /* General frames */
    }
  }
  devSendResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_DEV_SEND_FRAME_RESP_TLV, 4, (BYTE*)devSendResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * This is used to set a temporary MAC address of an interface
 */
int wfaStaSetMacAddr(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  // Uncomment it if needed
  //dutCommand_t *cmd = (dutCommand_t *)caCmdBuf;
  // char *ifname = cmd->intf;
  dutCmdResponse_t* staCmdResp = &gGenericResp;
  // Uncomment it if needed
  //char *macaddr = &cmd->cmdsu.macaddr[0];

  wfaEncodeTLV(WFA_STA_SET_MAC_ADDRESS_RESP_TLV, 4, (BYTE*)staCmdResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

int wfaStaDisconnect(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* cmd = (dutCommand_t*)caCmdBuf;
  char* ifname = cmd->intf;
  char string[64];
  char* token;
  FILE* tmpfd;
  dutCmdResponse_t* staDiscResp = &gGenericResp;
  uint32_t networkId;
  const char* tmpfile = "/tmp/.wfaStaDisconnectTmp";

  DPRINT_INFO(WFA_OUT, "Entering wfaStaDisconnect ...\n");
  // Retrieve the network id.
  sprintf(gCmdStr, "wpa_cli.sh status > %s", tmpfile);
  sret = systemWithLog(gCmdStr);
  if (sret != 0) {
    RETURN_STA_CMD_ERROR(staDiscResp, STATUS_ERROR,
                         "error getting wpa_supplicant status: %d\n", sret);
  }

  tmpfd = fopen(tmpfile, "r+");
  if (tmpfd == NULL) {
    RETURN_STA_CMD_ERROR(staDiscResp, STATUS_ERROR, "temp file open failed\n");
  }

  networkId = -1;
  for (;;) {
    if (fgets(string, sizeof(string), tmpfd) == NULL) {
      break;
    }

    if (strncmp(string, "id", 2) == 0) {
      token = strtok(string, "=");
      token = strtok(NULL, "=");
      if (token != NULL) {
        networkId = atoi(token);
        break;
      }
    }
  }
  fclose(tmpfd);

  if (networkId != -1) {
    sprintf(gCmdStr, "wpa_cli.sh -i %s disable_network %d > %s", ifname,
            networkId, tmpfile);
    sret = systemWithLog(gCmdStr);
    if (sret != 0) {
      RETURN_STA_CMD_ERROR(staDiscResp, STATUS_ERROR,
                           "error disabling network: %d\n", sret);
    }

    if (!readLine(tmpfile, string, sizeof(string))) {
      RETURN_STA_CMD_ERROR(staDiscResp, STATUS_ERROR,
                           "unable to read command output\n");
    }

    if (strcmp(string, "OK") != 0) {
      RETURN_STA_CMD_ERROR(staDiscResp, STATUS_ERROR,
                           "disable network failed, error: %s\n", string);
    }
  } else {
    DPRINT_INFO(WFA_OUT, "No network connected\n");
  }

  staDiscResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_DISCONNECT_RESP_TLV, sizeof(dutCmdResponse_t),
               (BYTE*)staDiscResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);

  return WFA_SUCCESS;
}

/* Execute CLI, read the status from Environment variable */
int wfaExecuteCLI(char* CLI) {
  char* retstr;

  sret = systemWithLog(CLI);

  retstr = getenv("WFA_CLI_STATUS");
  printf("cli status %s\n", retstr);
  return atoi(retstr);
}

/* Supporting Functions */

void wfaSendPing(tgPingStart_t* staPing, float* interval, int streamid) {
  int totalpkts, tos = -1;
  char cmdStr[256];
//    char *addr = staPing->dipaddr;
#ifdef WFA_PC_CONSOLE
  char addr[40];
  char bflag[] = "-b";
  char* tmpstr;
  int inum = 0;
#else
  char bflag[] = "  ";
#endif

  totalpkts = (int)(staPing->duration * staPing->frameRate);

#ifdef WFA_PC_CONSOLE

  printf("\nwfa_cs.c wfaSendPing CS : The Stream ID is %d", streamid);

  strcpy(addr, staPing->dipaddr);
  printf("\nCS :the addr is %s ", addr);
  printf("\nCS :Inside the WFA_PC_CONSLE BLOCK");
  printf("\nCS :the addr is %s ", addr);
  if (staPing->iptype == 2) {
    memset(bflag, 0, strlen(bflag));
  } else {
    tmpstr = strtok(addr, ".");
    inum = atoi(tmpstr);

    printf("interval %f\n", *interval);

    if (inum >= 224 && inum <= 239)  // multicast
    {
    } else  // if not MC, check if it is BC address
    {
      printf("\nCS :Inside the BC address BLOCK");
      printf("\nCS :the inum %d", inum);
      strtok(NULL, ".");
      //strtok(NULL, ".");
      tmpstr = strtok(NULL, ".");
      printf("tmpstr %s\n", tmpstr);
      inum = atoi(tmpstr);
      printf("\nCS : The string is %s", tmpstr);
      if (inum != 255)
        memset(bflag, 0, strlen(bflag));
    }
  }
#endif
  if (staPing->dscp >= 0) {
    tos = convertDscpToTos(staPing->dscp);
    if (tos < 0)
      printf("\nwfaSendPing invalid tos converted, dscp=%d", staPing->dscp);
  }
  printf("\nwfa_cs.c wfaSendPing : The Stream ID=%d IPtype=%i\n", streamid,
         staPing->iptype);
  printf("IPtype : %i  tos=%d", staPing->iptype, tos);

  if (staPing->iptype == 2) {
    if (tos > 0)
      sprintf(cmdStr,
              "echo streamid=%i > /tmp/spout_%d.txt;wfaping6.sh %s %s -i %f -c "
              "%i -Q %d -s %i -q >> /tmp/spout_%d.txt 2>/dev/null",
              streamid, streamid, bflag, staPing->dipaddr, *interval, totalpkts,
              tos, staPing->frameSize, streamid);
    else
      sprintf(cmdStr,
              "echo streamid=%i > /tmp/spout_%d.txt;wfaping6.sh %s %s -i %f -c "
              "%i -s %i -q >> /tmp/spout_%d.txt 2>/dev/null",
              streamid, streamid, bflag, staPing->dipaddr, *interval, totalpkts,
              staPing->frameSize, streamid);
    sret = systemWithLog(cmdStr);
    printf("\nCS : The command string is %s", cmdStr);
  } else {
    if (tos > 0)
      sprintf(cmdStr,
              "echo streamid=%i > /tmp/spout_%d.txt;wfaping.sh %s %s -i %f -c "
              "%i  -Q %d -s %i -q >> /tmp/spout_%d.txt 2>/dev/null",
              streamid, streamid, bflag, staPing->dipaddr, *interval, totalpkts,
              tos, staPing->frameSize, streamid);
    else
      sprintf(cmdStr,
              "echo streamid=%i > /tmp/spout_%d.txt;wfaping.sh %s %s -i %f -c "
              "%i -s %i -q >> /tmp/spout_%d.txt 2>/dev/null",
              streamid, streamid, bflag, staPing->dipaddr, *interval, totalpkts,
              staPing->frameSize, streamid);
    sret = systemWithLog(cmdStr);
    printf("\nCS : The command string is %s", cmdStr);
  }
  sprintf(cmdStr, "updatepid.sh /tmp/spout_%d.txt", streamid);
  sret = systemWithLog(cmdStr);
  printf("\nCS : The command string is %s", cmdStr);
}

int wfaStopPing(dutCmdResponse_t* stpResp, int streamid) {
  char strout[256];
  FILE* tmpfile = NULL;
  char cmdStr[128];
  printf("\nwfa_cs.c wfaStopPing:: stream id=%d\n", streamid);
  sprintf(cmdStr, "getpid.sh /tmp/spout_%d.txt /tmp/pid.txt", streamid);
  sret = systemWithLog(cmdStr);

  printf("\nCS : The command string is %s", cmdStr);

  sret = systemWithLog("stoping.sh /tmp/pid.txt ; sleep 2");

  sprintf(cmdStr, "getpstats.sh /tmp/spout_%d.txt", streamid);
  sret = systemWithLog(cmdStr);

  printf("\nCS : The command string is %s", cmdStr);

  tmpfile = fopen("/tmp/stpsta.txt", "r+");

  if (tmpfile == NULL) {
    return WFA_FAILURE;
  }

  if (fscanf(tmpfile, "%s", strout) != EOF) {
    if (*strout == '\0') {
      stpResp->cmdru.pingStp.sendCnt = 0;
    }

    else
      stpResp->cmdru.pingStp.sendCnt = atoi(strout);
  }

  printf("\nwfaStopPing after scan sent count %i\n",
         stpResp->cmdru.pingStp.sendCnt);

  if (fscanf(tmpfile, "%s", strout) != EOF) {
    if (*strout == '\0') {
      stpResp->cmdru.pingStp.repliedCnt = 0;
    } else
      stpResp->cmdru.pingStp.repliedCnt = atoi(strout);
  }
  printf("wfaStopPing after scan replied count %i\n",
         stpResp->cmdru.pingStp.repliedCnt);

  fclose(tmpfile);

  return WFA_SUCCESS;
}

/*
 * wfaStaGetP2pDevAddress():
 */
int wfaStaGetP2pDevAddress(int len,
                           BYTE* caCmdBuf,
                           int* respLen,
                           BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* dutCommand_t *getInfo = (dutCommand_t *)caCmdBuf; */

  printf("\n Entry wfaStaGetP2pDevAddress... ");

  // Fetch the device ID and store into infoResp->cmdru.devid
  //strcpy(infoResp->cmdru.devid, str);
  strcpy(&infoResp.cmdru.devid[0], "ABCDEFGH");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_GET_DEV_ADDRESS_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSetP2p():
 */
int wfaStaSetP2p(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaSetP2p_t *getStaSetP2p = (caStaSetP2p_t *)caCmdBuf; uncomment and use it*/

  printf("\n Entry wfaStaSetP2p... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SETP2P_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}
/*
 * wfaStaP2pConnect():
 */
int wfaStaP2pConnect(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaP2pConnect_t *getStaP2pConnect = (caStaP2pConnect_t *)caCmdBuf; uncomment and use it */

  printf("\n Entry wfaStaP2pConnect... ");

  // Implement the function and does not return anything.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_CONNECT_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaStartAutoGo():
 */
int wfaStaStartAutoGo(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  //caStaStartAutoGo_t *getStaStartAutoGo = (caStaStartAutoGo_t *)caCmdBuf;

  printf("\n Entry wfaStaStartAutoGo... ");

  // Fetch the group ID and store into 	infoResp->cmdru.grpid
  strcpy(&infoResp.cmdru.grpid[0], "ABCDEFGH");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_START_AUTO_GO_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaP2pStartGrpFormation():
 */
int wfaStaP2pStartGrpFormation(int len,
                               BYTE* caCmdBuf,
                               int* respLen,
                               BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  printf("\n Entry wfaStaP2pStartGrpFormation... ");

  strcpy(infoResp.cmdru.grpFormInfo.result, "CLIENT");
  strcpy(infoResp.cmdru.grpFormInfo.grpId, "AA:BB:CC:DD:EE:FF_DIRECT-SSID");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_START_GRP_FORMATION_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaP2pDissolve():
 */
int wfaStaP2pDissolve(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  printf("\n Entry wfaStaP2pDissolve... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_DISSOLVE_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSendP2pInvReq():
 */
int wfaStaSendP2pInvReq(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaSendP2pInvReq_t *getStaP2pInvReq= (caStaSendP2pInvReq_t *)caCmdBuf; */

  printf("\n Entry wfaStaSendP2pInvReq... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SEND_INV_REQ_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaAcceptP2pInvReq():
 */
int wfaStaAcceptP2pInvReq(int len,
                          BYTE* caCmdBuf,
                          int* respLen,
                          BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* uncomment and use it
     * caStaAcceptP2pInvReq_t *getStaP2pInvReq= (caStaAcceptP2pInvReq_t *)caCmdBuf;
     */

  printf("\n Entry wfaStaAcceptP2pInvReq... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_ACCEPT_INV_REQ_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSendP2pProvDisReq():
 */
int wfaStaSendP2pProvDisReq(int len,
                            BYTE* caCmdBuf,
                            int* respLen,
                            BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* uncomment and use it
     * caStaSendP2pProvDisReq_t *getStaP2pProvDisReq= (caStaSendP2pProvDisReq_t *)caCmdBuf;
     */

  printf("\n Entry wfaStaSendP2pProvDisReq... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SEND_PROV_DIS_REQ_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSetWpsPbc():
 */
int wfaStaSetWpsPbc(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* uncomment and use it
     * caStaSetWpsPbc_t *getStaSetWpsPbc= (caStaSetWpsPbc_t *)caCmdBuf;
     */

  printf("\n Entry wfaStaSetWpsPbc... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_WPS_SETWPS_PBC_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaWpsReadPin():
 */
int wfaStaWpsReadPin(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* uncomment and use it
     * caStaWpsReadPin_t *getStaWpsReadPin= (caStaWpsReadPin_t *)caCmdBuf;
     */

  printf("\n Entry wfaStaWpsReadPin... ");

  // Fetch the device PIN and put in 	infoResp->cmdru.wpsPin
  //strcpy(infoResp->cmdru.wpsPin, "12345678");
  strcpy(&infoResp.cmdru.wpsPin[0], "1234456");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_WPS_READ_PIN_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaWpsReadLabel():
 */
int wfaStaWpsReadLabel(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  printf("\n Entry wfaStaWpsReadLabel... ");

  // Fetch the device Label and put in	infoResp->cmdru.wpsPin
  //strcpy(infoResp->cmdru.wpsPin, "12345678");
  strcpy(&infoResp.cmdru.wpsPin[0], "1234456");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_WPS_READ_PIN_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaWpsEnterPin():
 */
int wfaStaWpsEnterPin(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* uncomment and use it
     * caStaWpsEnterPin_t *getStaWpsEnterPin= (caStaWpsEnterPin_t *)caCmdBuf;
     */

  printf("\n Entry wfaStaWpsEnterPin... ");

  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_WPS_ENTER_PIN_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaGetPsk():
 */
int wfaStaGetPsk(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaGetPsk_t *getStaGetPsk= (caStaGetPsk_t *)caCmdBuf; uncomment and use it */

  printf("\n Entry wfaStaGetPsk... ");

  // Fetch the device PP and SSID  and put in 	infoResp->cmdru.pskInfo
  strcpy(&infoResp.cmdru.pskInfo.passPhrase[0], "1234456");
  strcpy(&infoResp.cmdru.pskInfo.ssid[0], "WIFI_DIRECT");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_GET_PSK_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaP2pReset():
 */
int wfaStaP2pReset(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* dutCommand_t *getStaP2pReset= (dutCommand_t *)caCmdBuf; */

  printf("\n Entry wfaStaP2pReset... ");
  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_RESET_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaGetP2pIpConfig():
 */
int wfaStaGetP2pIpConfig(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaGetP2pIpConfig_t *staGetP2pIpConfig= (caStaGetP2pIpConfig_t *)caCmdBuf; */

  caStaGetIpConfigResp_t* ifinfo = &(infoResp.cmdru.getIfconfig);

  printf("\n Entry wfaStaGetP2pIpConfig... ");

  ifinfo->isDhcp = 0;
  strcpy(&(ifinfo->ipaddr[0]), "192.165.100.111");
  strcpy(&(ifinfo->mask[0]), "255.255.255.0");
  strcpy(&(ifinfo->dns[0][0]), "192.165.100.1");
  strcpy(&(ifinfo->mac[0]), "ba:ba:ba:ba:ba:ba");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_GET_IP_CONFIG_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSendServiceDiscoveryReq():
 */
int wfaStaSendServiceDiscoveryReq(int len,
                                  BYTE* caCmdBuf,
                                  int* respLen,
                                  BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  printf("\n Entry wfaStaSendServiceDiscoveryReq... ");
  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SEND_SERVICE_DISCOVERY_REQ_RESP_TLV,
               sizeof(infoResp), (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSendP2pPresenceReq():
 */
int wfaStaSendP2pPresenceReq(int len,
                             BYTE* caCmdBuf,
                             int* respLen,
                             BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SEND_PRESENCE_REQ_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSetSleepReq():
 */
int wfaStaSetSleepReq(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaSetSleep_t *staSetSleepReq= (caStaSetSleep_t *)caCmdBuf; */

  printf("\n Entry wfaStaSetSleepReq... ");
  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SET_SLEEP_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaSetOpportunisticPsReq():
 */
int wfaStaSetOpportunisticPsReq(int len,
                                BYTE* caCmdBuf,
                                int* respLen,
                                BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  printf("\n Entry wfaStaSetOpportunisticPsReq... ");
  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_SET_OPPORTUNISTIC_PS_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}
#ifndef WFA_STA_TB
/*
 * wfaStaPresetParams():
 */

int wfaStaPresetParams(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;

  DPRINT_INFO(WFA_WNG, "command sta_preset_testparameters will be ignored\n");

  infoResp.status = STATUS_COMPLETE;

  wfaEncodeTLV(WFA_STA_PRESET_PARAMETERS_RESP_TLV, 4, (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}
int wfaStaSet11n(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  dutCmdResponse_t* v11nParamsResp = &infoResp;

  DPRINT_INFO(WFA_WNG, "command sta_set_11n will be ignored\n");

#ifdef WFA_11N_SUPPORT_ONLY

  caSta11n_t* v11nParams = (caSta11n_t*)caCmdBuf;

  int st = 0;  // SUCCESS

  DPRINT_INFO(WFA_OUT, "Inside wfaStaSet11n function....\n");

  if (v11nParams->addba_reject != 0xFF && v11nParams->addba_reject < 2) {
    // implement the funciton
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_addba_reject failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->ampdu != 0xFF && v11nParams->ampdu < 2) {
    // implement the funciton

    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_ampdu failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->amsdu != 0xFF && v11nParams->amsdu < 2) {
    // implement the funciton
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_amsdu failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->greenfield != 0xFF && v11nParams->greenfield < 2) {
    // implement the funciton
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "_set_greenfield failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->mcs32 != 0xFF && v11nParams->mcs32 < 2 &&
      v11nParams->mcs_fixedrate[0] != '\0') {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_mcs failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  } else if (v11nParams->mcs32 != 0xFF && v11nParams->mcs32 < 2 &&
             v11nParams->mcs_fixedrate[0] == '\0') {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_mcs32 failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  } else if (v11nParams->mcs32 == 0xFF &&
             v11nParams->mcs_fixedrate[0] != '\0') {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_mcs32 failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->rifs_test != 0xFF && v11nParams->rifs_test < 2) {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_rifs_test failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->sgi20 != 0xFF && v11nParams->sgi20 < 2) {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_sgi20 failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->smps != 0xFFFF) {
    if (v11nParams->smps == 0) {
      // implement the funciton
      //st = wfaExecuteCLI(gCmdStr);
    } else if (v11nParams->smps == 1) {
      // implement the funciton
      //st = wfaExecuteCLI(gCmdStr);
      ;
    } else if (v11nParams->smps == 2) {
      // implement the funciton
      //st = wfaExecuteCLI(gCmdStr);
      ;
    }
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_smps failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->stbc_rx != 0xFFFF) {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_stbc_rx failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->width[0] != '\0') {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_11n_channel_width failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->_40_intolerant != 0xFF && v11nParams->_40_intolerant < 2) {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_40_intolerant failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->txsp_stream != 0 && v11nParams->txsp_stream < 4) {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_txsp_stream failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

  if (v11nParams->rxsp_stream != 0 && v11nParams->rxsp_stream < 4) {
    // implement the funciton
    //st = wfaExecuteCLI(gCmdStr);
    if (st != 0) {
      v11nParamsResp->status = STATUS_ERROR;
      strcpy(v11nParamsResp->cmdru.info, "set_rxsp_stream failed");
      wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, sizeof(dutCmdResponse_t),
                   (BYTE*)v11nParamsResp, respBuf);
      *respLen = WFA_TLV_HDR_LEN + sizeof(dutCmdResponse_t);
      return FALSE;
    }
  }

#endif

  v11nParamsResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_11N_RESP_TLV, 4, (BYTE*)v11nParamsResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}

int wfaStaSetWireless(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* staWirelessResp = &gGenericResp;

  DPRINT_INFO(WFA_WNG, "command sta_set_wireless will be ignored\n");

  staWirelessResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_WIRELESS_RESP_TLV, 4, (BYTE*)staWirelessResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}

int wfaStaSendADDBA(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t* staSendADDBAResp = &gGenericResp;

  DPRINT_INFO(WFA_WNG, "command sta_send_addba will be ignored\n");

  staSendADDBAResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_SEND_ADDBA_RESP_TLV, 4, (BYTE*)staSendADDBAResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;
  return WFA_SUCCESS;
}

#endif
/*
 * wfaStaAddArpTableEntry():
 */
int wfaStaAddArpTableEntry(int len,
                           BYTE* caCmdBuf,
                           int* respLen,
                           BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaAddARPTableEntry_t *staAddARPTableEntry= (caStaAddARPTableEntry_t *)caCmdBuf; uncomment and use it */

  printf("\n Entry wfastaAddARPTableEntry... ");
  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_ADD_ARP_TABLE_ENTRY_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaBlockICMPResponse():
 */
int wfaStaBlockICMPResponse(int len,
                            BYTE* caCmdBuf,
                            int* respLen,
                            BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  /* caStaBlockICMPResponse_t *staAddARPTableEntry= (caStaBlockICMPResponse_t *)caCmdBuf; uncomment and use it */

  printf("\n Entry wfaStaBlockICMPResponse... ");
  // Implement the function and this does not return any thing back.

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_P2P_BLOCK_ICMP_RESPONSE_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaSetRadio():
 */

int wfaStaSetRadio(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* setRadio = (dutCommand_t*)caCmdBuf;
  dutCmdResponse_t* staCmdResp = &gGenericResp;
  caStaSetRadio_t* sr = &setRadio->cmdsu.sr;

  if (sr->mode == WFA_OFF) {
    // turn radio off
  } else {
    // always turn the radio on
  }

  staCmdResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_RADIO_RESP_TLV, 4, (BYTE*)staCmdResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaSetRFeature():
 */

int wfaStaSetRFeature(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCommand_t* dutCmd = (dutCommand_t*)caCmdBuf;
  caStaRFeat_t* rfeat = &dutCmd->cmdsu.rfeat;
  dutCmdResponse_t* caResp = &gGenericResp;

  if (strcasecmp(rfeat->prog, "tdls") == 0) {
  }

  caResp->status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_SET_RFEATURE_RESP_TLV, 4, (BYTE*)caResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + 4;

  return WFA_SUCCESS;
}

/*
 * wfaStaStartWfdConnection():
 */
int wfaStaStartWfdConnection(int len,
                             BYTE* caCmdBuf,
                             int* respLen,
                             BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  //caStaStartWfdConn_t *staStartWfdConn= (caStaStartWfdConn_t *)caCmdBuf; //uncomment and use it

  printf("\n Entry wfaStaStartWfdConnection... ");

  // Fetch the GrpId and WFD session and return
  strcpy(&infoResp.cmdru.wfdConnInfo.wfdSessionId[0], "1234567890");
  strcpy(&infoResp.cmdru.wfdConnInfo.p2pGrpId[0], "WIFI_DISPLAY");
  strcpy(&infoResp.cmdru.wfdConnInfo.result[0], "GO");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_START_WFD_CONNECTION_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}
/*
 * wfaStaCliCommand():
 */

int wfaStaCliCommand(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  char cmdName[32];
  char *pcmdStr = NULL, *str;
  int st = 1;
  char CmdStr[WFA_CMD_STR_SZ];
  FILE* wfaCliFd;
  char wfaCliBuff[64];
  char retstr[256];
  int CmdReturnFlag = 0;
  char tmp[256];
  FILE* sh_pipe = NULL;
  caStaCliCmdResp_t infoResp;

  printf("\nEntry wfaStaCliCommand; command Received: %s\n", caCmdBuf);
  memcpy(cmdName, strtok_r((char*)caCmdBuf, ",", (char**)&pcmdStr), 32);
  sprintf(CmdStr, "%s", cmdName);

  for (;;) {
    // construct CLI standard cmd string
    str = strtok_r(NULL, ",", &pcmdStr);
    if (str == NULL || str[0] == '\0')
      break;
    else {
      strcat(strcat(CmdStr, " /"), str);
      str = strtok_r(NULL, ",", &pcmdStr);
      strcat(strcat(CmdStr, " "), str);
    }
  }
  // check the return process
  wfaCliFd = fopen("/etc/WfaEndpoint/wfa_cli.txt", "r");
  if (wfaCliFd != NULL) {
    while (fgets(wfaCliBuff, 64, wfaCliFd) != NULL) {
      //printf("\nLine read from CLI file : %s",wfaCliBuff);
      if (ferror(wfaCliFd))
        break;

      str = strtok(wfaCliBuff, "-");
      if (strcmp(str, cmdName) == 0) {
        str = strtok(NULL, ",");
        if (str != NULL) {
          if (strcmp(str, "TRUE") == 0)
            CmdReturnFlag = 1;
        } else
          printf(
              "ERR wfa_cli.txt, inside line format not end with , or missing "
              "TRUE/FALSE\n");
        break;
      }
    }
    fclose(wfaCliFd);
  } else {
    printf("/etc/WfaEndpoint/wfa_cli.txt is not exist\n");
    goto cleanup;
  }

  //printf("\n Command Return Flag : %d",CmdReturnFlag);
  memset(&retstr[0], '\0', 255);
  memset(&tmp[0], '\0', 255);
  sprintf(gCmdStr, "%s", CmdStr);
  printf("\nCLI Command -- %s\n", gCmdStr);

  sh_pipe = popen(gCmdStr, "r");
  if (!sh_pipe) {
    printf("Error in opening pipe\n");
    goto cleanup;
  }

  sleep(5);
  //tmp_val=getdelim(&retstr,255,"\n",sh_pipe);
  if (fgets(&retstr[0], 255, sh_pipe) == NULL) {
    printf("Getting NULL string in popen return\n");
    goto cleanup;
  } else
    printf("popen return str=%s\n", retstr);

  sleep(2);
  if (pclose(sh_pipe) == -1) {
    printf("Error in closing shell cmd pipe\n");
    goto cleanup;
  }
  sh_pipe = NULL;
  sleep(2);

  // find status first in output
  str = strtok_r((char*)retstr, "-", (char**)&pcmdStr);
  if (str != NULL) {
    memset(tmp, 0, 10);
    memcpy(tmp, str, 2);
    printf("cli status=%s\n", tmp);
    if (strlen(tmp) > 0)
      st = atoi(tmp);
    else
      printf("Missing status code\n");
  } else {
    printf("wfaStaCliCommand no return code found\n");
  }
  infoResp.resFlag = CmdReturnFlag;

cleanup:
  if (sh_pipe)
    pclose(sh_pipe);

  switch (st) {
    case 0:
      infoResp.status = STATUS_COMPLETE;
      if (CmdReturnFlag) {
        if ((pcmdStr != NULL) && (strlen(pcmdStr) > 0)) {
          memset(&(infoResp.result[0]), '\0', WFA_CLI_CMD_RESP_LEN - 1);
          strncpy(&infoResp.result[0], pcmdStr,
                  (strlen(pcmdStr) < WFA_CLI_CMD_RESP_LEN)
                      ? strlen(pcmdStr)
                      : (WFA_CLI_CMD_RESP_LEN - 2));
          printf("Return CLI result string to CA=%s\n", &(infoResp.result[0]));
        } else {
          strcpy(&infoResp.result[0], "No return string found\n");
        }
      }
      break;
    case 1:
      infoResp.status = STATUS_ERROR;
      break;
    case 2:
      infoResp.status = STATUS_INVALID;
      break;
  }

  wfaEncodeTLV(WFA_STA_CLI_CMD_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  printf("Exit from wfaStaCliCommand\n");
  return TRUE;
}
/*
 * wfaStaConnectGoStartWfd():
 */

int wfaStaConnectGoStartWfd(int len,
                            BYTE* caCmdBuf,
                            int* respLen,
                            BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  //  caStaConnectGoStartWfd_t *staConnecGoStartWfd= (caStaConnectGoStartWfd_t *)caCmdBuf; //uncomment and use it

  printf("\n Entry wfaStaConnectGoStartWfd... ");

  // connect the specified GO and then establish the wfd session

  // Fetch WFD session and return
  strcpy(&infoResp.cmdru.wfdConnInfo.wfdSessionId[0], "1234567890");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_CONNECT_GO_START_WFD_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaGenerateEvent():
 */

int wfaStaGenerateEvent(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaGenEvent_t* staGenerateEvent =
      (caStaGenEvent_t*)caCmdBuf;  //uncomment and use it
  caWfdStaGenEvent_t* wfdGenEvent;

  printf("\n Entry wfaStaGenerateEvent... ");

  // Geneate the specified action and return with complete/error.
  if (staGenerateEvent->program == PROG_TYPE_WFD) {
    wfdGenEvent = &staGenerateEvent->wfdEvent;
    if (wfdGenEvent->type == eUibcGen) {
    } else if (wfdGenEvent->type == eUibcHid) {
    } else if (wfdGenEvent->type == eFrameSkip) {
    } else if (wfdGenEvent->type == eI2cRead) {
    } else if (wfdGenEvent->type == eI2cWrite) {
    } else if (wfdGenEvent->type == eInputContent) {
    } else if (wfdGenEvent->type == eIdrReq) {
    }
  }

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GENERATE_EVENT_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

/*
 * wfaStaReinvokeWfdSession():
 */

int wfaStaReinvokeWfdSession(int len,
                             BYTE* caCmdBuf,
                             int* respLen,
                             BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  //  caStaReinvokeWfdSession_t *staReinvokeSession= (caStaReinvokeWfdSession_t *)caCmdBuf; //uncomment and use it

  printf("\n Entry wfaStaReinvokeWfdSession... ");

  // Reinvoke the WFD session by accepting the p2p invitation   or sending p2p invitation

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_REINVOKE_WFD_SESSION_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaGetParameter(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaGetParameter_t* staGetParam =
      (caStaGetParameter_t*)caCmdBuf;  //uncomment and use it

  caStaGetParameterResp_t* paramList = &infoResp.cmdru.getParamValue;

  printf("\n Entry wfaStaGetParameter... ");

  // Check the program type
  if (staGetParam->program == PROG_TYPE_WFD) {
    if (staGetParam->getParamValue == eDiscoveredDevList) {
      // Get the discovered devices, make space seperated list and return, check list is not bigger than 128 bytes.
      paramList->getParamType = eDiscoveredDevList;
      strcpy((char*)&paramList->devList,
             "11:22:33:44:55:66 22:33:44:55:66:77 33:44:55:66:77:88");
    }
  }

  if (staGetParam->program == PROG_TYPE_WFDS) {
    if (staGetParam->getParamValue == eDiscoveredDevList) {
      // Get the discovered devices, make space seperated list and return, check list is not bigger than 128 bytes.
      paramList->getParamType = eDiscoveredDevList;
      strcpy((char*)&paramList->devList,
             "11:22:33:44:55:66 22:33:44:55:66:77 33:44:55:66:77:88");
    }
    if (staGetParam->getParamValue == eOpenPorts) {
      // Run the port checker tool
      // Get all the open ports and make space seperated list and return, check list is not bigger than 128 bytes.
      paramList->getParamType = eOpenPorts;
      strcpy((char*)&paramList->devList, "22 139 445 68 9700");
    }
  }
  if (staGetParam->program == PROG_TYPE_NAN) {
    if (staGetParam->getParamValue == eMasterPref) {
      // Get the master preference of the device and return the value
      paramList->getParamType = eMasterPref;
      strcpy((char*)&paramList->masterPref, "0xff");
    }
  }

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GET_PARAMETER_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaNfcAction(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaNfcAction_t* getStaNfcAction =
      (caStaNfcAction_t*)caCmdBuf;  //uncomment and use it

  printf("\n Entry wfaStaNfcAction... ");

  if (getStaNfcAction->nfcOperation == eNfcHandOver) {
    printf("\n NfcAction - HandOver... ");

  } else if (getStaNfcAction->nfcOperation == eNfcReadTag) {
    printf("\n NfcAction - Read Tag... ");

  } else if (getStaNfcAction->nfcOperation == eNfcWriteSelect) {
    printf("\n NfcAction - Write Select... ");

  } else if (getStaNfcAction->nfcOperation == eNfcWriteConfig) {
    printf("\n NfcAction - Write Config... ");

  } else if (getStaNfcAction->nfcOperation == eNfcWritePasswd) {
    printf("\n NfcAction - Write Password... ");

  } else if (getStaNfcAction->nfcOperation == eNfcWpsHandOver) {
    printf("\n NfcAction - WPS Handover... ");
  }

  // Fetch the device mode and put in	 infoResp->cmdru.p2presult
  //strcpy(infoResp->cmdru.p2presult, "GO");

  // Fetch the device grp id and put in	 infoResp->cmdru.grpid
  //strcpy(infoResp->cmdru.grpid, "AA:BB:CC:DD:EE:FF_DIRECT-SSID");

  strcpy(infoResp.cmdru.staNfcAction.result, "CLIENT");
  strcpy(infoResp.cmdru.staNfcAction.grpId, "AA:BB:CC:DD:EE:FF_DIRECT-SSID");
  infoResp.cmdru.staNfcAction.peerRole = 1;

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_NFC_ACTION_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaExecAction(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaExecAction_t* staExecAction =
      (caStaExecAction_t*)caCmdBuf;  //comment if not used

  printf("\n Entry wfaStaExecAction... ");

  if (staExecAction->prog == PROG_TYPE_NAN) {
    // Perform necessary configurations and actions
    // return the MAC address conditionally as per CAPI specification
  }

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_EXEC_ACTION_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaInvokeCommand(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaInvokeCmd_t* staInvokeCmd =
      (caStaInvokeCmd_t*)caCmdBuf;  //uncomment and use it

  printf("\n Entry wfaStaInvokeCommand... ");

  // based on the command type , invoke API or complete the required procedures
  // return the  defined parameters based on the command that is received ( example response below)

  if (staInvokeCmd->cmdType == ePrimitiveCmdType &&
      staInvokeCmd->InvokeCmds.primtiveType.PrimType == eCmdPrimTypeAdvt) {
    infoResp.cmdru.staInvokeCmd.invokeCmdRspType = eCmdPrimTypeAdvt;
    infoResp.cmdru.staInvokeCmd.invokeCmdResp.advRsp.numServInfo = 1;
    strcpy(infoResp.cmdru.staInvokeCmd.invokeCmdResp.advRsp.servAdvInfo[0]
               .servName,
           "org.wi-fi.wfds.send.rx");
    infoResp.cmdru.staInvokeCmd.invokeCmdResp.advRsp.servAdvInfo[0].advtID =
        0x0000f;
    strcpy(infoResp.cmdru.staInvokeCmd.invokeCmdResp.advRsp.servAdvInfo[0]
               .serviceMac,
           "ab:cd:ef:gh:ij:kl");
  } else if (staInvokeCmd->cmdType == ePrimitiveCmdType &&
             staInvokeCmd->InvokeCmds.primtiveType.PrimType ==
                 eCmdPrimTypeSeek) {
    infoResp.cmdru.staInvokeCmd.invokeCmdRspType = eCmdPrimTypeSeek;
    infoResp.cmdru.staInvokeCmd.invokeCmdResp.seekRsp.searchID = 0x000ff;
  } else if (staInvokeCmd->cmdType == ePrimitiveCmdType &&
             staInvokeCmd->InvokeCmds.primtiveType.PrimType ==
                 eCmdPrimTypeConnSession) {
    infoResp.cmdru.staInvokeCmd.invokeCmdRspType = eCmdPrimTypeConnSession;
    infoResp.cmdru.staInvokeCmd.invokeCmdResp.connSessResp.sessionID = 0x000ff;
    strcpy(infoResp.cmdru.staInvokeCmd.invokeCmdResp.connSessResp.result, "GO");
    strcpy(infoResp.cmdru.staInvokeCmd.invokeCmdResp.connSessResp.grpId,
           "DIRECT-AB WFADUT");
  }
  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_INVOKE_CMD_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaManageService(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  //caStaMngServ_t *staMngServ = (caStaMngServ_t *)caCmdBuf;  //uncomment and use it

  printf("\n Entry wfaStaManageService... ");

  // based on the manage service type , invoke API's or complete the required procedures
  // return the  defined parameters based on the command that is received ( example response below)
  strcpy(infoResp.cmdru.staManageServ.result, "CLIENT");
  strcpy(infoResp.cmdru.staManageServ.grpId, "AA:BB:CC:DD:EE:FF_DIRECT-SSID");
  infoResp.cmdru.staManageServ.sessionID = 0x000ff;

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_MANAGE_SERVICE_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaGetEvents(int len, BYTE* caCmdBuf, int* respLen, BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaGetEvents_t* staGetEvents =
      (caStaGetEvents_t*)caCmdBuf;  //uncomment and use it

  printf("\n Entry wfaStaGetEvents... ");

  if (staGetEvents->program == PROG_TYPE_NAN) {
    // Get all the events from the Log file or stored events
    // return the  received/recorded event details - eventName, remoteInstanceID, localInstanceID, mac
  }

  // Get all the event from the Log file or stored events
  // return the  received/recorded events as space seperated list   ( example response below)
  strcpy(infoResp.cmdru.staGetEvents.result,
         "SearchResult SearchTerminated AdvertiseStatus SessionRequest "
         "ConnectStatus SessionStatus PortStatus");

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GET_EVENTS_RESP_TLV, sizeof(infoResp), (BYTE*)&infoResp,
               respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}

int wfaStaGetEventDetails(int len,
                          BYTE* caCmdBuf,
                          int* respLen,
                          BYTE* respBuf) {
  dutCmdResponse_t infoResp;
  caStaGetEventDetails_t* getStaGetEventDetails =
      (caStaGetEventDetails_t*)caCmdBuf;  //uncomment and use it

  printf("\n Entry wfaStaGetEventDetails... ");

  // based on the Requested Event type
  // return the latest corresponding evnet detailed parameters  ( example response below)

  if (getStaGetEventDetails->eventId == eSearchResult) {
    // fetch from log file or event history for the search result event and return the parameters
    infoResp.cmdru.staGetEventDetails.eventID = eSearchResult;

    infoResp.cmdru.staGetEventDetails.getEventDetails.searchResult.searchID =
        0x00abcd;
    strcpy(infoResp.cmdru.staGetEventDetails.getEventDetails.searchResult
               .serviceMac,
           "ab:cd:ef:gh:ij:kl");
    infoResp.cmdru.staGetEventDetails.getEventDetails.searchResult.advID =
        0x00dcba;
    strcpy(infoResp.cmdru.staGetEventDetails.getEventDetails.searchResult
               .serviceName,
           "org.wi-fi.wfds.send.rx");

    infoResp.cmdru.staGetEventDetails.getEventDetails.searchResult
        .serviceStatus = eServiceAvilable;
  } else if (
      getStaGetEventDetails->eventId ==
      eSearchTerminated) {  // fetch from log file or event history for the search terminated event and return the parameters
    infoResp.cmdru.staGetEventDetails.eventID = eSearchTerminated;
    infoResp.cmdru.staGetEventDetails.getEventDetails.searchTerminated
        .searchID = 0x00abcd;
  } else if (
      getStaGetEventDetails->eventId ==
      eAdvertiseStatus) {  // fetch from log file or event history for the Advertise Status event and return the parameters
    infoResp.cmdru.staGetEventDetails.eventID = eAdvertiseStatus;
    infoResp.cmdru.staGetEventDetails.getEventDetails.advStatus.advID =
        0x00dcba;

    infoResp.cmdru.staGetEventDetails.getEventDetails.advStatus.status =
        eAdvertised;
  } else if (
      getStaGetEventDetails->eventId ==
      eSessionRequest) {  // fetch from log file or event history for the session request event and return the parameters
    infoResp.cmdru.staGetEventDetails.eventID = eSessionRequest;
    infoResp.cmdru.staGetEventDetails.getEventDetails.sessionReq.advID =
        0x00dcba;
    strcpy(
        infoResp.cmdru.staGetEventDetails.getEventDetails.sessionReq.sessionMac,
        "ab:cd:ef:gh:ij:kl");
    infoResp.cmdru.staGetEventDetails.getEventDetails.sessionReq.sessionID =
        0x00baba;
  } else if (
      getStaGetEventDetails->eventId ==
      eSessionStatus) {  // fetch from log file or event history for the session status event and return the parameters
    infoResp.cmdru.staGetEventDetails.eventID = eSessionStatus;
    infoResp.cmdru.staGetEventDetails.getEventDetails.sessionStatus.sessionID =
        0x00baba;
    strcpy(infoResp.cmdru.staGetEventDetails.getEventDetails.sessionStatus
               .sessionMac,
           "ab:cd:ef:gh:ij:kl");
    infoResp.cmdru.staGetEventDetails.getEventDetails.sessionStatus.state =
        eSessionStateOpen;
  } else if (getStaGetEventDetails->eventId == eConnectStatus) {
    infoResp.cmdru.staGetEventDetails.eventID = eConnectStatus;
    infoResp.cmdru.staGetEventDetails.getEventDetails.connStatus.sessionID =
        0x00baba;
    strcpy(
        infoResp.cmdru.staGetEventDetails.getEventDetails.connStatus.sessionMac,
        "ab:cd:ef:gh:ij:kl");
    infoResp.cmdru.staGetEventDetails.getEventDetails.connStatus.status =
        eGroupFormationComplete;

  } else if (getStaGetEventDetails->eventId == ePortStatus) {
    infoResp.cmdru.staGetEventDetails.eventID = ePortStatus;
    infoResp.cmdru.staGetEventDetails.getEventDetails.portStatus.sessionID =
        0x00baba;
    strcpy(
        infoResp.cmdru.staGetEventDetails.getEventDetails.portStatus.sessionMac,
        "ab:cd:ef:gh:ij:kl");
    infoResp.cmdru.staGetEventDetails.getEventDetails.portStatus.port = 1009;
    infoResp.cmdru.staGetEventDetails.getEventDetails.portStatus.status =
        eLocalPortAllowed;
  }

  infoResp.status = STATUS_COMPLETE;
  wfaEncodeTLV(WFA_STA_GET_EVENT_DETAILS_RESP_TLV, sizeof(infoResp),
               (BYTE*)&infoResp, respBuf);
  *respLen = WFA_TLV_HDR_LEN + sizeof(infoResp);

  return WFA_SUCCESS;
}