12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124 |
- /*
- * Copyright (c) 2017-2019 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.
- */
- /**
- * DOC: wlan_tdls_ucfg_api.c
- *
- * TDLS north bound interface definitions
- */
- #include <wlan_tdls_ucfg_api.h>
- #include <wlan_tdls_tgt_api.h>
- #include "../../core/src/wlan_tdls_main.h"
- #include "../../core/src/wlan_tdls_cmds_process.h"
- #include "../../core/src/wlan_tdls_ct.h"
- #include "../../core/src/wlan_tdls_mgmt.h"
- #include <wlan_objmgr_global_obj.h>
- #include <wlan_objmgr_cmn.h>
- #include "wlan_policy_mgr_api.h"
- #include "wlan_scan_ucfg_api.h"
- #include "wlan_tdls_cfg.h"
- #include "cfg_ucfg_api.h"
- QDF_STATUS ucfg_tdls_init(void)
- {
- QDF_STATUS status;
- tdls_notice("tdls module dispatcher init");
- status = wlan_objmgr_register_psoc_create_handler(WLAN_UMAC_COMP_TDLS,
- tdls_psoc_obj_create_notification, NULL);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("Failed to register psoc create handler for tdls");
- return status;
- }
- status = wlan_objmgr_register_psoc_destroy_handler(WLAN_UMAC_COMP_TDLS,
- tdls_psoc_obj_destroy_notification, NULL);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("Failed to register psoc delete handler for tdls");
- goto fail_delete_psoc;
- }
- status = wlan_objmgr_register_vdev_create_handler(WLAN_UMAC_COMP_TDLS,
- tdls_vdev_obj_create_notification, NULL);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("Failed to register vdev create handler for tdls");
- goto fail_create_vdev;
- }
- status = wlan_objmgr_register_vdev_destroy_handler(WLAN_UMAC_COMP_TDLS,
- tdls_vdev_obj_destroy_notification, NULL);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("Failed to register vdev create handler for tdls");
- goto fail_delete_vdev;
- }
- tdls_notice("tdls module dispatcher init done");
- return status;
- fail_delete_vdev:
- wlan_objmgr_unregister_vdev_create_handler(WLAN_UMAC_COMP_TDLS,
- tdls_vdev_obj_create_notification, NULL);
- fail_create_vdev:
- wlan_objmgr_unregister_psoc_destroy_handler(WLAN_UMAC_COMP_TDLS,
- tdls_psoc_obj_destroy_notification, NULL);
- fail_delete_psoc:
- wlan_objmgr_unregister_psoc_create_handler(WLAN_UMAC_COMP_TDLS,
- tdls_psoc_obj_create_notification, NULL);
- return status;
- }
- QDF_STATUS ucfg_tdls_deinit(void)
- {
- QDF_STATUS ret;
- tdls_notice("tdls module dispatcher deinit");
- ret = wlan_objmgr_unregister_psoc_create_handler(WLAN_UMAC_COMP_TDLS,
- tdls_psoc_obj_create_notification, NULL);
- if (QDF_IS_STATUS_ERROR(ret))
- tdls_err("Failed to unregister psoc create handler");
- ret = wlan_objmgr_unregister_psoc_destroy_handler(WLAN_UMAC_COMP_TDLS,
- tdls_psoc_obj_destroy_notification, NULL);
- if (QDF_IS_STATUS_ERROR(ret))
- tdls_err("Failed to unregister psoc delete handler");
- ret = wlan_objmgr_unregister_vdev_create_handler(WLAN_UMAC_COMP_TDLS,
- tdls_vdev_obj_create_notification, NULL);
- if (QDF_IS_STATUS_ERROR(ret))
- tdls_err("Failed to unregister vdev create handler");
- ret = wlan_objmgr_unregister_vdev_destroy_handler(WLAN_UMAC_COMP_TDLS,
- tdls_vdev_obj_destroy_notification, NULL);
- if (QDF_IS_STATUS_ERROR(ret))
- tdls_err("Failed to unregister vdev delete handler");
- return ret;
- }
- /**
- * tdls_update_feature_flag() - update tdls feature flag
- * @tdls_soc_obj: pointer to tdls psoc object
- *
- * This function updates tdls feature flag
- */
- static void
- tdls_update_feature_flag(struct tdls_soc_priv_obj *tdls_soc_obj)
- {
- tdls_soc_obj->tdls_configs.tdls_feature_flags =
- ((tdls_soc_obj->tdls_configs.tdls_off_chan_enable ?
- 1 << TDLS_FEATURE_OFF_CHANNEL : 0) |
- (tdls_soc_obj->tdls_configs.tdls_wmm_mode_enable ?
- 1 << TDLS_FEATURE_WMM : 0) |
- (tdls_soc_obj->tdls_configs.tdls_buffer_sta_enable ?
- 1 << TDLS_FEATURE_BUFFER_STA : 0) |
- (tdls_soc_obj->tdls_configs.tdls_sleep_sta_enable ?
- 1 << TDLS_FEATURE_SLEEP_STA : 0) |
- (tdls_soc_obj->tdls_configs.tdls_scan_enable ?
- 1 << TDLS_FEATURE_SCAN : 0) |
- (tdls_soc_obj->tdls_configs.tdls_support_enable ?
- 1 << TDLS_FEATURE_ENABLE : 0) |
- (tdls_soc_obj->tdls_configs.tdls_implicit_trigger_enable ?
- 1 << TDLS_FEAUTRE_IMPLICIT_TRIGGER : 0) |
- (tdls_soc_obj->tdls_configs.tdls_external_control ?
- 1 << TDLS_FEATURE_EXTERNAL_CONTROL : 0));
- }
- /**
- * tdls_object_init_params() - init parameters for tdls object
- * @tdls_soc_obj: pointer to tdls psoc object
- *
- * This function init parameters for tdls object
- */
- static QDF_STATUS tdls_object_init_params(
- struct tdls_soc_priv_obj *tdls_soc_obj)
- {
- struct wlan_objmgr_psoc *psoc;
- if (!tdls_soc_obj) {
- tdls_err("invalid param");
- return QDF_STATUS_E_INVAL;
- }
- psoc = tdls_soc_obj->soc;
- if (!psoc) {
- tdls_err("invalid psoc object");
- return QDF_STATUS_E_INVAL;
- }
- tdls_soc_obj->tdls_configs.tdls_tx_states_period =
- cfg_get(psoc, CFG_TDLS_TX_STATS_PERIOD);
- tdls_soc_obj->tdls_configs.tdls_tx_pkt_threshold =
- cfg_get(psoc, CFG_TDLS_TX_PACKET_THRESHOLD);
- tdls_soc_obj->tdls_configs.tdls_rx_pkt_threshold =
- cfg_get(psoc, CFG_TDLS_PUAPSD_RX_FRAME_THRESHOLD);
- tdls_soc_obj->tdls_configs.tdls_max_discovery_attempt =
- cfg_get(psoc, CFG_TDLS_MAX_DISCOVERY_ATTEMPT);
- tdls_soc_obj->tdls_configs.tdls_idle_timeout =
- cfg_get(psoc, CFG_TDLS_IDLE_TIMEOUT);
- tdls_soc_obj->tdls_configs.tdls_idle_pkt_threshold =
- cfg_get(psoc, CFG_TDLS_IDLE_PACKET_THRESHOLD);
- tdls_soc_obj->tdls_configs.tdls_rssi_trigger_threshold =
- cfg_get(psoc, CFG_TDLS_RSSI_TRIGGER_THRESHOLD);
- tdls_soc_obj->tdls_configs.tdls_rssi_teardown_threshold =
- cfg_get(psoc, CFG_TDLS_RSSI_TEARDOWN_THRESHOLD);
- tdls_soc_obj->tdls_configs.tdls_rssi_delta =
- cfg_get(psoc, CFG_TDLS_RSSI_DELTA);
- tdls_soc_obj->tdls_configs.tdls_uapsd_mask =
- cfg_get(psoc, CFG_TDLS_QOS_WMM_UAPSD_MASK);
- tdls_soc_obj->tdls_configs.tdls_uapsd_inactivity_time =
- cfg_get(psoc, CFG_TDLS_PUAPSD_INACT_TIME);
- tdls_soc_obj->tdls_configs.tdls_uapsd_pti_window =
- cfg_get(psoc, CFG_TDLS_PUAPSD_PEER_TRAFFIC_IND_WINDOW);
- tdls_soc_obj->tdls_configs.tdls_uapsd_ptr_timeout =
- cfg_get(psoc, CFG_TDLS_PUAPSD_PEER_TRAFFIC_RSP_TIMEOUT);
- tdls_soc_obj->tdls_configs.tdls_pre_off_chan_num =
- cfg_get(psoc, CFG_TDLS_PREFERRED_OFF_CHANNEL_NUM);
- tdls_soc_obj->tdls_configs.tdls_pre_off_chan_bw =
- cfg_get(psoc, CFG_TDLS_PREFERRED_OFF_CHANNEL_BW);
- tdls_soc_obj->tdls_configs.tdls_peer_kickout_threshold =
- cfg_get(psoc, CFG_TDLS_PEER_KICKOUT_THRESHOLD);
- tdls_soc_obj->tdls_configs.delayed_trig_framint =
- cfg_get(psoc, CFG_TL_DELAYED_TRGR_FRM_INTERVAL);
- tdls_soc_obj->tdls_configs.tdls_wmm_mode_enable =
- cfg_get(psoc, CFG_TDLS_WMM_MODE_ENABLE);
- tdls_soc_obj->tdls_configs.tdls_off_chan_enable =
- cfg_get(psoc, CFG_TDLS_OFF_CHANNEL_ENABLED);
- tdls_soc_obj->tdls_configs.tdls_buffer_sta_enable =
- cfg_get(psoc, CFG_TDLS_BUF_STA_ENABLED);
- tdls_soc_obj->tdls_configs.tdls_scan_enable =
- cfg_get(psoc, CFG_TDLS_SCAN_ENABLE);
- tdls_soc_obj->tdls_configs.tdls_support_enable =
- cfg_get(psoc, CFG_TDLS_SUPPORT_ENABLE);
- tdls_soc_obj->tdls_configs.tdls_implicit_trigger_enable =
- cfg_get(psoc, CFG_TDLS_IMPLICIT_TRIGGER);
- tdls_soc_obj->tdls_configs.tdls_external_control =
- cfg_get(psoc, CFG_TDLS_EXTERNAL_CONTROL);
- tdls_update_feature_flag(tdls_soc_obj);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS tdls_global_init(struct tdls_soc_priv_obj *soc_obj)
- {
- tdls_object_init_params(soc_obj);
- soc_obj->connected_peer_count = 0;
- soc_obj->tdls_nss_switch_in_progress = false;
- soc_obj->tdls_teardown_peers_cnt = 0;
- soc_obj->tdls_nss_teardown_complete = false;
- soc_obj->tdls_nss_transition_mode = TDLS_NSS_TRANSITION_S_UNKNOWN;
- soc_obj->enable_tdls_connection_tracker = false;
- soc_obj->tdls_external_peer_count = 0;
- soc_obj->tdls_disable_in_progress = false;
- qdf_spinlock_create(&soc_obj->tdls_ct_spinlock);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS tdls_global_deinit(struct tdls_soc_priv_obj *soc_obj)
- {
- qdf_spinlock_destroy(&soc_obj->tdls_ct_spinlock);
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS ucfg_tdls_psoc_open(struct wlan_objmgr_psoc *psoc)
- {
- QDF_STATUS status;
- struct tdls_soc_priv_obj *soc_obj;
- tdls_debug("tdls psoc open");
- soc_obj = wlan_objmgr_psoc_get_comp_private_obj(psoc,
- WLAN_UMAC_COMP_TDLS);
- if (!soc_obj) {
- tdls_err("Failed to get tdls psoc component");
- return QDF_STATUS_E_FAILURE;
- }
- status = tdls_global_init(soc_obj);
- return status;
- }
- QDF_STATUS ucfg_tdls_update_config(struct wlan_objmgr_psoc *psoc,
- struct tdls_start_params *req)
- {
- struct tdls_soc_priv_obj *soc_obj;
- uint32_t tdls_feature_flags;
- struct policy_mgr_tdls_cbacks tdls_pm_call_backs;
- uint8_t sta_idx;
- tdls_debug("tdls update config ");
- if (!psoc || !req) {
- tdls_err("psoc: 0x%pK, req: 0x%pK", psoc, req);
- return QDF_STATUS_E_FAILURE;
- }
- soc_obj = wlan_objmgr_psoc_get_comp_private_obj(psoc,
- WLAN_UMAC_COMP_TDLS);
- if (!soc_obj) {
- tdls_err("Failed to get tdls psoc component");
- return QDF_STATUS_E_FAILURE;
- }
- soc_obj->tdls_rx_cb = req->tdls_rx_cb;
- soc_obj->tdls_rx_cb_data = req->tdls_rx_cb_data;
- soc_obj->tdls_wmm_cb = req->tdls_wmm_cb;
- soc_obj->tdls_wmm_cb_data = req->tdls_wmm_cb_data;
- soc_obj->tdls_event_cb = req->tdls_event_cb;
- soc_obj->tdls_evt_cb_data = req->tdls_evt_cb_data;
- /* Save callbacks to register/deregister TDLS sta with datapath */
- soc_obj->tdls_reg_peer = req->tdls_reg_peer;
- soc_obj->tdls_dereg_peer = req->tdls_dereg_peer;
- soc_obj->tdls_peer_context = req->tdls_peer_context;
- /* Save legacy PE/WMA commands in TDLS soc object */
- soc_obj->tdls_send_mgmt_req = req->tdls_send_mgmt_req;
- soc_obj->tdls_add_sta_req = req->tdls_add_sta_req;
- soc_obj->tdls_del_sta_req = req->tdls_del_sta_req;
- soc_obj->tdls_update_peer_state = req->tdls_update_peer_state;
- soc_obj->tdls_del_all_peers = req->tdls_del_all_peers;
- soc_obj->tdls_update_dp_vdev_flags = req->tdls_update_dp_vdev_flags;
- soc_obj->tdls_dp_vdev_update = req->tdls_dp_vdev_update;
- tdls_pm_call_backs.tdls_notify_increment_session =
- tdls_notify_increment_session;
- tdls_pm_call_backs.tdls_notify_decrement_session =
- tdls_notify_decrement_session;
- if (QDF_STATUS_SUCCESS != policy_mgr_register_tdls_cb(
- psoc, &tdls_pm_call_backs)) {
- tdls_err("policy manager callback registration failed ");
- return QDF_STATUS_E_FAILURE;
- }
- tdls_update_feature_flag(soc_obj);
- tdls_feature_flags = soc_obj->tdls_configs.tdls_feature_flags;
- if (!TDLS_IS_IMPLICIT_TRIG_ENABLED(tdls_feature_flags))
- soc_obj->tdls_current_mode = TDLS_SUPPORT_EXP_TRIG_ONLY;
- else if (TDLS_IS_EXTERNAL_CONTROL_ENABLED(tdls_feature_flags))
- soc_obj->tdls_current_mode = TDLS_SUPPORT_EXT_CONTROL;
- else
- soc_obj->tdls_current_mode = TDLS_SUPPORT_IMP_MODE;
- soc_obj->tdls_last_mode = soc_obj->tdls_current_mode;
- if (TDLS_IS_BUFFER_STA_ENABLED(tdls_feature_flags) ||
- TDLS_IS_SLEEP_STA_ENABLED(tdls_feature_flags) ||
- TDLS_IS_OFF_CHANNEL_ENABLED(tdls_feature_flags))
- soc_obj->max_num_tdls_sta =
- WLAN_TDLS_STA_P_UAPSD_OFFCHAN_MAX_NUM;
- else
- soc_obj->max_num_tdls_sta = WLAN_TDLS_STA_MAX_NUM;
- for (sta_idx = 0; sta_idx < soc_obj->max_num_tdls_sta; sta_idx++) {
- soc_obj->tdls_conn_info[sta_idx].sta_id = INVALID_TDLS_PEER_ID;
- soc_obj->tdls_conn_info[sta_idx].index =
- INVALID_TDLS_PEER_INDEX;
- soc_obj->tdls_conn_info[sta_idx].session_id = 255;
- qdf_mem_zero(&soc_obj->tdls_conn_info[sta_idx].peer_mac,
- QDF_MAC_ADDR_SIZE);
- }
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS ucfg_tdls_psoc_enable(struct wlan_objmgr_psoc *psoc)
- {
- QDF_STATUS status;
- tdls_notice("psoc tdls enable: 0x%pK", psoc);
- if (!psoc) {
- tdls_err("NULL psoc");
- return QDF_STATUS_E_FAILURE;
- }
- status = tgt_tdls_register_ev_handler(psoc);
- if (status != QDF_STATUS_SUCCESS)
- return status;
- status = wlan_serialization_register_comp_info_cb(psoc,
- WLAN_UMAC_COMP_TDLS,
- WLAN_SER_CMD_SCAN,
- tdls_scan_serialization_comp_info_cb);
- if (QDF_STATUS_SUCCESS != status) {
- tdls_err("Serialize scan cmd register failed ");
- return status;
- }
- /* register callbacks with tx/rx mgmt */
- status = tdls_mgmt_rx_ops(psoc, true);
- if (status != QDF_STATUS_SUCCESS)
- tdls_err("Failed to register mgmt rx callback, status:%d",
- status);
- return status;
- }
- QDF_STATUS ucfg_tdls_psoc_disable(struct wlan_objmgr_psoc *psoc)
- {
- QDF_STATUS status;
- struct tdls_soc_priv_obj *soc_obj = NULL;
- tdls_notice("psoc tdls disable: 0x%pK", psoc);
- if (!psoc) {
- tdls_err("NULL psoc");
- return QDF_STATUS_E_FAILURE;
- }
- status = tgt_tdls_unregister_ev_handler(psoc);
- if (QDF_IS_STATUS_ERROR(status))
- tdls_err("Failed to unregister tdls event handler");
- status = tdls_mgmt_rx_ops(psoc, false);
- if (QDF_IS_STATUS_ERROR(status))
- tdls_err("Failed to unregister mgmt rx callback");
- soc_obj = wlan_objmgr_psoc_get_comp_private_obj(psoc,
- WLAN_UMAC_COMP_TDLS);
- if (!soc_obj) {
- tdls_err("Failed to get tdls psoc component");
- return QDF_STATUS_E_FAILURE;
- }
- soc_obj->tdls_event_cb = NULL;
- soc_obj->tdls_evt_cb_data = NULL;
- return status;
- }
- QDF_STATUS ucfg_tdls_psoc_close(struct wlan_objmgr_psoc *psoc)
- {
- QDF_STATUS status = QDF_STATUS_SUCCESS;
- struct tdls_soc_priv_obj *tdls_soc;
- tdls_notice("tdls psoc close");
- tdls_soc = wlan_objmgr_psoc_get_comp_private_obj(psoc,
- WLAN_UMAC_COMP_TDLS);
- if (!tdls_soc) {
- tdls_err("Failed to get tdls psoc component");
- return QDF_STATUS_E_FAILURE;
- }
- status = tdls_global_deinit(tdls_soc);
- return status;
- }
- QDF_STATUS ucfg_tdls_add_peer(struct wlan_objmgr_vdev *vdev,
- struct tdls_add_peer_params *add_peer_req)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_add_peer_request *req;
- QDF_STATUS status;
- if (!vdev || !add_peer_req) {
- tdls_err("vdev: %pK, req %pK", vdev, add_peer_req);
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("vdevid: %d, peertype: %d",
- add_peer_req->vdev_id, add_peer_req->peer_type);
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- return status;
- }
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("mem allocate fail");
- status = QDF_STATUS_E_NOMEM;
- goto dec_ref;
- }
- qdf_mem_copy(&req->add_peer_req, add_peer_req, sizeof(*add_peer_req));
- req->vdev = vdev;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_ADD_STA;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post add peer msg fail");
- qdf_mem_free(req);
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- return status;
- }
- QDF_STATUS ucfg_tdls_update_peer(struct wlan_objmgr_vdev *vdev,
- struct tdls_update_peer_params *update_peer)
- {
- struct scheduler_msg msg = {0,};
- struct tdls_update_peer_request *req;
- QDF_STATUS status;
- if (!vdev || !update_peer) {
- tdls_err("vdev: %pK, update_peer: %pK", vdev, update_peer);
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("vdev_id: %d, peertype: %d",
- update_peer->vdev_id, update_peer->peer_type);
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- return status;
- }
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("mem allocate fail");
- status = QDF_STATUS_E_NOMEM;
- goto dec_ref;
- }
- qdf_mem_copy(&req->update_peer_req, update_peer, sizeof(*update_peer));
- req->vdev = vdev;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_CHANGE_STA;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post update peer msg fail");
- qdf_mem_free(req);
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- return status;
- }
- static char *tdls_get_oper_str(enum tdls_command_type cmd_type)
- {
- switch (cmd_type) {
- case TDLS_CMD_ENABLE_LINK:
- return "Enable_TDLS_LINK";
- case TDLS_CMD_DISABLE_LINK:
- return "DISABLE_TDLS_LINK";
- case TDLS_CMD_REMOVE_FORCE_PEER:
- return "REMOVE_FORCE_PEER";
- case TDLS_CMD_CONFIG_FORCE_PEER:
- return "CONFIG_FORCE_PEER";
- default:
- return "ERR:UNKNOWN OPER";
- }
- }
- QDF_STATUS ucfg_tdls_oper(struct wlan_objmgr_vdev *vdev,
- const uint8_t *macaddr, enum tdls_command_type cmd)
- {
- struct scheduler_msg msg = {0,};
- struct tdls_oper_request *req;
- QDF_STATUS status;
- if (!vdev || !macaddr) {
- tdls_err("vdev: %pK, mac %pK", vdev, macaddr);
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("%s for peer " QDF_MAC_ADDR_STR,
- tdls_get_oper_str(cmd),
- QDF_MAC_ADDR_ARRAY(macaddr));
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("%s: mem allocate fail", tdls_get_oper_str(cmd));
- return QDF_STATUS_E_NOMEM;
- }
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- goto error;
- }
- qdf_mem_copy(req->peer_addr, macaddr, QDF_MAC_ADDR_SIZE);
- req->vdev = vdev;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.type = cmd;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post msg for %s fail", tdls_get_oper_str(cmd));
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- error:
- qdf_mem_free(req);
- return status;
- }
- QDF_STATUS ucfg_tdls_get_all_peers(struct wlan_objmgr_vdev *vdev,
- char *buf, int buflen)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_get_all_peers *tdls_peers;
- QDF_STATUS status;
- tdls_peers = qdf_mem_malloc(sizeof(*tdls_peers));
- if (!tdls_peers) {
- tdls_err("mem allocate fail");
- return QDF_STATUS_E_NOMEM;
- }
- tdls_peers->vdev = vdev;
- tdls_peers->buf_len = buflen;
- tdls_peers->buf = buf;
- msg.bodyptr = tdls_peers;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_GET_ALL_PEERS;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (status != QDF_STATUS_SUCCESS)
- qdf_mem_free(tdls_peers);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS tdls_send_mgmt_frame_flush_callback(struct scheduler_msg *msg)
- {
- struct tdls_action_frame_request *req;
- if (!msg || !msg->bodyptr) {
- tdls_err("msg or msg->bodyptr is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- req = msg->bodyptr;
- if (req->vdev)
- wlan_objmgr_vdev_release_ref(req->vdev, WLAN_TDLS_NB_ID);
- qdf_mem_free(req);
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS ucfg_tdls_post_msg_flush_cb(struct scheduler_msg *msg)
- {
- void *ptr = msg->bodyptr;
- struct wlan_objmgr_vdev *vdev = NULL;
- switch (msg->type) {
- case TDLS_CMD_TEARDOWN_LINKS:
- case TDLS_NOTIFY_RESET_ADAPTERS:
- ptr = NULL;
- break;
- case TDLS_NOTIFY_STA_CONNECTION:
- vdev = ((struct tdls_sta_notify_params *)ptr)->vdev;
- break;
- case TDLS_NOTIFY_STA_DISCONNECTION:
- vdev = ((struct tdls_sta_notify_params *)ptr)->vdev;
- break;
- case TDLS_CMD_SET_TDLS_MODE:
- vdev = ((struct tdls_set_mode_params *)ptr)->vdev;
- break;
- case TDLS_CMD_TX_ACTION:
- case TDLS_CMD_SET_RESPONDER:
- break;
- }
- if (vdev)
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- if (ptr)
- qdf_mem_free(ptr);
- msg->bodyptr = NULL;
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS ucfg_tdls_send_mgmt_frame(
- struct tdls_action_frame_request *req)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_action_frame_request *mgmt_req;
- QDF_STATUS status;
- if (!req || !req->vdev) {
- tdls_err("Invalid mgmt req params %pK", req);
- return QDF_STATUS_E_NULL_VALUE;
- }
- mgmt_req = qdf_mem_malloc(sizeof(*mgmt_req) +
- req->len);
- if (!mgmt_req) {
- tdls_err("mem allocate fail");
- return QDF_STATUS_E_NOMEM;
- }
- qdf_mem_copy(mgmt_req, req, sizeof(*req));
- /*populate the additional IE's */
- if ((0 != req->len) && (NULL != req->cmd_buf)) {
- qdf_mem_copy(mgmt_req->tdls_mgmt.buf, req->cmd_buf,
- req->len);
- mgmt_req->tdls_mgmt.len = req->len;
- } else {
- mgmt_req->tdls_mgmt.len = 0;
- }
- tdls_debug("vdev id: %d, session id : %d", mgmt_req->vdev_id,
- mgmt_req->session_id);
- status = wlan_objmgr_vdev_try_get_ref(req->vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("Unable to get vdev reference for tdls module");
- goto mem_free;
- }
- msg.bodyptr = mgmt_req;
- msg.callback = tdls_process_cmd;
- msg.flush_callback = tdls_send_mgmt_frame_flush_callback;
- msg.type = TDLS_CMD_TX_ACTION;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status))
- goto release_ref;
- return status;
- release_ref:
- wlan_objmgr_vdev_release_ref(req->vdev, WLAN_TDLS_NB_ID);
- mem_free:
- qdf_mem_free(mgmt_req);
- return status;
- }
- QDF_STATUS ucfg_tdls_responder(struct tdls_set_responder_req *req)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_set_responder_req *msg_req;
- QDF_STATUS status;
- if (!req || !req->vdev) {
- tdls_err("invalid input %pK", req);
- return QDF_STATUS_E_NULL_VALUE;
- }
- msg_req = qdf_mem_malloc(sizeof(*msg_req));
- if (!msg_req)
- return QDF_STATUS_E_NULL_VALUE;
- msg_req->responder = req->responder;
- msg_req->vdev = req->vdev;
- qdf_mem_copy(msg_req->peer_mac, req->peer_mac, QDF_MAC_ADDR_SIZE);
- msg.bodyptr = msg_req;
- msg.callback = tdls_process_cmd;
- msg.flush_callback = ucfg_tdls_post_msg_flush_cb;
- msg.type = TDLS_CMD_SET_RESPONDER;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status))
- qdf_mem_free(msg_req);
- return status;
- }
- QDF_STATUS ucfg_tdls_teardown_links(struct wlan_objmgr_vdev *vdev)
- {
- QDF_STATUS status;
- struct scheduler_msg msg = {0, };
- if (!vdev) {
- tdls_err("vdev is NULL ");
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("Enter ");
- msg.bodyptr = vdev;
- msg.callback = tdls_process_cmd;
- msg.flush_callback = ucfg_tdls_post_msg_flush_cb;
- msg.type = TDLS_CMD_TEARDOWN_LINKS;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- tdls_debug("Exit ");
- return status;
- }
- QDF_STATUS ucfg_tdls_notify_reset_adapter(struct wlan_objmgr_vdev *vdev)
- {
- QDF_STATUS status;
- struct scheduler_msg msg = {0, };
- if (!vdev) {
- tdls_err("vdev is NULL ");
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("Enter ");
- msg.bodyptr = vdev;
- msg.callback = tdls_process_cmd;
- msg.flush_callback = ucfg_tdls_post_msg_flush_cb;
- msg.type = TDLS_NOTIFY_RESET_ADAPTERS;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- return status;
- }
- QDF_STATUS ucfg_tdls_notify_sta_connect(
- struct tdls_sta_notify_params *notify_info)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_sta_notify_params *notify;
- QDF_STATUS status;
- if (!notify_info || !notify_info->vdev) {
- tdls_err("notify_info %pK", notify_info);
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("Enter ");
- notify = qdf_mem_malloc(sizeof(*notify));
- if (!notify) {
- wlan_objmgr_vdev_release_ref(notify_info->vdev,
- WLAN_TDLS_NB_ID);
- return QDF_STATUS_E_NULL_VALUE;
- }
- *notify = *notify_info;
- msg.bodyptr = notify;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_NOTIFY_STA_CONNECTION;
- msg.flush_callback = ucfg_tdls_post_msg_flush_cb;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_TARGET_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- wlan_objmgr_vdev_release_ref(notify->vdev, WLAN_TDLS_NB_ID);
- qdf_mem_free(notify);
- }
- tdls_debug("Exit ");
- return status;
- }
- QDF_STATUS ucfg_tdls_notify_sta_disconnect(
- struct tdls_sta_notify_params *notify_info)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_sta_notify_params *notify;
- QDF_STATUS status;
- if (!notify_info || !notify_info->vdev) {
- tdls_err("notify_info %pK", notify_info);
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("Enter ");
- notify = qdf_mem_malloc(sizeof(*notify));
- if (!notify)
- return QDF_STATUS_E_NULL_VALUE;
- *notify = *notify_info;
- msg.bodyptr = notify;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_NOTIFY_STA_DISCONNECTION;
- msg.flush_callback = ucfg_tdls_post_msg_flush_cb;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_TARGET_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- wlan_objmgr_vdev_release_ref(notify->vdev, WLAN_TDLS_NB_ID);
- qdf_mem_free(notify);
- }
- tdls_debug("Exit ");
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS ucfg_tdls_set_operating_mode(
- struct tdls_set_mode_params *set_mode_params)
- {
- struct scheduler_msg msg = {0, };
- struct tdls_set_mode_params *set_mode;
- QDF_STATUS status;
- if (!set_mode_params || !set_mode_params->vdev) {
- tdls_err("set_mode_params %pK", set_mode_params);
- return QDF_STATUS_E_NULL_VALUE;
- }
- tdls_debug("Enter ");
- set_mode = qdf_mem_malloc(sizeof(*set_mode));
- if (!set_mode) {
- tdls_err("memory allocate fail");
- return QDF_STATUS_E_NULL_VALUE;
- }
- status = wlan_objmgr_vdev_try_get_ref(set_mode->vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("failed to get vdev ref");
- qdf_mem_free(set_mode);
- return status;
- }
- set_mode->source = set_mode_params->source;
- set_mode->tdls_mode = set_mode_params->tdls_mode;
- set_mode->update_last = set_mode_params->update_last;
- set_mode->vdev = set_mode_params->vdev;
- msg.bodyptr = set_mode;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_SET_TDLS_MODE;
- msg.flush_callback = ucfg_tdls_post_msg_flush_cb;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- wlan_objmgr_vdev_release_ref(set_mode->vdev, WLAN_TDLS_NB_ID);
- qdf_mem_free(set_mode);
- }
- tdls_debug("Exit ");
- return QDF_STATUS_SUCCESS;
- }
- void ucfg_tdls_update_rx_pkt_cnt(struct wlan_objmgr_vdev *vdev,
- struct qdf_mac_addr *mac_addr,
- struct qdf_mac_addr *dest_mac_addr)
- {
- QDF_STATUS status;
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (status != QDF_STATUS_SUCCESS)
- return;
- tdls_update_rx_pkt_cnt(vdev, mac_addr, dest_mac_addr);
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- }
- void ucfg_tdls_update_tx_pkt_cnt(struct wlan_objmgr_vdev *vdev,
- struct qdf_mac_addr *mac_addr)
- {
- QDF_STATUS status;
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (status != QDF_STATUS_SUCCESS)
- return;
- tdls_update_tx_pkt_cnt(vdev, mac_addr);
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- }
- QDF_STATUS ucfg_tdls_antenna_switch(struct wlan_objmgr_vdev *vdev,
- uint32_t mode)
- {
- QDF_STATUS status;
- struct tdls_antenna_switch_request *req;
- struct scheduler_msg msg = {0, };
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("mem allocate fail");
- return QDF_STATUS_E_NOMEM;
- }
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- goto error;
- }
- req->vdev = vdev;
- req->mode = mode;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.flush_callback = tdls_antenna_switch_flush_callback;
- msg.type = TDLS_CMD_ANTENNA_SWITCH;
- status = scheduler_post_message(QDF_MODULE_ID_HDD,
- QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post antenna switch msg fail");
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- error:
- qdf_mem_free(req);
- return status;
- }
- QDF_STATUS ucfg_set_tdls_offchannel(struct wlan_objmgr_vdev *vdev,
- int offchannel)
- {
- QDF_STATUS status = QDF_STATUS_SUCCESS;
- struct scheduler_msg msg = {0, };
- struct tdls_set_offchannel *req;
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("mem allocate fail");
- return QDF_STATUS_E_NOMEM;
- }
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- goto free;
- }
- req->offchannel = offchannel;
- req->vdev = vdev;
- req->callback = wlan_tdls_offchan_parms_callback;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_SET_OFFCHANNEL;
- status = scheduler_post_message(QDF_MODULE_ID_HDD, QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post set tdls offchannel msg fail");
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- free:
- qdf_mem_free(req);
- return status;
- }
- QDF_STATUS ucfg_set_tdls_offchan_mode(struct wlan_objmgr_vdev *vdev,
- int offchanmode)
- {
- QDF_STATUS status = QDF_STATUS_SUCCESS;
- struct scheduler_msg msg = {0, };
- struct tdls_set_offchanmode *req;
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("mem allocate fail");
- return QDF_STATUS_E_NOMEM;
- }
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- goto free;
- }
- req->offchan_mode = offchanmode;
- req->vdev = vdev;
- req->callback = wlan_tdls_offchan_parms_callback;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_SET_OFFCHANMODE;
- status = scheduler_post_message(QDF_MODULE_ID_HDD, QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post set offchanmode msg fail");
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- free:
- qdf_mem_free(req);
- return status;
- }
- QDF_STATUS ucfg_set_tdls_secoffchanneloffset(struct wlan_objmgr_vdev *vdev,
- int offchanoffset)
- {
- int status = QDF_STATUS_SUCCESS;
- struct scheduler_msg msg = {0, };
- struct tdls_set_secoffchanneloffset *req;
- req = qdf_mem_malloc(sizeof(*req));
- if (!req) {
- tdls_err("mem allocate fail");
- return QDF_STATUS_E_NOMEM;
- }
- status = wlan_objmgr_vdev_try_get_ref(vdev, WLAN_TDLS_NB_ID);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("can't get vdev");
- goto free;
- }
- req->offchan_offset = offchanoffset;
- req->vdev = vdev;
- req->callback = wlan_tdls_offchan_parms_callback;
- msg.bodyptr = req;
- msg.callback = tdls_process_cmd;
- msg.type = TDLS_CMD_SET_SECOFFCHANOFFSET;
- status = scheduler_post_message(QDF_MODULE_ID_HDD, QDF_MODULE_ID_TDLS,
- QDF_MODULE_ID_OS_IF, &msg);
- if (QDF_IS_STATUS_ERROR(status)) {
- tdls_err("post set secoffchan offset msg fail");
- goto dec_ref;
- }
- return status;
- dec_ref:
- wlan_objmgr_vdev_release_ref(vdev, WLAN_TDLS_NB_ID);
- free:
- qdf_mem_free(req);
- return status;
- }
|