qcacmn: Add core\utils directory and files to qcacmn
As a part of UMAC convergence, move the core\utils logging to qcacmn. CRs-Fixed: 1109855 Change-Id: I499a392f74f3e52e99df4d03e4a27bce6cf5be7c
Cette révision appartient à :
Srinivas Girigowda
révisé par
qcabuildsw
qcabuildsw
Parent
6195152790
révision
60644c29e6
127
utils/ptt/inc/wlan_ptt_sock_svc.h
Fichier normal
127
utils/ptt/inc/wlan_ptt_sock_svc.h
Fichier normal
@@ -0,0 +1,127 @@
|
||||
/*
|
||||
* Copyright (c) 2012-2017 The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Previously licensed under the ISC license by Qualcomm Atheros, Inc.
|
||||
*
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
/*
|
||||
* This file was originally distributed by Qualcomm Atheros, Inc.
|
||||
* under proprietary terms before Copyright ownership was assigned
|
||||
* to the Linux Foundation.
|
||||
*/
|
||||
|
||||
/******************************************************************************
|
||||
* wlan_ptt_sock_svc.c
|
||||
*
|
||||
******************************************************************************/
|
||||
#ifndef PTT_SOCK_SVC_H
|
||||
#define PTT_SOCK_SVC_H
|
||||
#include <wlan_nlink_srv.h>
|
||||
#include <qdf_types.h>
|
||||
#include <qdf_status.h>
|
||||
#include <qdf_trace.h>
|
||||
|
||||
/*
|
||||
* Quarky Message Format:
|
||||
* The following is the messaging protocol between Quarky and PTT Socket App.
|
||||
* The totalMsgLen is the length from Radio till msgBody. The value of Radio
|
||||
* is always defaulted to 0. The MsgLen is the length from msgId till msgBody.
|
||||
* The length of the msgBody varies with respect to the MsgId. Buffer space
|
||||
* for MsgBody is already allocated in the received buffer. So in case of READ
|
||||
* we just need to populate the values in the received message and send it
|
||||
* back
|
||||
* +------------+-------+-------+--------+-------+---------+
|
||||
* |TotalMsgLen | Radio | MsgId | MsgLen |Status |MsgBody |
|
||||
* +------------+-------+-------|--------+-------+---------+
|
||||
* <------4----><--4---><---2--><---2---><---4--><--------->
|
||||
*/
|
||||
/* PTT Socket App Message Ids */
|
||||
#define PTT_MSG_READ_REGISTER 0x3040
|
||||
#define PTT_MSG_WRITE_REGISTER 0x3041
|
||||
#define PTT_MSG_READ_MEMORY 0x3044
|
||||
#define PTT_MSG_WRITE_MEMORY 0x3045
|
||||
#define PTT_MSG_LOG_DUMP_DBG 0x32A1
|
||||
#define PTT_MSG_FTM_CMDS_TYPE 0x4040
|
||||
#define ANI_DRIVER_MSG_START 0x0001
|
||||
#define ANI_MSG_APP_REG_REQ (ANI_DRIVER_MSG_START + 0)
|
||||
#define ANI_MSG_APP_REG_RSP (ANI_DRIVER_MSG_START + 1)
|
||||
#define ANI_MSG_OEM_DATA_REQ (ANI_DRIVER_MSG_START + 2)
|
||||
#define ANI_MSG_OEM_DATA_RSP (ANI_DRIVER_MSG_START + 3)
|
||||
#define ANI_MSG_CHANNEL_INFO_REQ (ANI_DRIVER_MSG_START + 4)
|
||||
#define ANI_MSG_CHANNEL_INFO_RSP (ANI_DRIVER_MSG_START + 5)
|
||||
#define ANI_MSG_OEM_ERROR (ANI_DRIVER_MSG_START + 6)
|
||||
#define ANI_MSG_PEER_STATUS_IND (ANI_DRIVER_MSG_START + 7)
|
||||
#define ANI_MSG_SET_OEM_CAP_REQ (ANI_DRIVER_MSG_START + 8)
|
||||
#define ANI_MSG_SET_OEM_CAP_RSP (ANI_DRIVER_MSG_START + 9)
|
||||
#define ANI_MSG_GET_OEM_CAP_REQ (ANI_DRIVER_MSG_START + 10)
|
||||
#define ANI_MSG_GET_OEM_CAP_RSP (ANI_DRIVER_MSG_START + 11)
|
||||
|
||||
#define ANI_MAX_RADIOS 3
|
||||
#define ANI_NL_MSG_OK 0
|
||||
#define ANI_NL_MSG_ERROR -1
|
||||
#define ANI_NL_MSG_OVERHEAD (NLMSG_SPACE(tAniHdr + 4))
|
||||
/*
|
||||
* Packet Format for READ_REGISTER & WRITE_REGISTER:
|
||||
* TotalMsgLen : 4 bytes [value=20 bytes]
|
||||
* Radio : 4 bytes
|
||||
* MsgId : 2 bytes
|
||||
* MsgLen : 2 bytes
|
||||
* Status : 4 bytes
|
||||
* Address : 4 bytes
|
||||
* Payload : 4 bytes
|
||||
*/
|
||||
/*
|
||||
* Packet Format for READ_MEMORY & WRITE_MEMORY :
|
||||
* TotalMsgLen : 4 bytes [value= 20+LEN_PAYLOAD bytes]
|
||||
* Radio : 4 bytes
|
||||
* MsgId : 2 bytes
|
||||
* MsgLen : 2 bytes
|
||||
* Status : 4 bytes
|
||||
* Address : 4 bytes
|
||||
* Length : 4 bytes [LEN_PAYLOAD]
|
||||
* Payload : LEN_PAYLOAD bytes
|
||||
*/
|
||||
#ifdef PTT_SOCK_SVC_ENABLE
|
||||
int ptt_sock_activate_svc(void);
|
||||
void ptt_sock_deactivate_svc(void);
|
||||
int ptt_sock_send_msg_to_app(tAniHdr *wmsg, int radio, int src_mod, int pid);
|
||||
#else
|
||||
static inline int ptt_sock_activate_svc(void) { return 0; }
|
||||
static inline void ptt_sock_deactivate_svc(void) { return; }
|
||||
static inline int ptt_sock_send_msg_to_app(tAniHdr *wmsg, int radio,
|
||||
int src_mod, int pid)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
/*
|
||||
* Format of message exchanged between the PTT Socket App in userspace and the
|
||||
* WLAN Driver, in either direction. Each msg will begin with this header and
|
||||
* will followed by the Quarky message
|
||||
*/
|
||||
typedef struct sAniAppRegReq {
|
||||
tAniNlModTypes type; /* module id */
|
||||
int pid; /* process id */
|
||||
} tAniNlAppRegReq;
|
||||
typedef struct sAniNlAppRegRsp {
|
||||
tAniHdr wniHdr; /* Generic WNI msg header */
|
||||
tAniNlAppRegReq regReq; /* The original request msg */
|
||||
int ret; /* Return code */
|
||||
} tAniNlAppRegRsp;
|
||||
#endif
|
||||
231
utils/ptt/src/wlan_ptt_sock_svc.c
Fichier normal
231
utils/ptt/src/wlan_ptt_sock_svc.c
Fichier normal
@@ -0,0 +1,231 @@
|
||||
/*
|
||||
* Copyright (c) 2012-2017 The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Previously licensed under the ISC license by Qualcomm Atheros, Inc.
|
||||
*
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
/*
|
||||
* This file was originally distributed by Qualcomm Atheros, Inc.
|
||||
* under proprietary terms before Copyright ownership was assigned
|
||||
* to the Linux Foundation.
|
||||
*/
|
||||
|
||||
/******************************************************************************
|
||||
* wlan_ptt_sock_svc.c
|
||||
*
|
||||
******************************************************************************/
|
||||
#ifdef PTT_SOCK_SVC_ENABLE
|
||||
#include <wlan_nlink_srv.h>
|
||||
#include <qdf_types.h>
|
||||
#include <qdf_status.h>
|
||||
#include <qdf_trace.h>
|
||||
#include <wlan_nlink_common.h>
|
||||
#include <wlan_ptt_sock_svc.h>
|
||||
#include <qdf_types.h>
|
||||
#include <qdf_trace.h>
|
||||
|
||||
#define PTT_SOCK_DEBUG
|
||||
#ifdef PTT_SOCK_DEBUG
|
||||
#define PTT_TRACE(level, args ...) QDF_TRACE(QDF_MODULE_ID_QDF, level, ## args)
|
||||
#else
|
||||
#define PTT_TRACE(level, args ...)
|
||||
#endif
|
||||
|
||||
/** ptt Process ID */
|
||||
static int32_t ptt_pid = INVALID_PID;
|
||||
|
||||
#ifdef PTT_SOCK_DEBUG_VERBOSE
|
||||
/* Utility function to perform a hex dump */
|
||||
static void ptt_sock_dump_buf(const unsigned char *pbuf, int cnt)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < cnt; i++) {
|
||||
if ((i % 16) == 0)
|
||||
QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_INFO,
|
||||
"\n%p:", pbuf);
|
||||
QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_INFO, " %02X",
|
||||
*pbuf);
|
||||
pbuf++;
|
||||
}
|
||||
QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_INFO, "\n");
|
||||
}
|
||||
#endif
|
||||
|
||||
/**
|
||||
* ptt_sock_send_msg_to_app() - Send nl message to user space
|
||||
* wmsg: Message header
|
||||
* radio: Unit number of the radio
|
||||
* src_mod: Message type
|
||||
* pid: Process ID to which message will be unicast. Message
|
||||
* will be broadcast when PID is INVALID_PID
|
||||
*
|
||||
* Utility function to send a netlink message to an application in user space
|
||||
*
|
||||
* Return: 0 on success and negative value on failure
|
||||
*/
|
||||
int ptt_sock_send_msg_to_app(tAniHdr *wmsg, int radio, int src_mod, int pid)
|
||||
{
|
||||
int err = -1;
|
||||
int payload_len;
|
||||
int tot_msg_len;
|
||||
tAniNlHdr *wnl;
|
||||
struct sk_buff *skb;
|
||||
struct nlmsghdr *nlh;
|
||||
int wmsg_length = be16_to_cpu(wmsg->length);
|
||||
static int nlmsg_seq;
|
||||
|
||||
if (radio < 0 || radio > ANI_MAX_RADIOS) {
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_ERROR, "%s: invalid radio id [%d]\n",
|
||||
__func__, radio);
|
||||
return -EINVAL;
|
||||
}
|
||||
payload_len = wmsg_length + sizeof(wnl->radio) + sizeof(*wmsg);
|
||||
tot_msg_len = NLMSG_SPACE(payload_len);
|
||||
skb = dev_alloc_skb(tot_msg_len);
|
||||
if (skb == NULL) {
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_ERROR,
|
||||
"%s: dev_alloc_skb() failed for msg size[%d]\n",
|
||||
__func__, tot_msg_len);
|
||||
return -ENOMEM;
|
||||
}
|
||||
nlh =
|
||||
nlmsg_put(skb, pid, nlmsg_seq++, src_mod, payload_len,
|
||||
NLM_F_REQUEST);
|
||||
if (NULL == nlh) {
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_ERROR,
|
||||
"%s: nlmsg_put() failed for msg size[%d]\n", __func__,
|
||||
tot_msg_len);
|
||||
kfree_skb(skb);
|
||||
return -ENOMEM;
|
||||
}
|
||||
wnl = (tAniNlHdr *) nlh;
|
||||
wnl->radio = radio;
|
||||
memcpy(&wnl->wmsg, wmsg, wmsg_length);
|
||||
#ifdef PTT_SOCK_DEBUG_VERBOSE
|
||||
ptt_sock_dump_buf((const unsigned char *)skb->data, skb->len);
|
||||
#endif
|
||||
|
||||
if (pid != INVALID_PID)
|
||||
err = nl_srv_ucast(skb, pid, MSG_DONTWAIT);
|
||||
else
|
||||
err = nl_srv_bcast(skb);
|
||||
|
||||
if (err)
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_INFO,
|
||||
"%s:Failed sending Msg Type [0x%X] to pid[%d]\n",
|
||||
__func__, be16_to_cpu(wmsg->type), pid);
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* Process tregisteration request and send registration response messages
|
||||
* to the PTT Socket App in user space
|
||||
*/
|
||||
static void ptt_sock_proc_reg_req(tAniHdr *wmsg, int radio)
|
||||
{
|
||||
tAniNlAppRegReq *reg_req;
|
||||
tAniNlAppRegRsp rspmsg;
|
||||
reg_req = (tAniNlAppRegReq *) (wmsg + 1);
|
||||
memset((char *)&rspmsg, 0, sizeof(rspmsg));
|
||||
/* send reg response message to the application */
|
||||
rspmsg.ret = ANI_NL_MSG_OK;
|
||||
rspmsg.regReq.type = reg_req->type;
|
||||
/*Save the pid */
|
||||
ptt_pid = reg_req->pid;
|
||||
rspmsg.regReq.pid = reg_req->pid;
|
||||
rspmsg.wniHdr.type = cpu_to_be16(ANI_MSG_APP_REG_RSP);
|
||||
rspmsg.wniHdr.length = cpu_to_be16(sizeof(rspmsg));
|
||||
if (ptt_sock_send_msg_to_app((tAniHdr *) &rspmsg.wniHdr, radio,
|
||||
ANI_NL_MSG_PUMAC, ptt_pid) < 0) {
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_INFO,
|
||||
"%s: Error sending ANI_MSG_APP_REG_RSP to pid[%d]\n",
|
||||
__func__, ptt_pid);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Process all the messages from the PTT Socket App in user space
|
||||
*/
|
||||
static void ptt_proc_pumac_msg(struct sk_buff *skb, tAniHdr *wmsg, int radio)
|
||||
{
|
||||
u16 ani_msg_type = be16_to_cpu(wmsg->type);
|
||||
switch (ani_msg_type) {
|
||||
case ANI_MSG_APP_REG_REQ:
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_INFO,
|
||||
"%s: Received ANI_MSG_APP_REG_REQ [0x%X]\n", __func__,
|
||||
ani_msg_type);
|
||||
ptt_sock_proc_reg_req(wmsg, radio);
|
||||
break;
|
||||
default:
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_ERROR,
|
||||
"%s: Received Unknown Msg Type[0x%X]\n", __func__,
|
||||
ani_msg_type);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Process all the Netlink messages from PTT Socket app in user space
|
||||
*/
|
||||
static int ptt_sock_rx_nlink_msg(struct sk_buff *skb)
|
||||
{
|
||||
tAniNlHdr *wnl;
|
||||
int radio;
|
||||
int type;
|
||||
wnl = (tAniNlHdr *) skb->data;
|
||||
radio = wnl->radio;
|
||||
type = wnl->nlh.nlmsg_type;
|
||||
switch (type) {
|
||||
case ANI_NL_MSG_PUMAC: /* Message from the PTT socket APP */
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_INFO,
|
||||
"%s: Received ANI_NL_MSG_PUMAC Msg [0x%X]\n",
|
||||
__func__, type);
|
||||
ptt_proc_pumac_msg(skb, &wnl->wmsg, radio);
|
||||
break;
|
||||
default:
|
||||
PTT_TRACE(QDF_TRACE_LEVEL_ERROR, "%s: Unknown NL Msg [0x%X]\n",
|
||||
__func__, type);
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* ptt_sock_activate_svc() - activate PTT service
|
||||
*
|
||||
* Return: 0
|
||||
*/
|
||||
int ptt_sock_activate_svc(void)
|
||||
{
|
||||
ptt_pid = INVALID_PID;
|
||||
nl_srv_register(ANI_NL_MSG_PUMAC, ptt_sock_rx_nlink_msg);
|
||||
nl_srv_register(ANI_NL_MSG_PTT, ptt_sock_rx_nlink_msg);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* ptt_sock_deactivate_svc() - deactivate PTT service
|
||||
*
|
||||
* Return: Void
|
||||
*/
|
||||
void ptt_sock_deactivate_svc(void)
|
||||
{
|
||||
ptt_pid = INVALID_PID;
|
||||
}
|
||||
|
||||
#endif /* PTT_SOCK_SVC_ENABLE */
|
||||
Référencer dans un nouveau ticket
Bloquer un utilisateur