| /* |
| * Copyright (c) 2011, 2017-2018 The Linux Foundation. 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. |
| */ |
| |
| #include <os_if_spectral_netlink.h> |
| #include <spectral_cmn_api_i.h> |
| #include <spectral_defs_i.h> |
| #include <wlan_nlink_srv.h> |
| #include <wlan_nlink_common.h> |
| #ifdef CNSS_GENL |
| #include <net/cnss_nl.h> |
| #endif |
| |
| #ifndef CNSS_GENL |
| static struct sock *os_if_spectral_nl_sock; |
| static atomic_t spectral_nl_users = ATOMIC_INIT(0); |
| #endif |
| |
| #if (KERNEL_VERSION(2, 6, 31) > LINUX_VERSION_CODE) |
| void |
| os_if_spectral_nl_data_ready(struct sock *sk, int len) |
| { |
| spectral_debug("%d", __LINE__); |
| } |
| |
| #else |
| void |
| os_if_spectral_nl_data_ready(struct sk_buff *skb) |
| { |
| spectral_debug("%d", __LINE__); |
| } |
| #endif /* VERSION */ |
| |
| #ifndef CNSS_GENL |
| /** |
| * os_if_spectral_init_nl_cfg() - Initialize netlink kernel |
| * configuration parameters |
| * @cfg : Pointer to netlink_kernel_cfg |
| * |
| * Initialize netlink kernel configuration parameters required |
| * for spectral module |
| * |
| * Return: None |
| */ |
| #if KERNEL_VERSION(3, 6, 0) <= LINUX_VERSION_CODE |
| static void |
| os_if_spectral_init_nl_cfg(struct netlink_kernel_cfg *cfg) |
| { |
| cfg->groups = 1; |
| cfg->input = os_if_spectral_nl_data_ready; |
| } |
| #else |
| static void |
| os_if_spectral_init_nl_cfg(struct netlink_kernel_cfg *cfg) |
| { |
| } |
| #endif |
| /** |
| * os_if_spectral_create_nl_sock() - Create Netlink socket |
| * @cfg : Pointer to netlink_kernel_cfg |
| * |
| * Create Netlink socket required for spectral module |
| * |
| * Return: None |
| */ |
| #if KERNEL_VERSION(3, 7, 0) <= LINUX_VERSION_CODE |
| static void |
| os_if_spectral_create_nl_sock(struct netlink_kernel_cfg *cfg) |
| { |
| os_if_spectral_nl_sock = |
| (struct sock *)netlink_kernel_create(&init_net, |
| SPECTRAL_NETLINK, cfg); |
| } |
| #elif KERNEL_VERSION(3, 6, 0) <= LINUX_VERSION_CODE |
| static void |
| os_if_spectral_create_nl_sock(struct netlink_kernel_cfg *cfg) |
| { |
| os_if_spectral_nl_sock = |
| (struct sock *)netlink_kernel_create(&init_net, |
| SPECTRAL_NETLINK, |
| THIS_MODULE, cfg); |
| } |
| #elif (KERNEL_VERSION(2, 6, 31) > LINUX_VERSION_CODE) |
| static void |
| os_if_spectral_create_nl_sock(struct netlink_kernel_cfg *cfg) |
| { |
| os_if_spectral_nl_sock = |
| (struct sock *)netlink_kernel_create( |
| SPECTRAL_NETLINK, 1, |
| &os_if_spectral_nl_data_ready, |
| THIS_MODULE); |
| } |
| #else |
| #if (KERNEL_VERSION(3, 10, 0) <= LINUX_VERSION_CODE) |
| static void |
| os_if_spectral_create_nl_sock(struct netlink_kernel_cfg *cfg) |
| { |
| memset(cfg, 0, sizeof(*cfg)); |
| cfg->groups = 1; |
| cfg->input = &os_if_spectral_nl_data_ready; |
| os_if_spectral_nl_sock = |
| (struct sock *)netlink_kernel_create(&init_net, |
| SPECTRAL_NETLINK, cfg); |
| } |
| #else |
| static void |
| os_if_spectral_create_nl_sock(struct netlink_kernel_cfg *cfg) |
| { |
| os_if_spectral_nl_sock = |
| (struct sock *)netlink_kernel_create( |
| &init_net, |
| SPECTRAL_NETLINK, 1, |
| &os_if_spectral_nl_data_ready, |
| NULL, THIS_MODULE); |
| } |
| #endif |
| #endif |
| |
| /** |
| * os_if_spectral_init_nl() - Initialize netlink data structures for |
| * spectral module |
| * @pdev : Pointer to pdev |
| * |
| * Return: 0 on success else failure |
| */ |
| static int |
| os_if_spectral_init_nl(struct wlan_objmgr_pdev *pdev) |
| { |
| struct pdev_spectral *ps = NULL; |
| struct netlink_kernel_cfg cfg; |
| |
| memset(&cfg, 0, sizeof(cfg)); |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return -EINVAL; |
| } |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| |
| if (!ps) { |
| spectral_err("PDEV SPECTRAL object is NULL!"); |
| return -EINVAL; |
| } |
| os_if_spectral_init_nl_cfg(&cfg); |
| |
| if (!os_if_spectral_nl_sock) { |
| os_if_spectral_create_nl_sock(&cfg); |
| |
| if (!os_if_spectral_nl_sock) { |
| spectral_err("NETLINK_KERNEL_CREATE FAILED"); |
| return -ENODEV; |
| } |
| } |
| ps->spectral_sock = os_if_spectral_nl_sock; |
| |
| if (!ps->spectral_sock) { |
| spectral_err("ps->spectral_sock is NULL"); |
| return -ENODEV; |
| } |
| atomic_inc(&spectral_nl_users); |
| |
| return 0; |
| } |
| |
| /** |
| * os_if_spectral_destroy_netlink() - De-initialize netlink data structures for |
| * spectral module |
| * @pdev : Pointer to pdev |
| * |
| * Return: Success/Failure |
| */ |
| static int |
| os_if_spectral_destroy_netlink(struct wlan_objmgr_pdev *pdev) |
| { |
| struct pdev_spectral *ps = NULL; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return -EINVAL; |
| } |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| |
| if (!ps) { |
| spectral_err("PDEV SPECTRAL object is NULL!"); |
| return -EINVAL; |
| } |
| ps->spectral_sock = NULL; |
| if (atomic_dec_and_test(&spectral_nl_users)) { |
| sock_release(os_if_spectral_nl_sock->sk_socket); |
| os_if_spectral_nl_sock = NULL; |
| } |
| return 0; |
| } |
| #else |
| |
| static int |
| os_if_spectral_init_nl(struct wlan_objmgr_pdev *pdev) |
| { |
| return 0; |
| } |
| |
| static int |
| os_if_spectral_destroy_netlink(struct wlan_objmgr_pdev *pdev) |
| { |
| return 0; |
| } |
| #endif |
| |
| void * |
| os_if_spectral_prep_skb(struct wlan_objmgr_pdev *pdev) |
| { |
| struct pdev_spectral *ps = NULL; |
| struct nlmsghdr *spectral_nlh = NULL; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return NULL; |
| } |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| |
| if (!ps) { |
| spectral_err("PDEV SPECTRAL object is NULL!"); |
| return NULL; |
| } |
| ps->skb = qdf_nbuf_alloc(NULL, MAX_SPECTRAL_PAYLOAD, 0, 0, false); |
| |
| if (!ps->skb) { |
| spectral_err("allocate skb (len=%u) failed", |
| MAX_SPECTRAL_PAYLOAD); |
| return NULL; |
| } |
| |
| qdf_nbuf_put_tail(ps->skb, MAX_SPECTRAL_PAYLOAD); |
| spectral_nlh = (struct nlmsghdr *)ps->skb->data; |
| |
| OS_MEMZERO(spectral_nlh, sizeof(*spectral_nlh)); |
| |
| /* |
| * Possible bug that size of struct spectral_samp_msg and |
| * SPECTRAL_MSG differ by 3 bytes so we miss 3 bytes |
| */ |
| |
| spectral_nlh->nlmsg_len = NLMSG_SPACE(sizeof(struct spectral_samp_msg)); |
| spectral_nlh->nlmsg_pid = 0; |
| spectral_nlh->nlmsg_flags = 0; |
| spectral_nlh->nlmsg_type = WLAN_NL_MSG_SPECTRAL_SCAN; |
| |
| return NLMSG_DATA(spectral_nlh); |
| } |
| |
| #if (KERNEL_VERSION(2, 6, 31) > LINUX_VERSION_CODE) |
| static inline void |
| os_if_init_spectral_skb_dst_pid( |
| struct sk_buff *skb, |
| struct pdev_spectral *ps) |
| { |
| NETLINK_CB(skb).dst_pid = |
| ps->spectral_pid; |
| } |
| #else |
| static inline void |
| os_if_init_spectral_skb_dst_pid( |
| struct sk_buff *skb, |
| struct pdev_spectral *ps) |
| { |
| } |
| #endif /* VERSION - field deprecated by newer kernels */ |
| |
| #if KERNEL_VERSION(3, 7, 0) > LINUX_VERSION_CODE |
| static inline void |
| os_if_init_spectral_skb_pid_portid(struct sk_buff *skb) |
| { |
| NETLINK_CB(skb).pid = 0; /* from kernel */ |
| } |
| #else |
| static inline void |
| os_if_init_spectral_skb_pid_portid(struct sk_buff *skb) |
| { |
| NETLINK_CB(skb).portid = 0; /* from kernel */ |
| } |
| #endif |
| |
| |
| /** |
| * os_if_spectral_nl_unicast_msg() - Sends unicast Spectral message to user |
| * space |
| * @pdev : Pointer to pdev |
| * |
| * Return: void |
| */ |
| #ifndef CNSS_GENL |
| static int |
| os_if_spectral_nl_unicast_msg(struct wlan_objmgr_pdev *pdev) |
| { |
| struct pdev_spectral *ps = NULL; |
| int status; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return -EINVAL; |
| } |
| |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| if (!ps) { |
| spectral_err("PDEV SPECTRAL object is NULL!"); |
| return -EINVAL; |
| } |
| |
| if (!ps->skb) { |
| spectral_err("Socket buffer is null"); |
| return -EINVAL; |
| } |
| |
| if (!ps->spectral_sock) { |
| spectral_err("Spectral Socket is invalid"); |
| dev_kfree_skb(ps->skb); |
| return -EINVAL; |
| } |
| |
| os_if_init_spectral_skb_dst_pid(ps->skb, ps); |
| |
| os_if_init_spectral_skb_pid_portid(ps->skb); |
| |
| /* to mcast group 1<<0 */ |
| NETLINK_CB(ps->skb).dst_group = 0; |
| |
| status = netlink_unicast(ps->spectral_sock, |
| ps->skb, |
| ps->spectral_pid, MSG_DONTWAIT); |
| |
| return status; |
| } |
| #else |
| |
| static int |
| os_if_spectral_nl_unicast_msg(struct wlan_objmgr_pdev *pdev) |
| { |
| struct pdev_spectral *ps = NULL; |
| int status; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return -EINVAL; |
| } |
| |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| if (!ps) { |
| spectral_err("PDEV SPECTRAL object is NULL!"); |
| return -EINVAL; |
| } |
| |
| if (!ps->skb) { |
| spectral_err("Socket buffer is null"); |
| return -EINVAL; |
| } |
| |
| spectral_debug("spectral unicast message"); |
| os_if_init_spectral_skb_pid_portid(ps->skb); |
| |
| status = nl_srv_ucast(ps->skb, ps->spectral_pid, MSG_DONTWAIT, |
| WLAN_NL_MSG_SPECTRAL_SCAN, CLD80211_MCGRP_OEM_MSGS); |
| if (status < 0) |
| spectral_err("failed to send to spectral scan app"); |
| |
| return status; |
| } |
| |
| #endif |
| /** |
| * os_if_spectral_nl_bcast_msg() - Sends broadcast Spectral message to user |
| * space |
| * @pdev : Pointer to pdev |
| * |
| * Return: void |
| */ |
| static int |
| os_if_spectral_nl_bcast_msg(struct wlan_objmgr_pdev *pdev) |
| { |
| #if (KERNEL_VERSION(2, 6, 31) >= LINUX_VERSION_CODE) |
| fd_set write_set; |
| #endif |
| int status; |
| struct pdev_spectral *ps = NULL; |
| |
| #if (KERNEL_VERSION(2, 6, 31) >= LINUX_VERSION_CODE) |
| FD_ZERO(&write_set); |
| #endif |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return -EINVAL; |
| } |
| ps = wlan_objmgr_pdev_get_comp_private_obj(pdev, |
| WLAN_UMAC_COMP_SPECTRAL); |
| |
| if (!ps) { |
| spectral_err("PDEV SPECTRAL object is NULL!"); |
| return -EINVAL; |
| } |
| |
| if (!ps->skb) { |
| spectral_err("Socket buffer is null"); |
| return -EINVAL; |
| } |
| |
| if (!ps->spectral_sock) { |
| dev_kfree_skb(ps->skb); |
| return -EINVAL; |
| } |
| |
| status = netlink_broadcast(ps->spectral_sock, |
| ps->skb, |
| 0, 1, GFP_ATOMIC); |
| |
| return status; |
| } |
| |
| void |
| os_if_spectral_netlink_init(struct wlan_objmgr_pdev *pdev) |
| { |
| struct spectral_nl_cb nl_cb = {0}; |
| struct spectral_context *sptrl_ctx; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return; |
| } |
| |
| sptrl_ctx = spectral_get_spectral_ctx_from_pdev(pdev); |
| |
| if (!sptrl_ctx) { |
| spectral_err("Spectral context is NULL!"); |
| return; |
| } |
| |
| os_if_spectral_init_nl(pdev); |
| |
| /* Register Netlink handlers */ |
| nl_cb.get_nbuff = os_if_spectral_prep_skb; |
| nl_cb.send_nl_bcast = os_if_spectral_nl_bcast_msg; |
| nl_cb.send_nl_unicast = os_if_spectral_nl_unicast_msg; |
| |
| if (sptrl_ctx->sptrlc_register_netlink_cb) |
| sptrl_ctx->sptrlc_register_netlink_cb(pdev, &nl_cb); |
| } |
| EXPORT_SYMBOL(os_if_spectral_netlink_init); |
| |
| void os_if_spectral_netlink_deinit(struct wlan_objmgr_pdev *pdev) |
| { |
| struct spectral_context *sptrl_ctx; |
| |
| if (!pdev) { |
| spectral_err("PDEV is NULL!"); |
| return; |
| } |
| |
| sptrl_ctx = spectral_get_spectral_ctx_from_pdev(pdev); |
| |
| if (!sptrl_ctx) { |
| spectral_err("Spectral context is NULL!"); |
| return; |
| } |
| |
| if (sptrl_ctx->sptrlc_deregister_netlink_cb) |
| sptrl_ctx->sptrlc_deregister_netlink_cb(pdev); |
| |
| os_if_spectral_destroy_netlink(pdev); |
| } |
| EXPORT_SYMBOL(os_if_spectral_netlink_deinit); |