From ef49d63e8847ce14e43023bea020273a2cc73363 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?=C3=81ngel?= <kazimiro69@gmail.com>
Date: Thu, 16 Mar 2017 16:11:33 +0100
Subject: [PATCH] Added get channel function

---
 os_dep/linux/ioctl_cfg80211.c | 113 ++++++++++++++++++++++++++++++++++
 1 file changed, 113 insertions(+)

diff --git a/os_dep/linux/ioctl_cfg80211.c b/os_dep/linux/ioctl_cfg80211.c
index 8cb5dba..0c97041 100644
--- a/os_dep/linux/ioctl_cfg80211.c
+++ b/os_dep/linux/ioctl_cfg80211.c
@@ -4575,6 +4575,118 @@ static int	cfg80211_rtw_set_monitor_channel(struct wiphy *wiphy, struct cfg80211
 }
 #endif
 
+static int cfg80211_rtw_get_channel(struct wiphy *wiphy, struct wireless_dev *wdev, struct cfg80211_chan_def *chandef){
+  _adapter *padapter= wiphy_to_adapter(wiphy);
+  int channel;
+  int control_freq;
+  int center_freq;
+  int center_freq2=0;
+  int width;
+  int band;
+  int bandWidth;
+  int offset;
+  
+  struct dvobj_priv *dvobj;
+  struct net_device *ndev = wdev->netdev;
+  HAL_DATA_TYPE	*pHalData = GET_HAL_DATA(padapter);
+  if (!ndev)
+    return -ENODEV;
+  
+  offset = rtw_get_oper_choffset(padapter);
+  channel = adapter_to_dvobj(padapter)->oper_channel;
+
+  if(channel >= 1){
+    switch(pHalData->CurrentBandType){
+      case 0:
+	band = NL80211_BAND_2GHZ;
+	break;
+      case 1:
+	band = NL80211_BAND_5GHZ;
+	break;
+      default:
+	return -EINVAL;
+	
+    }
+    control_freq =  ieee80211_channel_to_frequency(channel, band);
+    
+    dvobj=adapter_to_dvobj(padapter);
+    if(dvobj!=NULL){
+      bandWidth = adapter_to_dvobj(padapter)->oper_bwmode;
+      DBG_871X("%s bw %d\n", __func__,adapter_to_dvobj(padapter)->oper_bwmode);
+    }else{
+      bandWidth = pHalData->CurrentChannelBW;
+      DBG_871X("%s dvobj null\n", __func__);
+    }
+    switch(pHalData->CurrentChannelBW){
+      case CHANNEL_WIDTH_20:
+	DBG_871X("%s width 20\n", __func__);
+	width = NL80211_CHAN_WIDTH_20;
+	center_freq = control_freq;
+	break;
+      case CHANNEL_WIDTH_40:
+	DBG_871X("%s width 40\n", __func__);
+	width = NL80211_CHAN_WIDTH_40;
+	if(offset==HAL_PRIME_CHNL_OFFSET_LOWER){
+	  center_freq = control_freq +10;
+	}else{
+	  center_freq = control_freq -10;
+	}
+	break;
+      case CHANNEL_WIDTH_80:
+	DBG_871X("%s width 80\n", __func__);
+	width = NL80211_CHAN_WIDTH_80;
+	if(offset==HAL_PRIME_CHNL_OFFSET_LOWER){
+	  center_freq = control_freq +30;
+	}else{
+	  center_freq = control_freq -30;
+	}
+	break;
+      case CHANNEL_WIDTH_160:
+	DBG_871X("%s width 160\n", __func__);
+	width = NL80211_CHAN_WIDTH_160;
+	if(offset==HAL_PRIME_CHNL_OFFSET_LOWER){
+	  center_freq = control_freq +50;
+	}else{
+	  center_freq = control_freq -50;
+	}
+	break;
+      case CHANNEL_WIDTH_80_80:
+	DBG_871X("%s width 80x80\n", __func__);
+	width = NL80211_CHAN_WIDTH_80P80;
+	if(offset==HAL_PRIME_CHNL_OFFSET_LOWER){
+	  center_freq = control_freq +30;
+	  center_freq2=center_freq+80;
+	}else{
+	  center_freq = control_freq -30;
+	  center_freq2=center_freq-80;
+	}
+	break;
+      case CHANNEL_WIDTH_MAX:
+	DBG_871X("%s width max\n", __func__);
+	width = NL80211_CHAN_WIDTH_160;
+	break;
+    }
+    chandef->chan = ieee80211_get_channel(wiphy, control_freq);
+    if(chandef->chan == NULL){
+      chandef->chan = ieee80211_get_channel(wiphy, ieee80211_channel_to_frequency(channel, band));
+      DBG_871X("%s chan null\n", __func__);
+      if(chandef->chan == NULL){
+	DBG_871X("%s chan null\n", __func__);
+	return -EINVAL;
+      }
+    }
+    chandef->width = width;
+    chandef->center_freq1 = center_freq;
+    chandef->center_freq2 = center_freq2;  
+    DBG_871X("%s : channel %d width %d freq1 %d freq2 %d center_freq %d offset %d\n", __func__, channel, width, chandef->center_freq1, chandef->center_freq2, chandef->chan->center_freq,rtw_get_oper_choffset(padapter));
+
+  }else{
+      return -EINVAL;
+  }
+  return 0;
+ 
+}
+
 static int	cfg80211_rtw_set_channel(struct wiphy *wiphy
 	#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,35))
 	, struct net_device *ndev
@@ -6603,6 +6715,7 @@ static struct cfg80211_ops rtw_cfg80211_ops = {
 	.sched_scan_start = cfg80211_rtw_sched_scan_start,
 	.sched_scan_stop = cfg80211_rtw_sched_scan_stop,
 #endif /* CONFIG_PNO_SUPPORT */
+	.get_channel = cfg80211_rtw_get_channel,
 };
 
 struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev)