blob: 7e38af5e1765739b732029f3e4b7943e2eaa707c [file] [log] [blame]
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001/************************************************************
Kevin McKinney9937fdb2012-01-04 20:29:00 -05002 * CMHOST.C
3 * This file contains the routines for handling Connection
4 * Management.
5 ************************************************************/
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07006
Kevin McKinney9937fdb2012-01-04 20:29:00 -05007/* #define CONN_MSG */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07008#include "headers.h"
9
Kevin McKinney5db125f2012-01-04 20:29:02 -050010enum E_CLASSIFIER_ACTION {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070011 eInvalidClassifierAction,
12 eAddClassifier,
13 eReplaceClassifier,
14 eDeleteClassifier
Kevin McKinney5db125f2012-01-04 20:29:02 -050015};
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070016
Kevin McKinney9937fdb2012-01-04 20:29:00 -050017static ULONG GetNextTargetBufferLocation(PMINI_ADAPTER Adapter, B_UINT16 tid);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070018
19/************************************************************
Kevin McKinney9937fdb2012-01-04 20:29:00 -050020 * Function - SearchSfid
21 *
22 * Description - This routinue would search QOS queues having
23 * specified SFID as input parameter.
24 *
25 * Parameters - Adapter: Pointer to the Adapter structure
26 * uiSfid : Given SFID for matching
27 *
28 * Returns - Queue index for this SFID(If matched)
29 * Else Invalid Queue Index(If Not matched)
30 ************************************************************/
Kevin McKinneyce4bbc22012-01-04 20:29:04 -050031int SearchSfid(PMINI_ADAPTER Adapter, UINT uiSfid)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070032{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050033 int i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -050034
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050035 for (i = (NO_OF_QUEUES-1); i >= 0; i--)
36 if (Adapter->PackInfo[i].ulSFID == uiSfid)
37 return i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -050038
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070039 return NO_OF_QUEUES+1;
40}
41
42/***************************************************************
Kevin McKinney9937fdb2012-01-04 20:29:00 -050043 * Function -SearchFreeSfid
44 *
45 * Description - This routinue would search Free available SFID.
46 *
47 * Parameter - Adapter: Pointer to the Adapter structure
48 *
49 * Returns - Queue index for the free SFID
50 * Else returns Invalid Index.
51 ****************************************************************/
Kevin McKinneyce4bbc22012-01-04 20:29:04 -050052static int SearchFreeSfid(PMINI_ADAPTER Adapter)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070053{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050054 int i;
Stephen Hemminger20f48652010-10-31 23:52:36 -040055
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050056 for (i = 0; i < (NO_OF_QUEUES-1); i++)
57 if (Adapter->PackInfo[i].ulSFID == 0)
58 return i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -050059
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070060 return NO_OF_QUEUES+1;
61}
62
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070063/*
Kevin McKinney9937fdb2012-01-04 20:29:00 -050064 * Function: SearchClsid
65 * Description: This routinue would search Classifier having specified ClassifierID as input parameter
66 * Input parameters: PMINI_ADAPTER Adapter - Adapter Context
67 * unsigned int uiSfid - The SF in which the classifier is to searched
68 * B_UINT16 uiClassifierID - The classifier ID to be searched
69 * Return: int :Classifier table index of matching entry
70 */
71static int SearchClsid(PMINI_ADAPTER Adapter, ULONG ulSFID, B_UINT16 uiClassifierID)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070072{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050073 int i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -050074
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050075 for (i = 0; i < MAX_CLASSIFIERS; i++) {
76 if ((Adapter->astClassifierTable[i].bUsed) &&
77 (Adapter->astClassifierTable[i].uiClassifierRuleIndex == uiClassifierID) &&
78 (Adapter->astClassifierTable[i].ulSFID == ulSFID))
79 return i;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070080 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -050081
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070082 return MAX_CLASSIFIERS+1;
83}
84
Kevin McKinney9937fdb2012-01-04 20:29:00 -050085/*
86 * @ingroup ctrl_pkt_functions
87 * This routinue would search Free available Classifier entry in classifier table.
88 * @return free Classifier Entry index in classifier table for specified SF
89 */
90static int SearchFreeClsid(PMINI_ADAPTER Adapter /**Adapter Context*/)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070091{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050092 int i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -050093
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -050094 for (i = 0; i < MAX_CLASSIFIERS; i++) {
95 if (!Adapter->astClassifierTable[i].bUsed)
96 return i;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070097 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -050098
Stephen Hemmingerf8942e02010-09-08 14:46:36 -070099 return MAX_CLASSIFIERS+1;
100}
101
Stephen Hemminger9dd47ee2010-11-01 12:24:00 -0400102static VOID deleteSFBySfid(PMINI_ADAPTER Adapter, UINT uiSearchRuleIndex)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700103{
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500104 /* deleting all the packet held in the SF */
105 flush_queue(Adapter, uiSearchRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700106
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500107 /* Deleting the all classifiers for this SF */
108 DeleteAllClassifiersForSF(Adapter, uiSearchRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700109
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500110 /* Resetting only MIBS related entries in the SF */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700111 memset((PVOID)&Adapter->PackInfo[uiSearchRuleIndex], 0, sizeof(S_MIBS_SERVICEFLOW_TABLE));
112}
113
114static inline VOID
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500115CopyIpAddrToClassifier(S_CLASSIFIER_RULE *pstClassifierEntry,
116 B_UINT8 u8IpAddressLen, B_UINT8 *pu8IpAddressMaskSrc,
117 BOOLEAN bIpVersion6, E_IPADDR_CONTEXT eIpAddrContext)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700118{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500119 int i = 0;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500120 UINT nSizeOfIPAddressInBytes = IP_LENGTH_OF_ADDRESS;
121 UCHAR *ptrClassifierIpAddress = NULL;
122 UCHAR *ptrClassifierIpMask = NULL;
123 PMINI_ADAPTER Adapter = GET_BCM_ADAPTER(gblpnetdev);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700124
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500125 if (bIpVersion6)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700126 nSizeOfIPAddressInBytes = IPV6_ADDRESS_SIZEINBYTES;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500127
128 /* Destination Ip Address */
129 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Ip Address Range Length:0x%X ", u8IpAddressLen);
130 if ((bIpVersion6 ? (IPV6_ADDRESS_SIZEINBYTES * MAX_IP_RANGE_LENGTH * 2) :
131 (TOTAL_MASKED_ADDRESS_IN_BYTES)) >= u8IpAddressLen) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700132 /*
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500133 * checking both the mask and address togethor in Classification.
134 * So length will be : TotalLengthInBytes/nSizeOfIPAddressInBytes * 2
135 * (nSizeOfIPAddressInBytes for address and nSizeOfIPAddressInBytes for mask)
136 */
137 if (eIpAddrContext == eDestIpAddress) {
138 pstClassifierEntry->ucIPDestinationAddressLength = u8IpAddressLen/(nSizeOfIPAddressInBytes * 2);
139 if (bIpVersion6) {
140 ptrClassifierIpAddress = pstClassifierEntry->stDestIpAddress.ucIpv6Address;
141 ptrClassifierIpMask = pstClassifierEntry->stDestIpAddress.ucIpv6Mask;
142 } else {
143 ptrClassifierIpAddress = pstClassifierEntry->stDestIpAddress.ucIpv4Address;
144 ptrClassifierIpMask = pstClassifierEntry->stDestIpAddress.ucIpv4Mask;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700145 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500146 } else if (eIpAddrContext == eSrcIpAddress) {
147 pstClassifierEntry->ucIPSourceAddressLength = u8IpAddressLen/(nSizeOfIPAddressInBytes * 2);
148 if (bIpVersion6) {
149 ptrClassifierIpAddress = pstClassifierEntry->stSrcIpAddress.ucIpv6Address;
150 ptrClassifierIpMask = pstClassifierEntry->stSrcIpAddress.ucIpv6Mask;
151 } else {
152 ptrClassifierIpAddress = pstClassifierEntry->stSrcIpAddress.ucIpv4Address;
153 ptrClassifierIpMask = pstClassifierEntry->stSrcIpAddress.ucIpv4Mask;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700154 }
155 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500156 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Address Length:0x%X\n", pstClassifierEntry->ucIPDestinationAddressLength);
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500157 while ((u8IpAddressLen >= nSizeOfIPAddressInBytes) && (i < MAX_IP_RANGE_LENGTH)) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700158 memcpy(ptrClassifierIpAddress +
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500159 (i * nSizeOfIPAddressInBytes),
160 (pu8IpAddressMaskSrc+(i*nSizeOfIPAddressInBytes*2)),
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700161 nSizeOfIPAddressInBytes);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500162
163 if (!bIpVersion6) {
164 if (eIpAddrContext == eSrcIpAddress) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500165 pstClassifierEntry->stSrcIpAddress.ulIpv4Addr[i] = ntohl(pstClassifierEntry->stSrcIpAddress.ulIpv4Addr[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500166 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Src Ip Address:0x%luX ",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500167 pstClassifierEntry->stSrcIpAddress.ulIpv4Addr[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500168 } else if (eIpAddrContext == eDestIpAddress) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500169 pstClassifierEntry->stDestIpAddress.ulIpv4Addr[i] = ntohl(pstClassifierEntry->stDestIpAddress.ulIpv4Addr[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500170 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Dest Ip Address:0x%luX ",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500171 pstClassifierEntry->stDestIpAddress.ulIpv4Addr[i]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700172 }
173 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500174 u8IpAddressLen -= nSizeOfIPAddressInBytes;
175 if (u8IpAddressLen >= nSizeOfIPAddressInBytes) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700176 memcpy(ptrClassifierIpMask +
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500177 (i * nSizeOfIPAddressInBytes),
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700178 (pu8IpAddressMaskSrc+nSizeOfIPAddressInBytes +
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500179 (i*nSizeOfIPAddressInBytes*2)),
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700180 nSizeOfIPAddressInBytes);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500181
182 if (!bIpVersion6) {
183 if (eIpAddrContext == eSrcIpAddress) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500184 pstClassifierEntry->stSrcIpAddress.ulIpv4Mask[i] =
185 ntohl(pstClassifierEntry->stSrcIpAddress.ulIpv4Mask[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500186 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Src Ip Mask Address:0x%luX ",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500187 pstClassifierEntry->stSrcIpAddress.ulIpv4Mask[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500188 } else if (eIpAddrContext == eDestIpAddress) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500189 pstClassifierEntry->stDestIpAddress.ulIpv4Mask[i] =
190 ntohl(pstClassifierEntry->stDestIpAddress.ulIpv4Mask[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500191 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Dest Ip Mask Address:0x%luX ",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500192 pstClassifierEntry->stDestIpAddress.ulIpv4Mask[i]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700193 }
194 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500195 u8IpAddressLen -= nSizeOfIPAddressInBytes;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700196 }
Kevin McKinneycffae182012-01-04 20:29:03 -0500197 if (u8IpAddressLen == 0)
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500198 pstClassifierEntry->bDestIpValid = TRUE;
199
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500200 i++;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700201 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500202 if (bIpVersion6) {
203 /* Restore EndianNess of Struct */
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500204 for (i = 0; i < MAX_IP_RANGE_LENGTH * 4; i++) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500205 if (eIpAddrContext == eSrcIpAddress) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500206 pstClassifierEntry->stSrcIpAddress.ulIpv6Addr[i] = ntohl(pstClassifierEntry->stSrcIpAddress.ulIpv6Addr[i]);
207 pstClassifierEntry->stSrcIpAddress.ulIpv6Mask[i] = ntohl(pstClassifierEntry->stSrcIpAddress.ulIpv6Mask[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500208 } else if (eIpAddrContext == eDestIpAddress) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500209 pstClassifierEntry->stDestIpAddress.ulIpv6Addr[i] = ntohl(pstClassifierEntry->stDestIpAddress.ulIpv6Addr[i]);
210 pstClassifierEntry->stDestIpAddress.ulIpv6Mask[i] = ntohl(pstClassifierEntry->stDestIpAddress.ulIpv6Mask[i]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700211 }
212 }
213 }
214 }
215}
216
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500217void ClearTargetDSXBuffer(PMINI_ADAPTER Adapter, B_UINT16 TID, BOOLEAN bFreeAll)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700218{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500219 int i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500220
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500221 for (i = 0; i < Adapter->ulTotalTargetBuffersAvailable; i++) {
222 if (Adapter->astTargetDsxBuffer[i].valid)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700223 continue;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500224
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500225 if ((bFreeAll) || (Adapter->astTargetDsxBuffer[i].tid == TID)) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500226 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "ClearTargetDSXBuffer: found tid %d buffer cleared %lx\n",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500227 TID, Adapter->astTargetDsxBuffer[i].ulTargetDsxBuffer);
228 Adapter->astTargetDsxBuffer[i].valid = 1;
229 Adapter->astTargetDsxBuffer[i].tid = 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700230 Adapter->ulFreeTargetBufferCnt++;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500231 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700232 }
233}
234
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500235/*
236 * @ingroup ctrl_pkt_functions
237 * copy classifier rule into the specified SF index
238 */
239static inline VOID CopyClassifierRuleToSF(PMINI_ADAPTER Adapter, stConvergenceSLTypes *psfCSType, UINT uiSearchRuleIndex, UINT nClassifierIndex)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700240{
241 S_CLASSIFIER_RULE *pstClassifierEntry = NULL;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500242 /* VOID *pvPhsContext = NULL; */
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500243 int i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500244 /* UCHAR ucProtocolLength=0; */
245 /* ULONG ulPhsStatus; */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700246
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500247 if (Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value == 0 ||
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700248 nClassifierIndex > (MAX_CLASSIFIERS-1))
249 return;
250
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500251 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Storing Classifier Rule Index : %X",
252 ntohs(psfCSType->cCPacketClassificationRule.u16PacketClassificationRuleIndex));
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700253
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500254 if (nClassifierIndex > MAX_CLASSIFIERS-1)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700255 return;
256
257 pstClassifierEntry = &Adapter->astClassifierTable[nClassifierIndex];
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500258 if (pstClassifierEntry) {
259 /* Store if Ipv6 */
260 pstClassifierEntry->bIpv6Protocol = (Adapter->PackInfo[uiSearchRuleIndex].ucIpVersion == IPV6) ? TRUE : FALSE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700261
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500262 /* Destinaiton Port */
263 pstClassifierEntry->ucDestPortRangeLength = psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRangeLength / 4;
264 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Destination Port Range Length:0x%X ", pstClassifierEntry->ucDestPortRangeLength);
265
Kevin McKinneycffae182012-01-04 20:29:03 -0500266 if (psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRangeLength <= MAX_PORT_RANGE) {
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500267 for (i = 0; i < (pstClassifierEntry->ucDestPortRangeLength); i++) {
268 pstClassifierEntry->usDestPortRangeLo[i] = *((PUSHORT)(psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange+i));
269 pstClassifierEntry->usDestPortRangeHi[i] =
270 *((PUSHORT)(psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange+2+i));
271 pstClassifierEntry->usDestPortRangeLo[i] = ntohs(pstClassifierEntry->usDestPortRangeLo[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500272 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Destination Port Range Lo:0x%X ",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500273 pstClassifierEntry->usDestPortRangeLo[i]);
274 pstClassifierEntry->usDestPortRangeHi[i] = ntohs(pstClassifierEntry->usDestPortRangeHi[i]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700275 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500276 } else {
277 pstClassifierEntry->ucDestPortRangeLength = 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700278 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500279
280 /* Source Port */
281 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Source Port Range Length:0x%X ",
282 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRangeLength);
Kevin McKinneycffae182012-01-04 20:29:03 -0500283 if (psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRangeLength <= MAX_PORT_RANGE) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500284 pstClassifierEntry->ucSrcPortRangeLength = psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRangeLength/4;
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500285 for (i = 0; i < (pstClassifierEntry->ucSrcPortRangeLength); i++) {
286 pstClassifierEntry->usSrcPortRangeLo[i] =
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500287 *((PUSHORT)(psfCSType->cCPacketClassificationRule.
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500288 u8ProtocolSourcePortRange+i));
289 pstClassifierEntry->usSrcPortRangeHi[i] =
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500290 *((PUSHORT)(psfCSType->cCPacketClassificationRule.
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500291 u8ProtocolSourcePortRange+2+i));
292 pstClassifierEntry->usSrcPortRangeLo[i] =
293 ntohs(pstClassifierEntry->usSrcPortRangeLo[i]);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500294 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Source Port Range Lo:0x%X ",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500295 pstClassifierEntry->usSrcPortRangeLo[i]);
296 pstClassifierEntry->usSrcPortRangeHi[i] = ntohs(pstClassifierEntry->usSrcPortRangeHi[i]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700297 }
298 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500299 /* Destination Ip Address and Mask */
300 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Ip Destination Parameters : ");
301 CopyIpAddrToClassifier(pstClassifierEntry,
302 psfCSType->cCPacketClassificationRule.u8IPDestinationAddressLength,
303 psfCSType->cCPacketClassificationRule.u8IPDestinationAddress,
304 (Adapter->PackInfo[uiSearchRuleIndex].ucIpVersion == IPV6) ?
305 TRUE : FALSE, eDestIpAddress);
306
307 /* Source Ip Address and Mask */
308 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Ip Source Parameters : ");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700309
310 CopyIpAddrToClassifier(pstClassifierEntry,
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500311 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddressLength,
312 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddress,
313 (Adapter->PackInfo[uiSearchRuleIndex].ucIpVersion == IPV6) ? TRUE : FALSE,
314 eSrcIpAddress);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700315
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500316 /* TOS */
317 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "TOS Length:0x%X ", psfCSType->cCPacketClassificationRule.u8IPTypeOfServiceLength);
Kevin McKinneycffae182012-01-04 20:29:03 -0500318 if (psfCSType->cCPacketClassificationRule.u8IPTypeOfServiceLength == 3) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500319 pstClassifierEntry->ucIPTypeOfServiceLength = psfCSType->cCPacketClassificationRule.u8IPTypeOfServiceLength;
320 pstClassifierEntry->ucTosLow = psfCSType->cCPacketClassificationRule.u8IPTypeOfService[0];
321 pstClassifierEntry->ucTosHigh = psfCSType->cCPacketClassificationRule.u8IPTypeOfService[1];
322 pstClassifierEntry->ucTosMask = psfCSType->cCPacketClassificationRule.u8IPTypeOfService[2];
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700323 pstClassifierEntry->bTOSValid = TRUE;
324 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500325 if (psfCSType->cCPacketClassificationRule.u8Protocol == 0) {
326 /* we didn't get protocol field filled in by the BS */
327 pstClassifierEntry->ucProtocolLength = 0;
328 } else {
329 pstClassifierEntry->ucProtocolLength = 1; /* 1 valid protocol */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700330 }
331
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500332 pstClassifierEntry->ucProtocol[0] = psfCSType->cCPacketClassificationRule.u8Protocol;
333 pstClassifierEntry->u8ClassifierRulePriority = psfCSType->cCPacketClassificationRule.u8ClassifierRulePriority;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700334
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500335 /* store the classifier rule ID and set this classifier entry as valid */
336 pstClassifierEntry->ucDirection = Adapter->PackInfo[uiSearchRuleIndex].ucDirection;
337 pstClassifierEntry->uiClassifierRuleIndex = ntohs(psfCSType->cCPacketClassificationRule.u16PacketClassificationRuleIndex);
338 pstClassifierEntry->usVCID_Value = Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value;
339 pstClassifierEntry->ulSFID = Adapter->PackInfo[uiSearchRuleIndex].ulSFID;
340 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Search Index %d Dir: %d, Index: %d, Vcid: %d\n",
341 uiSearchRuleIndex, pstClassifierEntry->ucDirection,
342 pstClassifierEntry->uiClassifierRuleIndex,
343 pstClassifierEntry->usVCID_Value);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700344
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500345 if (psfCSType->cCPacketClassificationRule.u8AssociatedPHSI)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700346 pstClassifierEntry->u8AssociatedPHSI = psfCSType->cCPacketClassificationRule.u8AssociatedPHSI;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700347
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500348 /* Copy ETH CS Parameters */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700349 pstClassifierEntry->ucEthCSSrcMACLen = (psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddressLength);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500350 memcpy(pstClassifierEntry->au8EThCSSrcMAC, psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress, MAC_ADDRESS_SIZE);
351 memcpy(pstClassifierEntry->au8EThCSSrcMACMask, psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress + MAC_ADDRESS_SIZE, MAC_ADDRESS_SIZE);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700352 pstClassifierEntry->ucEthCSDestMACLen = (psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500353 memcpy(pstClassifierEntry->au8EThCSDestMAC, psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress, MAC_ADDRESS_SIZE);
354 memcpy(pstClassifierEntry->au8EThCSDestMACMask, psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress + MAC_ADDRESS_SIZE, MAC_ADDRESS_SIZE);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700355 pstClassifierEntry->ucEtherTypeLen = (psfCSType->cCPacketClassificationRule.u8EthertypeLength);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500356 memcpy(pstClassifierEntry->au8EthCSEtherType, psfCSType->cCPacketClassificationRule.u8Ethertype, NUM_ETHERTYPE_BYTES);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700357 memcpy(pstClassifierEntry->usUserPriority, &psfCSType->cCPacketClassificationRule.u16UserPriority, 2);
358 pstClassifierEntry->usVLANID = ntohs(psfCSType->cCPacketClassificationRule.u16VLANID);
359 pstClassifierEntry->usValidityBitMap = ntohs(psfCSType->cCPacketClassificationRule.u16ValidityBitMap);
360
361 pstClassifierEntry->bUsed = TRUE;
362 }
363}
364
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500365/*
366 * @ingroup ctrl_pkt_functions
367 */
368static inline VOID DeleteClassifierRuleFromSF(PMINI_ADAPTER Adapter, UINT uiSearchRuleIndex, UINT nClassifierIndex)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700369{
370 S_CLASSIFIER_RULE *pstClassifierEntry = NULL;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500371 B_UINT16 u16PacketClassificationRuleIndex;
372 USHORT usVCID;
373 /* VOID *pvPhsContext = NULL; */
374 /*ULONG ulPhsStatus; */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700375
376 usVCID = Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value;
377
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500378 if (nClassifierIndex > MAX_CLASSIFIERS-1)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700379 return;
380
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500381 if (usVCID == 0)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700382 return;
383
384 u16PacketClassificationRuleIndex = Adapter->astClassifierTable[nClassifierIndex].uiClassifierRuleIndex;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700385 pstClassifierEntry = &Adapter->astClassifierTable[nClassifierIndex];
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500386 if (pstClassifierEntry) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700387 pstClassifierEntry->bUsed = FALSE;
388 pstClassifierEntry->uiClassifierRuleIndex = 0;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500389 memset(pstClassifierEntry, 0, sizeof(S_CLASSIFIER_RULE));
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700390
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500391 /* Delete the PHS Rule for this classifier */
392 PhsDeleteClassifierRule(&Adapter->stBCMPhsContext, usVCID, u16PacketClassificationRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700393 }
394}
395
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500396/*
397 * @ingroup ctrl_pkt_functions
398 */
399VOID DeleteAllClassifiersForSF(PMINI_ADAPTER Adapter, UINT uiSearchRuleIndex)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700400{
401 S_CLASSIFIER_RULE *pstClassifierEntry = NULL;
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500402 int i;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500403 /* B_UINT16 u16PacketClassificationRuleIndex; */
404 USHORT ulVCID;
405 /* VOID *pvPhsContext = NULL; */
406 /* ULONG ulPhsStatus; */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700407
408 ulVCID = Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value;
409
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500410 if (ulVCID == 0)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700411 return;
412
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500413 for (i = 0; i < MAX_CLASSIFIERS; i++) {
414 if (Adapter->astClassifierTable[i].usVCID_Value == ulVCID) {
415 pstClassifierEntry = &Adapter->astClassifierTable[i];
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500416
417 if (pstClassifierEntry->bUsed)
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500418 DeleteClassifierRuleFromSF(Adapter, uiSearchRuleIndex, i);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700419 }
420 }
421
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500422 /* Delete All Phs Rules Associated with this SF */
423 PhsDeleteSFRules(&Adapter->stBCMPhsContext, ulVCID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700424}
425
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500426/*
427 * This routinue copies the Connection Management
428 * related data into the Adapter structure.
429 * @ingroup ctrl_pkt_functions
430 */
431static VOID CopyToAdapter(register PMINI_ADAPTER Adapter, /* <Pointer to the Adapter structure */
432 register pstServiceFlowParamSI psfLocalSet, /* <Pointer to the ServiceFlowParamSI structure */
433 register UINT uiSearchRuleIndex, /* <Index of Queue, to which this data belongs */
434 register UCHAR ucDsxType,
435 stLocalSFAddIndicationAlt *pstAddIndication) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700436
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500437 /* UCHAR ucProtocolLength = 0; */
438 ULONG ulSFID;
439 UINT nClassifierIndex = 0;
Kevin McKinney5db125f2012-01-04 20:29:02 -0500440 enum E_CLASSIFIER_ACTION eClassifierAction = eInvalidClassifierAction;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500441 B_UINT16 u16PacketClassificationRuleIndex = 0;
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500442 int i;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700443 stConvergenceSLTypes *psfCSType = NULL;
444 S_PHS_RULE sPhsRule;
445 USHORT uVCID = Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value;
446 UINT UGIValue = 0;
447
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500448 Adapter->PackInfo[uiSearchRuleIndex].bValid = TRUE;
449 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Search Rule Index = %d\n", uiSearchRuleIndex);
Kevin McKinneye4868622012-01-04 20:29:01 -0500450 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "%s: SFID= %x ", __func__, ntohl(psfLocalSet->u32SFID));
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500451 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Updating Queue %d", uiSearchRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700452
453 ulSFID = ntohl(psfLocalSet->u32SFID);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500454 /* Store IP Version used */
455 /* Get The Version Of IP used (IPv6 or IPv4) from CSSpecification field of SF */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700456
457 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport = 0;
458 Adapter->PackInfo[uiSearchRuleIndex].bEthCSSupport = 0;
459
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500460 /* Enable IP/ETh CS Support As Required */
461 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "CopyToAdapter : u8CSSpecification : %X\n", psfLocalSet->u8CSSpecification);
462 switch (psfLocalSet->u8CSSpecification) {
463 case eCSPacketIPV4:
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700464 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500465 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport = IPV4_CS;
466 break;
467 }
468 case eCSPacketIPV6:
469 {
470 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport = IPV6_CS;
471 break;
472 }
473 case eCS802_3PacketEthernet:
474 case eCS802_1QPacketVLAN:
475 {
476 Adapter->PackInfo[uiSearchRuleIndex].bEthCSSupport = ETH_CS_802_3;
477 break;
478 }
479 case eCSPacketIPV4Over802_1QVLAN:
480 case eCSPacketIPV4Over802_3Ethernet:
481 {
482 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport = IPV4_CS;
483 Adapter->PackInfo[uiSearchRuleIndex].bEthCSSupport = ETH_CS_802_3;
484 break;
485 }
486 case eCSPacketIPV6Over802_1QVLAN:
487 case eCSPacketIPV6Over802_3Ethernet:
488 {
489 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport = IPV6_CS;
490 Adapter->PackInfo[uiSearchRuleIndex].bEthCSSupport = ETH_CS_802_3;
491 break;
492 }
493 default:
494 {
495 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Error in value of CS Classification.. setting default to IP CS\n");
496 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport = IPV4_CS;
497 break;
498 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700499 }
500
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500501 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "CopyToAdapter : Queue No : %X ETH CS Support : %X , IP CS Support : %X\n",
502 uiSearchRuleIndex,
503 Adapter->PackInfo[uiSearchRuleIndex].bEthCSSupport,
504 Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700505
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500506 /* Store IP Version used */
507 /* Get The Version Of IP used (IPv6 or IPv4) from CSSpecification field of SF */
508 if (Adapter->PackInfo[uiSearchRuleIndex].bIPCSSupport == IPV6_CS)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700509 Adapter->PackInfo[uiSearchRuleIndex].ucIpVersion = IPV6;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700510 else
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700511 Adapter->PackInfo[uiSearchRuleIndex].ucIpVersion = IPV4;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700512
513 /* To ensure that the ETH CS code doesn't gets executed if the BS doesn't supports ETH CS */
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500514 if (!Adapter->bETHCSEnabled)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700515 Adapter->PackInfo[uiSearchRuleIndex].bEthCSSupport = 0;
516
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500517 if (psfLocalSet->u8ServiceClassNameLength > 0 && psfLocalSet->u8ServiceClassNameLength < 32)
518 memcpy(Adapter->PackInfo[uiSearchRuleIndex].ucServiceClassName, psfLocalSet->u8ServiceClassName, psfLocalSet->u8ServiceClassNameLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700519
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500520 Adapter->PackInfo[uiSearchRuleIndex].u8QueueType = psfLocalSet->u8ServiceFlowSchedulingType;
521
522 if (Adapter->PackInfo[uiSearchRuleIndex].u8QueueType == BE && Adapter->PackInfo[uiSearchRuleIndex].ucDirection)
523 Adapter->usBestEffortQueueIndex = uiSearchRuleIndex;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700524
525 Adapter->PackInfo[uiSearchRuleIndex].ulSFID = ntohl(psfLocalSet->u32SFID);
526
527 Adapter->PackInfo[uiSearchRuleIndex].u8TrafficPriority = psfLocalSet->u8TrafficPriority;
528
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500529 /* copy all the classifier in the Service Flow param structure */
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500530 for (i = 0; i < psfLocalSet->u8TotalClassifiers; i++) {
531 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Classifier index =%d", i);
532 psfCSType = &psfLocalSet->cConvergenceSLTypes[i];
533 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Classifier index =%d", i);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700534
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500535 if (psfCSType->cCPacketClassificationRule.u8ClassifierRulePriority)
536 Adapter->PackInfo[uiSearchRuleIndex].bClassifierPriority = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700537
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500538 if (psfCSType->cCPacketClassificationRule.u8ClassifierRulePriority)
539 Adapter->PackInfo[uiSearchRuleIndex].bClassifierPriority = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700540
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500541 if (ucDsxType == DSA_ACK) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700542 eClassifierAction = eAddClassifier;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500543 } else if (ucDsxType == DSC_ACK) {
544 switch (psfCSType->u8ClassfierDSCAction) {
545 case 0: /* DSC Add Classifier */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700546 {
547 eClassifierAction = eAddClassifier;
548 }
549 break;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500550 case 1: /* DSC Replace Classifier */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700551 {
552 eClassifierAction = eReplaceClassifier;
553 }
554 break;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500555 case 2: /* DSC Delete Classifier */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700556 {
557 eClassifierAction = eDeleteClassifier;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700558 }
559 break;
560 default:
561 {
562 eClassifierAction = eInvalidClassifierAction;
563 }
564 }
565 }
566
567 u16PacketClassificationRuleIndex = ntohs(psfCSType->cCPacketClassificationRule.u16PacketClassificationRuleIndex);
568
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500569 switch (eClassifierAction) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700570 case eAddClassifier:
571 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500572 /* Get a Free Classifier Index From Classifier table for this SF to add the Classifier */
573 /* Contained in this message */
574 nClassifierIndex = SearchClsid(Adapter, ulSFID, u16PacketClassificationRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700575
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500576 if (nClassifierIndex > MAX_CLASSIFIERS) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700577 nClassifierIndex = SearchFreeClsid(Adapter);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500578 if (nClassifierIndex > MAX_CLASSIFIERS) {
579 /* Failed To get a free Entry */
580 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Error Failed To get a free Classifier Entry");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700581 break;
582 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500583 /* Copy the Classifier Rule for this service flow into our Classifier table maintained per SF. */
584 CopyClassifierRuleToSF(Adapter, psfCSType, uiSearchRuleIndex, nClassifierIndex);
585 } else {
586 /* This Classifier Already Exists and it is invalid to Add Classifier with existing PCRI */
587 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL,
588 "CopyToAdapter: Error The Specified Classifier Already Exists and attempted To Add Classifier with Same PCRI : 0x%x\n",
589 u16PacketClassificationRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700590 }
591 }
592 break;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700593 case eReplaceClassifier:
594 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500595 /* Get the Classifier Index From Classifier table for this SF and replace existing Classifier */
596 /* with the new classifier Contained in this message */
597 nClassifierIndex = SearchClsid(Adapter, ulSFID, u16PacketClassificationRuleIndex);
598 if (nClassifierIndex > MAX_CLASSIFIERS) {
599 /* Failed To search the classifier */
600 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Error Search for Classifier To be replaced failed");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700601 break;
602 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500603 /* Copy the Classifier Rule for this service flow into our Classifier table maintained per SF. */
604 CopyClassifierRuleToSF(Adapter, psfCSType, uiSearchRuleIndex, nClassifierIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700605 }
606 break;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700607 case eDeleteClassifier:
608 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500609 /* Get the Classifier Index From Classifier table for this SF and replace existing Classifier */
610 /* with the new classifier Contained in this message */
611 nClassifierIndex = SearchClsid(Adapter, ulSFID, u16PacketClassificationRuleIndex);
612 if (nClassifierIndex > MAX_CLASSIFIERS) {
613 /* Failed To search the classifier */
614 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Error Search for Classifier To be deleted failed");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700615 break;
616 }
617
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500618 /* Delete This classifier */
619 DeleteClassifierRuleFromSF(Adapter, uiSearchRuleIndex, nClassifierIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700620 }
621 break;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700622 default:
623 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500624 /* Invalid Action for classifier */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700625 break;
626 }
627 }
628 }
629
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500630 /* Repeat parsing Classification Entries to process PHS Rules */
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500631 for (i = 0; i < psfLocalSet->u8TotalClassifiers; i++) {
632 psfCSType = &psfLocalSet->cConvergenceSLTypes[i];
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500633 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "psfCSType->u8PhsDSCAction : 0x%x\n", psfCSType->u8PhsDSCAction);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700634
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500635 switch (psfCSType->u8PhsDSCAction) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700636 case eDeleteAllPHSRules:
637 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500638 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Deleting All PHS Rules For VCID: 0x%X\n", uVCID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700639
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500640 /* Delete All the PHS rules for this Service flow */
641 PhsDeleteSFRules(&Adapter->stBCMPhsContext, uVCID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700642 break;
643 }
644 case eDeletePHSRule:
645 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500646 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "PHS DSC Action = Delete PHS Rule\n");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700647
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500648 if (psfCSType->cPhsRule.u8PHSI)
649 PhsDeletePHSRule(&Adapter->stBCMPhsContext, uVCID, psfCSType->cCPacketClassificationRule.u8AssociatedPHSI);
650
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700651 break;
652 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500653 default:
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700654 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500655 if (ucDsxType == DSC_ACK) {
656 /* BCM_DEBUG_PRINT(CONN_MSG,("Invalid PHS DSC Action For DSC\n",psfCSType->cPhsRule.u8PHSI)); */
657 break; /* FOr DSC ACK Case PHS DSC Action must be in valid set */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700658 }
659 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500660 /* Proceed To Add PHS rule for DSA_ACK case even if PHS DSC action is unspecified */
661 /* No Break Here . Intentionally! */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700662
663 case eAddPHSRule:
664 case eSetPHSRule:
665 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500666 if (psfCSType->cPhsRule.u8PHSI) {
667 /* Apply This PHS Rule to all classifiers whose Associated PHSI Match */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700668 unsigned int uiClassifierIndex = 0;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500669 if (pstAddIndication->u8Direction == UPLINK_DIR) {
670 for (uiClassifierIndex = 0; uiClassifierIndex < MAX_CLASSIFIERS; uiClassifierIndex++) {
671 if ((Adapter->astClassifierTable[uiClassifierIndex].bUsed) &&
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700672 (Adapter->astClassifierTable[uiClassifierIndex].ulSFID == Adapter->PackInfo[uiSearchRuleIndex].ulSFID) &&
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500673 (Adapter->astClassifierTable[uiClassifierIndex].u8AssociatedPHSI == psfCSType->cPhsRule.u8PHSI)) {
674 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL,
675 "Adding PHS Rule For Classifier: 0x%x cPhsRule.u8PHSI: 0x%x\n",
676 Adapter->astClassifierTable[uiClassifierIndex].uiClassifierRuleIndex,
677 psfCSType->cPhsRule.u8PHSI);
678 /* Update The PHS Rule for this classifier as Associated PHSI id defined */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700679
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500680 /* Copy the PHS Rule */
681 sPhsRule.u8PHSI = psfCSType->cPhsRule.u8PHSI;
682 sPhsRule.u8PHSFLength = psfCSType->cPhsRule.u8PHSFLength;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700683 sPhsRule.u8PHSMLength = psfCSType->cPhsRule.u8PHSMLength;
684 sPhsRule.u8PHSS = psfCSType->cPhsRule.u8PHSS;
685 sPhsRule.u8PHSV = psfCSType->cPhsRule.u8PHSV;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500686 memcpy(sPhsRule.u8PHSF, psfCSType->cPhsRule.u8PHSF, MAX_PHS_LENGTHS);
687 memcpy(sPhsRule.u8PHSM, psfCSType->cPhsRule.u8PHSM, MAX_PHS_LENGTHS);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700688 sPhsRule.u8RefCnt = 0;
689 sPhsRule.bUnclassifiedPHSRule = FALSE;
690 sPhsRule.PHSModifiedBytes = 0;
691 sPhsRule.PHSModifiedNumPackets = 0;
692 sPhsRule.PHSErrorNumPackets = 0;
693
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500694 /* bPHSRuleAssociated = TRUE; */
695 /* Store The PHS Rule for this classifier */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700696
697 PhsUpdateClassifierRule(
698 &Adapter->stBCMPhsContext,
699 uVCID,
700 Adapter->astClassifierTable[uiClassifierIndex].uiClassifierRuleIndex,
701 &sPhsRule,
702 Adapter->astClassifierTable[uiClassifierIndex].u8AssociatedPHSI);
703
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500704 /* Update PHS Rule For the Classifier */
705 if (sPhsRule.u8PHSI) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700706 Adapter->astClassifierTable[uiClassifierIndex].u32PHSRuleID = sPhsRule.u8PHSI;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500707 memcpy(&Adapter->astClassifierTable[uiClassifierIndex].sPhsRule, &sPhsRule, sizeof(S_PHS_RULE));
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700708 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700709 }
710 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500711 } else {
712 /* Error PHS Rule specified in signaling could not be applied to any classifier */
713
714 /* Copy the PHS Rule */
715 sPhsRule.u8PHSI = psfCSType->cPhsRule.u8PHSI;
716 sPhsRule.u8PHSFLength = psfCSType->cPhsRule.u8PHSFLength;
717 sPhsRule.u8PHSMLength = psfCSType->cPhsRule.u8PHSMLength;
718 sPhsRule.u8PHSS = psfCSType->cPhsRule.u8PHSS;
719 sPhsRule.u8PHSV = psfCSType->cPhsRule.u8PHSV;
720 memcpy(sPhsRule.u8PHSF, psfCSType->cPhsRule.u8PHSF, MAX_PHS_LENGTHS);
721 memcpy(sPhsRule.u8PHSM, psfCSType->cPhsRule.u8PHSM, MAX_PHS_LENGTHS);
722 sPhsRule.u8RefCnt = 0;
723 sPhsRule.bUnclassifiedPHSRule = TRUE;
724 sPhsRule.PHSModifiedBytes = 0;
725 sPhsRule.PHSModifiedNumPackets = 0;
726 sPhsRule.PHSErrorNumPackets = 0;
727 /* Store The PHS Rule for this classifier */
728
729 /*
730 * Passing the argument u8PHSI instead of clsid. Because for DL with no classifier rule,
731 * clsid will be zero hence we can't have multiple PHS rules for the same SF.
732 * To support multiple PHS rule, passing u8PHSI.
733 */
734 PhsUpdateClassifierRule(
735 &Adapter->stBCMPhsContext,
736 uVCID,
737 sPhsRule.u8PHSI,
738 &sPhsRule,
739 sPhsRule.u8PHSI);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700740 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700741 }
742 }
743 break;
744 }
745 }
746
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500747 if (psfLocalSet->u32MaxSustainedTrafficRate == 0) {
748 /* No Rate Limit . Set Max Sustained Traffic Rate to Maximum */
749 Adapter->PackInfo[uiSearchRuleIndex].uiMaxAllowedRate = WIMAX_MAX_ALLOWED_RATE;
750 } else if (ntohl(psfLocalSet->u32MaxSustainedTrafficRate) > WIMAX_MAX_ALLOWED_RATE) {
751 /* Too large Allowed Rate specified. Limiting to Wi Max Allowed rate */
752 Adapter->PackInfo[uiSearchRuleIndex].uiMaxAllowedRate = WIMAX_MAX_ALLOWED_RATE;
753 } else {
754 Adapter->PackInfo[uiSearchRuleIndex].uiMaxAllowedRate = ntohl(psfLocalSet->u32MaxSustainedTrafficRate);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700755 }
756
757 Adapter->PackInfo[uiSearchRuleIndex].uiMaxLatency = ntohl(psfLocalSet->u32MaximumLatency);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500758 if (Adapter->PackInfo[uiSearchRuleIndex].uiMaxLatency == 0) /* 0 should be treated as infinite */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700759 Adapter->PackInfo[uiSearchRuleIndex].uiMaxLatency = MAX_LATENCY_ALLOWED;
760
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500761 if ((Adapter->PackInfo[uiSearchRuleIndex].u8QueueType == ERTPS ||
762 Adapter->PackInfo[uiSearchRuleIndex].u8QueueType == UGS))
763 UGIValue = ntohs(psfLocalSet->u16UnsolicitedGrantInterval);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700764
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500765 if (UGIValue == 0)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700766 UGIValue = DEFAULT_UG_INTERVAL;
767
768 /*
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500769 * For UGI based connections...
770 * DEFAULT_UGI_FACTOR*UGIInterval worth of data is the max token count at host...
771 * The extra amount of token is to ensure that a large amount of jitter won't have loss in throughput...
772 * In case of non-UGI based connection, 200 frames worth of data is the max token count at host...
773 */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700774 Adapter->PackInfo[uiSearchRuleIndex].uiMaxBucketSize =
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500775 (DEFAULT_UGI_FACTOR*Adapter->PackInfo[uiSearchRuleIndex].uiMaxAllowedRate*UGIValue)/1000;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700776
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500777 if (Adapter->PackInfo[uiSearchRuleIndex].uiMaxBucketSize < WIMAX_MAX_MTU*8) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700778 UINT UGIFactor = 0;
779 /* Special Handling to ensure the biggest size of packet can go out from host to FW as follows:
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500780 * 1. Any packet from Host to FW can go out in different packet size.
781 * 2. So in case the Bucket count is smaller than MTU, the packets of size (Size > TokenCount), will get dropped.
782 * 3. We can allow packets of MaxSize from Host->FW that can go out from FW in multiple SDUs by fragmentation at Wimax Layer
783 */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700784 UGIFactor = (Adapter->PackInfo[uiSearchRuleIndex].uiMaxLatency/UGIValue + 1);
785
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500786 if (UGIFactor > DEFAULT_UGI_FACTOR)
787 Adapter->PackInfo[uiSearchRuleIndex].uiMaxBucketSize =
788 (UGIFactor*Adapter->PackInfo[uiSearchRuleIndex].uiMaxAllowedRate*UGIValue)/1000;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700789
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500790 if (Adapter->PackInfo[uiSearchRuleIndex].uiMaxBucketSize > WIMAX_MAX_MTU*8)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700791 Adapter->PackInfo[uiSearchRuleIndex].uiMaxBucketSize = WIMAX_MAX_MTU*8;
792 }
793
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500794 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "LAT: %d, UGI: %d\n", Adapter->PackInfo[uiSearchRuleIndex].uiMaxLatency, UGIValue);
795 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "uiMaxAllowedRate: 0x%x, u32MaxSustainedTrafficRate: 0x%x ,uiMaxBucketSize: 0x%x",
796 Adapter->PackInfo[uiSearchRuleIndex].uiMaxAllowedRate,
797 ntohl(psfLocalSet->u32MaxSustainedTrafficRate),
798 Adapter->PackInfo[uiSearchRuleIndex].uiMaxBucketSize);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700799
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500800 /* copy the extended SF Parameters to Support MIBS */
801 CopyMIBSExtendedSFParameters(Adapter, psfLocalSet, uiSearchRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700802
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500803 /* store header suppression enabled flag per SF */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700804 Adapter->PackInfo[uiSearchRuleIndex].bHeaderSuppressionEnabled =
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500805 !(psfLocalSet->u8RequesttransmissionPolicy &
806 MASK_DISABLE_HEADER_SUPPRESSION);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700807
Ilia Mirkin23c32982011-03-13 00:28:55 -0500808 kfree(Adapter->PackInfo[uiSearchRuleIndex].pstSFIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700809 Adapter->PackInfo[uiSearchRuleIndex].pstSFIndication = pstAddIndication;
810
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500811 /* Re Sort the SF list in PackInfo according to Traffic Priority */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700812 SortPackInfo(Adapter);
813
814 /* Re Sort the Classifier Rules table and re - arrange
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500815 * according to Classifier Rule Priority
816 */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700817 SortClassifiers(Adapter);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700818 DumpPhsRules(&Adapter->stBCMPhsContext);
Kevin McKinneye4868622012-01-04 20:29:01 -0500819 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "%s <=====", __func__);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700820}
821
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700822/***********************************************************************
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500823 * Function - DumpCmControlPacket
824 *
825 * Description - This routinue Dumps the Contents of the AddIndication
826 * Structure in the Connection Management Control Packet
827 *
828 * Parameter - pvBuffer: Pointer to the buffer containing the
829 * AddIndication data.
830 *
831 * Returns - None
832 *************************************************************************/
Arnd Bergmann44a17eff2010-09-30 10:24:12 +0200833static VOID DumpCmControlPacket(PVOID pvBuffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700834{
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -0500835 int uiLoopIndex;
836 int nIndex;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500837 stLocalSFAddIndicationAlt *pstAddIndication;
838 UINT nCurClassifierCnt;
839 PMINI_ADAPTER Adapter = GET_BCM_ADAPTER(gblpnetdev);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700840
841 pstAddIndication = (stLocalSFAddIndicationAlt *)pvBuffer;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500842 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "======>");
843 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8Type: 0x%X", pstAddIndication->u8Type);
844 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8Direction: 0x%X", pstAddIndication->u8Direction);
845 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16TID: 0x%X", ntohs(pstAddIndication->u16TID));
846 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16CID: 0x%X", ntohs(pstAddIndication->u16CID));
847 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16VCID: 0x%X", ntohs(pstAddIndication->u16VCID));
848 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " AuthorizedSet--->");
849 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32SFID: 0x%X", htonl(pstAddIndication->sfAuthorizedSet.u32SFID));
850 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16CID: 0x%X", htons(pstAddIndication->sfAuthorizedSet.u16CID));
851 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceClassNameLength: 0x%X",
852 pstAddIndication->sfAuthorizedSet.u8ServiceClassNameLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700853
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500854 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceClassName: 0x%X ,0x%X , 0x%X, 0x%X, 0x%X, 0x%X",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700855 pstAddIndication->sfAuthorizedSet.u8ServiceClassName[0],
856 pstAddIndication->sfAuthorizedSet.u8ServiceClassName[1],
857 pstAddIndication->sfAuthorizedSet.u8ServiceClassName[2],
858 pstAddIndication->sfAuthorizedSet.u8ServiceClassName[3],
859 pstAddIndication->sfAuthorizedSet.u8ServiceClassName[4],
860 pstAddIndication->sfAuthorizedSet.u8ServiceClassName[5]);
861
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500862 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8MBSService: 0x%X", pstAddIndication->sfAuthorizedSet.u8MBSService);
863 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8QosParamSet: 0x%X", pstAddIndication->sfAuthorizedSet.u8QosParamSet);
864 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TrafficPriority: 0x%X, %p",
865 pstAddIndication->sfAuthorizedSet.u8TrafficPriority, &pstAddIndication->sfAuthorizedSet.u8TrafficPriority);
866 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaxSustainedTrafficRate: 0x%X 0x%p",
867 pstAddIndication->sfAuthorizedSet.u32MaxSustainedTrafficRate,
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700868 &pstAddIndication->sfAuthorizedSet.u32MaxSustainedTrafficRate);
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500869 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaxTrafficBurst: 0x%X", pstAddIndication->sfAuthorizedSet.u32MaxTrafficBurst);
870 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MinReservedTrafficRate : 0x%X",
871 pstAddIndication->sfAuthorizedSet.u32MinReservedTrafficRate);
872 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificQoSParamLength: 0x%X",
873 pstAddIndication->sfAuthorizedSet.u8VendorSpecificQoSParamLength);
874 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificQoSParam: 0x%X",
875 pstAddIndication->sfAuthorizedSet.u8VendorSpecificQoSParam[0]);
876 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceFlowSchedulingType: 0x%X",
877 pstAddIndication->sfAuthorizedSet.u8ServiceFlowSchedulingType);
878 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32ToleratedJitter: 0x%X", pstAddIndication->sfAuthorizedSet.u32ToleratedJitter);
879 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaximumLatency: 0x%X", pstAddIndication->sfAuthorizedSet.u32MaximumLatency);
880 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8FixedLengthVSVariableLengthSDUIndicator: 0x%X",
881 pstAddIndication->sfAuthorizedSet.u8FixedLengthVSVariableLengthSDUIndicator);
882 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8SDUSize: 0x%X", pstAddIndication->sfAuthorizedSet.u8SDUSize);
883 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16TargetSAID: 0x%X", pstAddIndication->sfAuthorizedSet.u16TargetSAID);
884 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ARQEnable: 0x%X", pstAddIndication->sfAuthorizedSet.u8ARQEnable);
885 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQWindowSize: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQWindowSize);
886 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQRetryTxTimeOut: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQRetryTxTimeOut);
887 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQRetryRxTimeOut: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQRetryRxTimeOut);
888 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQBlockLifeTime: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQBlockLifeTime);
889 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQSyncLossTimeOut: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQSyncLossTimeOut);
890 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ARQDeliverInOrder: 0x%X", pstAddIndication->sfAuthorizedSet.u8ARQDeliverInOrder);
891 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQRxPurgeTimeOut: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQRxPurgeTimeOut);
892 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQBlockSize: 0x%X", pstAddIndication->sfAuthorizedSet.u16ARQBlockSize);
893 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8CSSpecification: 0x%X", pstAddIndication->sfAuthorizedSet.u8CSSpecification);
894 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TypeOfDataDeliveryService: 0x%X",
895 pstAddIndication->sfAuthorizedSet.u8TypeOfDataDeliveryService);
896 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16SDUInterArrivalTime: 0x%X", pstAddIndication->sfAuthorizedSet.u16SDUInterArrivalTime);
897 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16TimeBase: 0x%X", pstAddIndication->sfAuthorizedSet.u16TimeBase);
898 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8PagingPreference: 0x%X", pstAddIndication->sfAuthorizedSet.u8PagingPreference);
899 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16UnsolicitedPollingInterval: 0x%X",
900 pstAddIndication->sfAuthorizedSet.u16UnsolicitedPollingInterval);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700901
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500902 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "sfAuthorizedSet.u8HARQChannelMapping %x %x %x ",
903 *(unsigned int *)pstAddIndication->sfAuthorizedSet.u8HARQChannelMapping,
904 *(unsigned int *)&pstAddIndication->sfAuthorizedSet.u8HARQChannelMapping[4],
905 *(USHORT *)&pstAddIndication->sfAuthorizedSet.u8HARQChannelMapping[8]);
906 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TrafficIndicationPreference: 0x%X",
907 pstAddIndication->sfAuthorizedSet.u8TrafficIndicationPreference);
908 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " Total Classifiers Received: 0x%X", pstAddIndication->sfAuthorizedSet.u8TotalClassifiers);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700909
910 nCurClassifierCnt = pstAddIndication->sfAuthorizedSet.u8TotalClassifiers;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500911 if (nCurClassifierCnt > MAX_CLASSIFIERS_IN_SF)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700912 nCurClassifierCnt = MAX_CLASSIFIERS_IN_SF;
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500913
914 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "pstAddIndication->sfAuthorizedSet.bValid %d", pstAddIndication->sfAuthorizedSet.bValid);
915 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "pstAddIndication->sfAuthorizedSet.u16MacOverhead %x", pstAddIndication->sfAuthorizedSet.u16MacOverhead);
916 if (!pstAddIndication->sfAuthorizedSet.bValid)
917 pstAddIndication->sfAuthorizedSet.bValid = 1;
918 for (nIndex = 0; nIndex < nCurClassifierCnt; nIndex++) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700919 stConvergenceSLTypes *psfCSType = NULL;
920 psfCSType = &pstAddIndication->sfAuthorizedSet.cConvergenceSLTypes[nIndex];
921
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500922 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "psfCSType = %p", psfCSType);
923 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "CCPacketClassificationRuleSI====>");
924 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ClassifierRulePriority: 0x%X ",
925 psfCSType->cCPacketClassificationRule.u8ClassifierRulePriority);
926 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPTypeOfServiceLength: 0x%X ",
927 psfCSType->cCPacketClassificationRule.u8IPTypeOfServiceLength);
928 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPTypeOfService[3]: 0x%X ,0x%X ,0x%X ",
929 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[0],
930 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[1],
931 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[2]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700932
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500933 for (uiLoopIndex = 0; uiLoopIndex < 1; uiLoopIndex++)
934 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8Protocol: 0x%02X ",
935 psfCSType->cCPacketClassificationRule.u8Protocol);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700936
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500937 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPMaskedSourceAddressLength: 0x%X ",
938 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700939
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500940 for (uiLoopIndex = 0; uiLoopIndex < 32; uiLoopIndex++)
941 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPMaskedSourceAddress[32]: 0x%02X ",
942 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddress[uiLoopIndex]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700943
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500944 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPDestinationAddressLength: 0x%X ",
945 psfCSType->cCPacketClassificationRule.u8IPDestinationAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700946
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500947 for (uiLoopIndex = 0; uiLoopIndex < 32; uiLoopIndex++)
948 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPDestinationAddress[32]: 0x%02X ",
949 psfCSType->cCPacketClassificationRule.u8IPDestinationAddress[uiLoopIndex]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700950
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500951 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolSourcePortRangeLength:0x%X ",
952 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRangeLength);
953 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolSourcePortRange[4]: 0x%02X ,0x%02X ,0x%02X ,0x%02X ",
954 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[0],
955 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[1],
956 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[2],
957 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[3]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700958
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500959 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolDestPortRangeLength: 0x%02X ",
960 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRangeLength);
961 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolDestPortRange[4]: 0x%02X ,0x%02X ,0x%02X ,0x%02X ",
962 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[0],
963 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[1],
964 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[2],
965 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[3]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700966
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500967 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetDestMacAddressLength: 0x%02X ",
968 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700969
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500970 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetDestMacAddress[6]: 0x %02X %02X %02X %02X %02X %02X",
971 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[0],
972 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[1],
973 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[2],
974 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[3],
975 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[4],
976 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700977
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500978 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetSourceMACAddressLength: 0x%02X ",
979 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700980
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500981 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetSourceMACAddress[6]: 0x %02X %02X %02X %02X %02X %02X",
982 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[0],
983 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[1],
984 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[2],
985 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[3],
986 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[4],
987 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700988
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500989 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthertypeLength: 0x%02X ",
990 psfCSType->cCPacketClassificationRule.u8EthertypeLength);
991 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8Ethertype[3]: 0x%02X ,0x%02X ,0x%02X ",
992 psfCSType->cCPacketClassificationRule.u8Ethertype[0],
993 psfCSType->cCPacketClassificationRule.u8Ethertype[1],
994 psfCSType->cCPacketClassificationRule.u8Ethertype[2]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -0700995
Kevin McKinney9937fdb2012-01-04 20:29:00 -0500996 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16UserPriority: 0x%X ", psfCSType->cCPacketClassificationRule.u16UserPriority);
997 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16VLANID: 0x%X ", psfCSType->cCPacketClassificationRule.u16VLANID);
998 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8AssociatedPHSI: 0x%02X ", psfCSType->cCPacketClassificationRule.u8AssociatedPHSI);
999 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16PacketClassificationRuleIndex: 0x%X ",
1000 psfCSType->cCPacketClassificationRule.u16PacketClassificationRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001001
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001002 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificClassifierParamLength: 0x%X ",
1003 psfCSType->cCPacketClassificationRule.u8VendorSpecificClassifierParamLength);
1004 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificClassifierParam[1]: 0x%X ",
1005 psfCSType->cCPacketClassificationRule.u8VendorSpecificClassifierParam[0]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001006#ifdef VERSION_D5
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001007 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPv6FlowLableLength: 0x%X ",
1008 psfCSType->cCPacketClassificationRule.u8IPv6FlowLableLength);
1009 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPv6FlowLable[6]: 0x %02X %02X %02X %02X %02X %02X ",
1010 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[0],
1011 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[1],
1012 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[2],
1013 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[3],
1014 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[4],
1015 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001016#endif
1017 }
1018
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001019 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "bValid: 0x%02X", pstAddIndication->sfAuthorizedSet.bValid);
1020 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "AdmittedSet--->");
1021 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32SFID: 0x%X", pstAddIndication->sfAdmittedSet.u32SFID);
1022 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16CID: 0x%X", pstAddIndication->sfAdmittedSet.u16CID);
1023 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceClassNameLength: 0x%X",
1024 pstAddIndication->sfAdmittedSet.u8ServiceClassNameLength);
1025 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceClassName: 0x %02X %02X %02X %02X %02X %02X",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001026 pstAddIndication->sfAdmittedSet.u8ServiceClassName[0],
1027 pstAddIndication->sfAdmittedSet.u8ServiceClassName[1],
1028 pstAddIndication->sfAdmittedSet.u8ServiceClassName[2],
1029 pstAddIndication->sfAdmittedSet.u8ServiceClassName[3],
1030 pstAddIndication->sfAdmittedSet.u8ServiceClassName[4],
1031 pstAddIndication->sfAdmittedSet.u8ServiceClassName[5]);
1032
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001033 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8MBSService: 0x%02X", pstAddIndication->sfAdmittedSet.u8MBSService);
1034 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8QosParamSet: 0x%02X", pstAddIndication->sfAdmittedSet.u8QosParamSet);
1035 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TrafficPriority: 0x%02X", pstAddIndication->sfAdmittedSet.u8TrafficPriority);
1036 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaxTrafficBurst: 0x%X", pstAddIndication->sfAdmittedSet.u32MaxTrafficBurst);
1037 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MinReservedTrafficRate: 0x%X",
1038 pstAddIndication->sfAdmittedSet.u32MinReservedTrafficRate);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001039
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001040 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificQoSParamLength: 0x%02X",
1041 pstAddIndication->sfAdmittedSet.u8VendorSpecificQoSParamLength);
1042 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificQoSParam: 0x%02X",
1043 pstAddIndication->sfAdmittedSet.u8VendorSpecificQoSParam[0]);
1044 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceFlowSchedulingType: 0x%02X",
1045 pstAddIndication->sfAdmittedSet.u8ServiceFlowSchedulingType);
1046 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32ToleratedJitter: 0x%X", pstAddIndication->sfAdmittedSet.u32ToleratedJitter);
1047 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaximumLatency: 0x%X", pstAddIndication->sfAdmittedSet.u32MaximumLatency);
1048 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8FixedLengthVSVariableLengthSDUIndicator: 0x%02X",
1049 pstAddIndication->sfAdmittedSet.u8FixedLengthVSVariableLengthSDUIndicator);
1050 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8SDUSize: 0x%02X", pstAddIndication->sfAdmittedSet.u8SDUSize);
1051 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16TargetSAID: 0x%02X", pstAddIndication->sfAdmittedSet.u16TargetSAID);
1052 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ARQEnable: 0x%02X", pstAddIndication->sfAdmittedSet.u8ARQEnable);
1053 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQWindowSize: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQWindowSize);
1054 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQRetryTxTimeOut: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQRetryTxTimeOut);
1055 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQRetryRxTimeOut: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQRetryRxTimeOut);
1056 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQBlockLifeTime: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQBlockLifeTime);
1057 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQSyncLossTimeOut: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQSyncLossTimeOut);
1058 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ARQDeliverInOrder: 0x%02X", pstAddIndication->sfAdmittedSet.u8ARQDeliverInOrder);
1059 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQRxPurgeTimeOut: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQRxPurgeTimeOut);
1060 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16ARQBlockSize: 0x%X", pstAddIndication->sfAdmittedSet.u16ARQBlockSize);
1061 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8CSSpecification: 0x%02X", pstAddIndication->sfAdmittedSet.u8CSSpecification);
1062 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TypeOfDataDeliveryService: 0x%02X",
1063 pstAddIndication->sfAdmittedSet.u8TypeOfDataDeliveryService);
1064 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16SDUInterArrivalTime: 0x%X", pstAddIndication->sfAdmittedSet.u16SDUInterArrivalTime);
1065 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16TimeBase: 0x%X", pstAddIndication->sfAdmittedSet.u16TimeBase);
1066 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8PagingPreference: 0x%X", pstAddIndication->sfAdmittedSet.u8PagingPreference);
1067 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TrafficIndicationPreference: 0x%02X",
1068 pstAddIndication->sfAdmittedSet.u8TrafficIndicationPreference);
1069 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " Total Classifiers Received: 0x%X", pstAddIndication->sfAdmittedSet.u8TotalClassifiers);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001070
1071 nCurClassifierCnt = pstAddIndication->sfAdmittedSet.u8TotalClassifiers;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001072 if (nCurClassifierCnt > MAX_CLASSIFIERS_IN_SF)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001073 nCurClassifierCnt = MAX_CLASSIFIERS_IN_SF;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001074
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001075 for (nIndex = 0; nIndex < nCurClassifierCnt; nIndex++) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001076 stConvergenceSLTypes *psfCSType = NULL;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001077
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001078 psfCSType = &pstAddIndication->sfAdmittedSet.cConvergenceSLTypes[nIndex];
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001079 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " CCPacketClassificationRuleSI====>");
1080 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ClassifierRulePriority: 0x%02X ",
1081 psfCSType->cCPacketClassificationRule.u8ClassifierRulePriority);
1082 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPTypeOfServiceLength: 0x%02X",
1083 psfCSType->cCPacketClassificationRule.u8IPTypeOfServiceLength);
1084 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPTypeOfService[3]: 0x%02X %02X %02X",
1085 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[0],
1086 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[1],
1087 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[2]);
1088 for (uiLoopIndex = 0; uiLoopIndex < 1; uiLoopIndex++)
1089 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8Protocol: 0x%02X ", psfCSType->cCPacketClassificationRule.u8Protocol);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001090
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001091 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPMaskedSourceAddressLength: 0x%02X ",
1092 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001093
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001094 for (uiLoopIndex = 0; uiLoopIndex < 32; uiLoopIndex++)
1095 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPMaskedSourceAddress[32]: 0x%02X ",
1096 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddress[uiLoopIndex]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001097
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001098 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPDestinationAddressLength: 0x%02X ",
1099 psfCSType->cCPacketClassificationRule.u8IPDestinationAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001100
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001101 for (uiLoopIndex = 0; uiLoopIndex < 32; uiLoopIndex++)
1102 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPDestinationAddress[32]: 0x%02X ",
1103 psfCSType->cCPacketClassificationRule.u8IPDestinationAddress[uiLoopIndex]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001104
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001105 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolSourcePortRangeLength: 0x%02X ",
1106 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRangeLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001107
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001108 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolSourcePortRange[4]: 0x %02X %02X %02X %02X ",
1109 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[0],
1110 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[1],
1111 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[2],
1112 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[3]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001113
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001114 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolDestPortRangeLength: 0x%02X ",
1115 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRangeLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001116
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001117 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ProtocolDestPortRange[4]: 0x %02X %02X %02X %02X ",
1118 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[0],
1119 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[1],
1120 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[2],
1121 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[3]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001122
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001123 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetDestMacAddressLength: 0x%02X ",
1124 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001125
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001126 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetDestMacAddress[6]: 0x %02X %02X %02X %02X %02X %02X",
1127 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[0],
1128 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[1],
1129 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[2],
1130 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[3],
1131 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[4],
1132 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001133
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001134 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetSourceMACAddressLength: 0x%02X ",
1135 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001136
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001137 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetSourceMACAddress[6]: 0x %02X %02X %02X %02X %02X %02X",
1138 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[0],
1139 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[1],
1140 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[2],
1141 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[3],
1142 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[4],
1143 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001144
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001145 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthertypeLength: 0x%02X ", psfCSType->cCPacketClassificationRule.u8EthertypeLength);
1146 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8Ethertype[3]: 0x%02X %02X %02X",
1147 psfCSType->cCPacketClassificationRule.u8Ethertype[0],
1148 psfCSType->cCPacketClassificationRule.u8Ethertype[1],
1149 psfCSType->cCPacketClassificationRule.u8Ethertype[2]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001150
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001151 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16UserPriority: 0x%X ", psfCSType->cCPacketClassificationRule.u16UserPriority);
1152 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16VLANID: 0x%X ", psfCSType->cCPacketClassificationRule.u16VLANID);
1153 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8AssociatedPHSI: 0x%02X ", psfCSType->cCPacketClassificationRule.u8AssociatedPHSI);
1154 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16PacketClassificationRuleIndex: 0x%X ",
1155 psfCSType->cCPacketClassificationRule.u16PacketClassificationRuleIndex);
1156 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificClassifierParamLength: 0x%02X",
1157 psfCSType->cCPacketClassificationRule.u8VendorSpecificClassifierParamLength);
1158 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificClassifierParam[1]: 0x%02X ",
1159 psfCSType->cCPacketClassificationRule.u8VendorSpecificClassifierParam[0]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001160#ifdef VERSION_D5
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001161 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPv6FlowLableLength: 0x%X ",
1162 psfCSType->cCPacketClassificationRule.u8IPv6FlowLableLength);
1163 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPv6FlowLable[6]: 0x %02X %02X %02X %02X %02X %02X ",
1164 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[0],
1165 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[1],
1166 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[2],
1167 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[3],
1168 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[4],
1169 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001170#endif
1171 }
1172
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001173 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "bValid: 0x%X", pstAddIndication->sfAdmittedSet.bValid);
1174 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " ActiveSet--->");
1175 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32SFID: 0x%X", pstAddIndication->sfActiveSet.u32SFID);
1176 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u16CID: 0x%X", pstAddIndication->sfActiveSet.u16CID);
1177 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceClassNameLength: 0x%X", pstAddIndication->sfActiveSet.u8ServiceClassNameLength);
1178 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceClassName: 0x %02X %02X %02X %02X %02X %02X",
1179 pstAddIndication->sfActiveSet.u8ServiceClassName[0],
1180 pstAddIndication->sfActiveSet.u8ServiceClassName[1],
1181 pstAddIndication->sfActiveSet.u8ServiceClassName[2],
1182 pstAddIndication->sfActiveSet.u8ServiceClassName[3],
1183 pstAddIndication->sfActiveSet.u8ServiceClassName[4],
1184 pstAddIndication->sfActiveSet.u8ServiceClassName[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001185
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001186 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8MBSService: 0x%02X", pstAddIndication->sfActiveSet.u8MBSService);
1187 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8QosParamSet: 0x%02X", pstAddIndication->sfActiveSet.u8QosParamSet);
1188 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8TrafficPriority: 0x%02X", pstAddIndication->sfActiveSet.u8TrafficPriority);
1189 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaxTrafficBurst: 0x%X", pstAddIndication->sfActiveSet.u32MaxTrafficBurst);
1190 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MinReservedTrafficRate: 0x%X",
1191 pstAddIndication->sfActiveSet.u32MinReservedTrafficRate);
1192 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificQoSParamLength: 0x%02X",
1193 pstAddIndication->sfActiveSet.u8VendorSpecificQoSParamLength);
1194 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8VendorSpecificQoSParam: 0x%02X",
1195 pstAddIndication->sfActiveSet.u8VendorSpecificQoSParam[0]);
1196 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8ServiceFlowSchedulingType: 0x%02X",
1197 pstAddIndication->sfActiveSet.u8ServiceFlowSchedulingType);
1198 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32ToleratedJitter: 0x%X", pstAddIndication->sfActiveSet.u32ToleratedJitter);
1199 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u32MaximumLatency: 0x%X", pstAddIndication->sfActiveSet.u32MaximumLatency);
1200 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8FixedLengthVSVariableLengthSDUIndicator: 0x%02X",
1201 pstAddIndication->sfActiveSet.u8FixedLengthVSVariableLengthSDUIndicator);
1202 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8SDUSize: 0x%X", pstAddIndication->sfActiveSet.u8SDUSize);
1203 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16TargetSAID: 0x%X", pstAddIndication->sfActiveSet.u16TargetSAID);
1204 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ARQEnable: 0x%X", pstAddIndication->sfActiveSet.u8ARQEnable);
1205 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQWindowSize: 0x%X", pstAddIndication->sfActiveSet.u16ARQWindowSize);
1206 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQRetryTxTimeOut: 0x%X", pstAddIndication->sfActiveSet.u16ARQRetryTxTimeOut);
1207 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQRetryRxTimeOut: 0x%X", pstAddIndication->sfActiveSet.u16ARQRetryRxTimeOut);
1208 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQBlockLifeTime: 0x%X", pstAddIndication->sfActiveSet.u16ARQBlockLifeTime);
1209 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQSyncLossTimeOut: 0x%X", pstAddIndication->sfActiveSet.u16ARQSyncLossTimeOut);
1210 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ARQDeliverInOrder: 0x%X", pstAddIndication->sfActiveSet.u8ARQDeliverInOrder);
1211 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQRxPurgeTimeOut: 0x%X", pstAddIndication->sfActiveSet.u16ARQRxPurgeTimeOut);
1212 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16ARQBlockSize: 0x%X", pstAddIndication->sfActiveSet.u16ARQBlockSize);
1213 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8CSSpecification: 0x%X", pstAddIndication->sfActiveSet.u8CSSpecification);
1214 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8TypeOfDataDeliveryService: 0x%X",
1215 pstAddIndication->sfActiveSet.u8TypeOfDataDeliveryService);
1216 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16SDUInterArrivalTime: 0x%X", pstAddIndication->sfActiveSet.u16SDUInterArrivalTime);
1217 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16TimeBase: 0x%X", pstAddIndication->sfActiveSet.u16TimeBase);
1218 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8PagingPreference: 0x%X", pstAddIndication->sfActiveSet.u8PagingPreference);
1219 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8TrafficIndicationPreference: 0x%X",
1220 pstAddIndication->sfActiveSet.u8TrafficIndicationPreference);
1221 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " Total Classifiers Received: 0x%X", pstAddIndication->sfActiveSet.u8TotalClassifiers);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001222
1223 nCurClassifierCnt = pstAddIndication->sfActiveSet.u8TotalClassifiers;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001224 if (nCurClassifierCnt > MAX_CLASSIFIERS_IN_SF)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001225 nCurClassifierCnt = MAX_CLASSIFIERS_IN_SF;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001226
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001227 for (nIndex = 0; nIndex < nCurClassifierCnt; nIndex++) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001228 stConvergenceSLTypes *psfCSType = NULL;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001229
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001230 psfCSType = &pstAddIndication->sfActiveSet.cConvergenceSLTypes[nIndex];
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001231 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " CCPacketClassificationRuleSI====>");
1232 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ClassifierRulePriority: 0x%X ",
1233 psfCSType->cCPacketClassificationRule.u8ClassifierRulePriority);
1234 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8IPTypeOfServiceLength: 0x%X ",
1235 psfCSType->cCPacketClassificationRule.u8IPTypeOfServiceLength);
1236 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8IPTypeOfService[3]: 0x%X ,0x%X ,0x%X ",
1237 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[0],
1238 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[1],
1239 psfCSType->cCPacketClassificationRule.u8IPTypeOfService[2]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001240
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001241 for (uiLoopIndex = 0; uiLoopIndex < 1; uiLoopIndex++)
1242 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8Protocol: 0x%X ", psfCSType->cCPacketClassificationRule.u8Protocol);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001243
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001244 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPMaskedSourceAddressLength: 0x%X ",
1245 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001246
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001247 for (uiLoopIndex = 0; uiLoopIndex < 32; uiLoopIndex++)
1248 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPMaskedSourceAddress[32]: 0x%X ",
1249 psfCSType->cCPacketClassificationRule.u8IPMaskedSourceAddress[uiLoopIndex]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001250
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001251 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8IPDestinationAddressLength: 0x%02X ",
1252 psfCSType->cCPacketClassificationRule.u8IPDestinationAddressLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001253
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001254 for (uiLoopIndex = 0; uiLoopIndex < 32; uiLoopIndex++)
1255 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8IPDestinationAddress[32]:0x%X ",
1256 psfCSType->cCPacketClassificationRule.u8IPDestinationAddress[uiLoopIndex]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001257
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001258 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ProtocolSourcePortRangeLength: 0x%X ",
1259 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRangeLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001260
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001261 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ProtocolSourcePortRange[4]: 0x%X ,0x%X ,0x%X ,0x%X ",
1262 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[0],
1263 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[1],
1264 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[2],
1265 psfCSType->cCPacketClassificationRule.u8ProtocolSourcePortRange[3]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001266
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001267 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ProtocolDestPortRangeLength: 0x%X ",
1268 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRangeLength);
1269 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8ProtocolDestPortRange[4]: 0x%X ,0x%X ,0x%X ,0x%X ",
1270 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[0],
1271 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[1],
1272 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[2],
1273 psfCSType->cCPacketClassificationRule.u8ProtocolDestPortRange[3]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001274
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001275 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8EthernetDestMacAddressLength: 0x%X ",
1276 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
1277 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8EthernetDestMacAddress[6]: 0x%X ,0x%X ,0x%X ,0x%X ,0x%X ,0x%X",
1278 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[0],
1279 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[1],
1280 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[2],
1281 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[3],
1282 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[4],
1283 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddress[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001284
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001285 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8EthernetSourceMACAddressLength: 0x%X ",
1286 psfCSType->cCPacketClassificationRule.u8EthernetDestMacAddressLength);
1287 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, "u8EthernetSourceMACAddress[6]: 0x%X ,0x%X ,0x%X ,0x%X ,0x%X ,0x%X",
1288 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[0],
1289 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[1],
1290 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[2],
1291 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[3],
1292 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[4],
1293 psfCSType->cCPacketClassificationRule.u8EthernetSourceMACAddress[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001294
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001295 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8EthertypeLength: 0x%X ",
1296 psfCSType->cCPacketClassificationRule.u8EthertypeLength);
1297 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8Ethertype[3]: 0x%X ,0x%X ,0x%X ",
1298 psfCSType->cCPacketClassificationRule.u8Ethertype[0],
1299 psfCSType->cCPacketClassificationRule.u8Ethertype[1],
1300 psfCSType->cCPacketClassificationRule.u8Ethertype[2]);
1301 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16UserPriority: 0x%X ",
1302 psfCSType->cCPacketClassificationRule.u16UserPriority);
1303 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16VLANID: 0x%X ", psfCSType->cCPacketClassificationRule.u16VLANID);
1304 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8AssociatedPHSI: 0x%X ", psfCSType->cCPacketClassificationRule.u8AssociatedPHSI);
1305 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u16PacketClassificationRuleIndex:0x%X ",
1306 psfCSType->cCPacketClassificationRule.u16PacketClassificationRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001307
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001308 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8VendorSpecificClassifierParamLength:0x%X ",
1309 psfCSType->cCPacketClassificationRule.u8VendorSpecificClassifierParamLength);
1310 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8VendorSpecificClassifierParam[1]:0x%X ",
1311 psfCSType->cCPacketClassificationRule.u8VendorSpecificClassifierParam[0]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001312#ifdef VERSION_D5
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001313 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8IPv6FlowLableLength: 0x%X ",
1314 psfCSType->cCPacketClassificationRule.u8IPv6FlowLableLength);
1315 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " u8IPv6FlowLable[6]: 0x%X ,0x%X ,0x%X ,0x%X ,0x%X ,0x%X ",
1316 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[0],
1317 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[1],
1318 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[2],
1319 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[3],
1320 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[4],
1321 psfCSType->cCPacketClassificationRule.u8IPv6FlowLable[5]);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001322#endif
1323 }
1324
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001325 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, DUMP_CONTROL, DBG_LVL_ALL, " bValid: 0x%X", pstAddIndication->sfActiveSet.bValid);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001326}
1327
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001328static inline ULONG RestoreSFParam(PMINI_ADAPTER Adapter, ULONG ulAddrSFParamSet, PUCHAR pucDestBuffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001329{
1330 UINT nBytesToRead = sizeof(stServiceFlowParamSI);
1331
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001332 if (ulAddrSFParamSet == 0 || NULL == pucDestBuffer) {
1333 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Got Param address as 0!!");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001334 return 0;
1335 }
1336 ulAddrSFParamSet = ntohl(ulAddrSFParamSet);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001337
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001338 /* Read out the SF Param Set At the indicated Location */
1339 if (rdm(Adapter, ulAddrSFParamSet, (PUCHAR)pucDestBuffer, nBytesToRead) < 0)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001340 return STATUS_FAILURE;
1341
1342 return 1;
1343}
1344
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001345static ULONG StoreSFParam(PMINI_ADAPTER Adapter, PUCHAR pucSrcBuffer, ULONG ulAddrSFParamSet)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001346{
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001347 UINT nBytesToWrite = sizeof(stServiceFlowParamSI);
Dan Carpenterf05321c2010-11-13 07:37:49 +03001348 int ret = 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001349
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001350 if (ulAddrSFParamSet == 0 || NULL == pucSrcBuffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001351 return 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001352
Dan Carpenterf05321c2010-11-13 07:37:49 +03001353 ret = wrm(Adapter, ulAddrSFParamSet, (u8 *)pucSrcBuffer, nBytesToWrite);
1354 if (ret < 0) {
Kevin McKinneye4868622012-01-04 20:29:01 -05001355 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "%s:%d WRM failed", __func__, __LINE__);
Dan Carpenterf05321c2010-11-13 07:37:49 +03001356 return ret;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001357 }
1358 return 1;
1359}
1360
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001361ULONG StoreCmControlResponseMessage(PMINI_ADAPTER Adapter, PVOID pvBuffer, UINT *puBufferLength)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001362{
1363 stLocalSFAddIndicationAlt *pstAddIndicationAlt = NULL;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001364 stLocalSFAddIndication *pstAddIndication = NULL;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001365 stLocalSFDeleteRequest *pstDeletionRequest;
1366 UINT uiSearchRuleIndex;
1367 ULONG ulSFID;
1368
1369 pstAddIndicationAlt = (stLocalSFAddIndicationAlt *)(pvBuffer);
1370
1371 /*
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001372 * In case of DSD Req By MS, we should immediately delete this SF so that
1373 * we can stop the further classifying the pkt for this SF.
1374 */
1375 if (pstAddIndicationAlt->u8Type == DSD_REQ) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001376 pstDeletionRequest = (stLocalSFDeleteRequest *)pvBuffer;
1377
1378 ulSFID = ntohl(pstDeletionRequest->u32SFID);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001379 uiSearchRuleIndex = SearchSfid(Adapter, ulSFID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001380
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001381 if (uiSearchRuleIndex < NO_OF_QUEUES) {
1382 deleteSFBySfid(Adapter, uiSearchRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001383 Adapter->u32TotalDSD++;
1384 }
1385 return 1;
1386 }
1387
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001388 if ((pstAddIndicationAlt->u8Type == DSD_RSP) ||
1389 (pstAddIndicationAlt->u8Type == DSD_ACK)) {
1390 /* No Special handling send the message as it is */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001391 return 1;
1392 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001393 /* For DSA_REQ, only up to "psfAuthorizedSet" parameter should be accessed by driver! */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001394
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001395 pstAddIndication = kmalloc(sizeof(*pstAddIndication), GFP_KERNEL);
Kevin McKinneycffae182012-01-04 20:29:03 -05001396 if (pstAddIndication == NULL)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001397 return 0;
1398
1399 /* AUTHORIZED SET */
1400 pstAddIndication->psfAuthorizedSet = (stServiceFlowParamSI *)
1401 GetNextTargetBufferLocation(Adapter, pstAddIndicationAlt->u16TID);
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001402 if (!pstAddIndication->psfAuthorizedSet) {
1403 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001404 return 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001405 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001406
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001407 if (StoreSFParam(Adapter, (PUCHAR)&pstAddIndicationAlt->sfAuthorizedSet,
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001408 (ULONG)pstAddIndication->psfAuthorizedSet) != 1) {
1409 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001410 return 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001411 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001412
Arnd Bergmann9f1c75a2010-09-30 10:24:11 +02001413 /* this can't possibly be right */
1414 pstAddIndication->psfAuthorizedSet = (stServiceFlowParamSI *)ntohl((ULONG)pstAddIndication->psfAuthorizedSet);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001415
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001416 if (pstAddIndicationAlt->u8Type == DSA_REQ) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001417 stLocalSFAddRequest AddRequest;
1418
1419 AddRequest.u8Type = pstAddIndicationAlt->u8Type;
1420 AddRequest.eConnectionDir = pstAddIndicationAlt->u8Direction;
1421 AddRequest.u16TID = pstAddIndicationAlt->u16TID;
1422 AddRequest.u16CID = pstAddIndicationAlt->u16CID;
1423 AddRequest.u16VCID = pstAddIndicationAlt->u16VCID;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001424 AddRequest.psfParameterSet = pstAddIndication->psfAuthorizedSet;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001425 (*puBufferLength) = sizeof(stLocalSFAddRequest);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001426 memcpy(pvBuffer, &AddRequest, sizeof(stLocalSFAddRequest));
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001427 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001428 return 1;
1429 }
1430
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001431 /* Since it's not DSA_REQ, we can access all field in pstAddIndicationAlt */
1432 /* We need to extract the structure from the buffer and pack it differently */
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001433
1434 pstAddIndication->u8Type = pstAddIndicationAlt->u8Type;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001435 pstAddIndication->eConnectionDir = pstAddIndicationAlt->u8Direction;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001436 pstAddIndication->u16TID = pstAddIndicationAlt->u16TID;
1437 pstAddIndication->u16CID = pstAddIndicationAlt->u16CID;
1438 pstAddIndication->u16VCID = pstAddIndicationAlt->u16VCID;
1439 pstAddIndication->u8CC = pstAddIndicationAlt->u8CC;
1440
1441 /* ADMITTED SET */
1442 pstAddIndication->psfAdmittedSet = (stServiceFlowParamSI *)
1443 GetNextTargetBufferLocation(Adapter, pstAddIndicationAlt->u16TID);
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001444 if (!pstAddIndication->psfAdmittedSet) {
1445 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001446 return 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001447 }
1448 if (StoreSFParam(Adapter, (PUCHAR)&pstAddIndicationAlt->sfAdmittedSet, (ULONG)pstAddIndication->psfAdmittedSet) != 1) {
1449 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001450 return 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001451 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001452
1453 pstAddIndication->psfAdmittedSet = (stServiceFlowParamSI *)ntohl((ULONG)pstAddIndication->psfAdmittedSet);
1454
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001455 /* ACTIVE SET */
1456 pstAddIndication->psfActiveSet = (stServiceFlowParamSI *)
1457 GetNextTargetBufferLocation(Adapter, pstAddIndicationAlt->u16TID);
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001458 if (!pstAddIndication->psfActiveSet) {
1459 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001460 return 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001461 }
1462 if (StoreSFParam(Adapter, (PUCHAR)&pstAddIndicationAlt->sfActiveSet, (ULONG)pstAddIndication->psfActiveSet) != 1) {
1463 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001464 return 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001465 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001466
1467 pstAddIndication->psfActiveSet = (stServiceFlowParamSI *)ntohl((ULONG)pstAddIndication->psfActiveSet);
1468
1469 (*puBufferLength) = sizeof(stLocalSFAddIndication);
1470 *(stLocalSFAddIndication *)pvBuffer = *pstAddIndication;
Stephen Hemminger082e8892010-11-01 09:35:21 -04001471 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001472 return 1;
1473}
1474
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001475static inline stLocalSFAddIndicationAlt
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001476*RestoreCmControlResponseMessage(register PMINI_ADAPTER Adapter, register PVOID pvBuffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001477{
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001478 ULONG ulStatus = 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001479 stLocalSFAddIndication *pstAddIndication = NULL;
1480 stLocalSFAddIndicationAlt *pstAddIndicationDest = NULL;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001481
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001482 pstAddIndication = (stLocalSFAddIndication *)(pvBuffer);
1483 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "=====>");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001484 if ((pstAddIndication->u8Type == DSD_REQ) ||
1485 (pstAddIndication->u8Type == DSD_RSP) ||
1486 (pstAddIndication->u8Type == DSD_ACK))
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001487 return (stLocalSFAddIndicationAlt *)pvBuffer;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001488
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001489 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Inside RestoreCmControlResponseMessage ");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001490 /*
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001491 * Need to Allocate memory to contain the SUPER Large structures
1492 * Our driver can't create these structures on Stack :(
1493 */
1494 pstAddIndicationDest = kmalloc(sizeof(stLocalSFAddIndicationAlt), GFP_KERNEL);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001495
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001496 if (pstAddIndicationDest) {
1497 memset(pstAddIndicationDest, 0, sizeof(stLocalSFAddIndicationAlt));
1498 } else {
1499 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Failed to allocate memory for SF Add Indication Structure ");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001500 return NULL;
1501 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001502 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-u8Type : 0x%X", pstAddIndication->u8Type);
1503 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-u8Direction : 0x%X", pstAddIndication->eConnectionDir);
1504 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-u8TID : 0x%X", ntohs(pstAddIndication->u16TID));
1505 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-u8CID : 0x%X", ntohs(pstAddIndication->u16CID));
1506 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-u16VCID : 0x%X", ntohs(pstAddIndication->u16VCID));
1507 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-autorized set loc : %p", pstAddIndication->psfAuthorizedSet);
1508 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-admitted set loc : %p", pstAddIndication->psfAdmittedSet);
1509 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "AddIndication-Active set loc : %p", pstAddIndication->psfActiveSet);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001510
1511 pstAddIndicationDest->u8Type = pstAddIndication->u8Type;
1512 pstAddIndicationDest->u8Direction = pstAddIndication->eConnectionDir;
1513 pstAddIndicationDest->u16TID = pstAddIndication->u16TID;
1514 pstAddIndicationDest->u16CID = pstAddIndication->u16CID;
1515 pstAddIndicationDest->u16VCID = pstAddIndication->u16VCID;
1516 pstAddIndicationDest->u8CC = pstAddIndication->u8CC;
1517
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001518 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Restoring Active Set ");
1519 ulStatus = RestoreSFParam(Adapter, (ULONG)pstAddIndication->psfActiveSet, (PUCHAR)&pstAddIndicationDest->sfActiveSet);
1520 if (ulStatus != 1)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001521 goto failed_restore_sf_param;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001522
1523 if (pstAddIndicationDest->sfActiveSet.u8TotalClassifiers > MAX_CLASSIFIERS_IN_SF)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001524 pstAddIndicationDest->sfActiveSet.u8TotalClassifiers = MAX_CLASSIFIERS_IN_SF;
1525
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001526 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Restoring Admitted Set ");
1527 ulStatus = RestoreSFParam(Adapter, (ULONG)pstAddIndication->psfAdmittedSet, (PUCHAR)&pstAddIndicationDest->sfAdmittedSet);
1528 if (ulStatus != 1)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001529 goto failed_restore_sf_param;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001530
1531 if (pstAddIndicationDest->sfAdmittedSet.u8TotalClassifiers > MAX_CLASSIFIERS_IN_SF)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001532 pstAddIndicationDest->sfAdmittedSet.u8TotalClassifiers = MAX_CLASSIFIERS_IN_SF;
1533
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001534 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Restoring Authorized Set ");
1535 ulStatus = RestoreSFParam(Adapter, (ULONG)pstAddIndication->psfAuthorizedSet, (PUCHAR)&pstAddIndicationDest->sfAuthorizedSet);
1536 if (ulStatus != 1)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001537 goto failed_restore_sf_param;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001538
1539 if (pstAddIndicationDest->sfAuthorizedSet.u8TotalClassifiers > MAX_CLASSIFIERS_IN_SF)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001540 pstAddIndicationDest->sfAuthorizedSet.u8TotalClassifiers = MAX_CLASSIFIERS_IN_SF;
1541
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001542 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Dumping the whole raw packet");
1543 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "============================================================");
1544 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, " pstAddIndicationDest->sfActiveSet size %zx %p", sizeof(*pstAddIndicationDest), pstAddIndicationDest);
1545 /* BCM_DEBUG_PRINT_BUFFER(Adapter,DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, (unsigned char *)pstAddIndicationDest, sizeof(*pstAddIndicationDest)); */
1546 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "============================================================");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001547 return pstAddIndicationDest;
1548failed_restore_sf_param:
Stephen Hemminger082e8892010-11-01 09:35:21 -04001549 kfree(pstAddIndicationDest);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001550 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "<=====");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001551 return NULL;
1552}
1553
1554ULONG SetUpTargetDsxBuffers(PMINI_ADAPTER Adapter)
1555{
1556 ULONG ulTargetDsxBuffersBase = 0;
1557 ULONG ulCntTargetBuffers;
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -05001558 ULONG i;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001559 int Status;
1560
Dan Carpenteracedadf2010-10-08 14:56:35 +02001561 if (!Adapter) {
1562 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Adapter was NULL!!!");
1563 return 0;
1564 }
1565
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001566 if (Adapter->astTargetDsxBuffer[0].ulTargetDsxBuffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001567 return 1;
1568
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001569 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Size of Each DSX Buffer(Also size of ServiceFlowParamSI): %zx ", sizeof(stServiceFlowParamSI));
1570 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Reading DSX buffer From Target location %x ", DSX_MESSAGE_EXCHANGE_BUFFER);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001571
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001572 Status = rdmalt(Adapter, DSX_MESSAGE_EXCHANGE_BUFFER, (PUINT)&ulTargetDsxBuffersBase, sizeof(UINT));
1573 if (Status < 0) {
1574 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "RDM failed!!");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001575 return 0;
1576 }
1577
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001578 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Base Address Of DSX Target Buffer : 0x%lx", ulTargetDsxBuffersBase);
1579 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Tgt Buffer is Now %lx :", ulTargetDsxBuffersBase);
1580 ulCntTargetBuffers = DSX_MESSAGE_EXCHANGE_BUFFER_SIZE / sizeof(stServiceFlowParamSI);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001581
1582 Adapter->ulTotalTargetBuffersAvailable =
1583 ulCntTargetBuffers > MAX_TARGET_DSX_BUFFERS ?
1584 MAX_TARGET_DSX_BUFFERS : ulCntTargetBuffers;
1585
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001586 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, " Total Target DSX Buffer setup %lx ", Adapter->ulTotalTargetBuffersAvailable);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001587
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -05001588 for (i = 0; i < Adapter->ulTotalTargetBuffersAvailable; i++) {
1589 Adapter->astTargetDsxBuffer[i].ulTargetDsxBuffer = ulTargetDsxBuffersBase;
1590 Adapter->astTargetDsxBuffer[i].valid = 1;
1591 Adapter->astTargetDsxBuffer[i].tid = 0;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001592 ulTargetDsxBuffersBase += sizeof(stServiceFlowParamSI);
1593 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, " Target DSX Buffer %lx setup at 0x%lx",
Kevin McKinney5cf4d6b2012-01-04 20:29:05 -05001594 i, Adapter->astTargetDsxBuffer[i].ulTargetDsxBuffer);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001595 }
1596 Adapter->ulCurrentTargetBuffer = 0;
1597 Adapter->ulFreeTargetBufferCnt = Adapter->ulTotalTargetBuffersAvailable;
1598 return 1;
1599}
1600
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001601static ULONG GetNextTargetBufferLocation(PMINI_ADAPTER Adapter, B_UINT16 tid)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001602{
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001603 ULONG ulTargetDSXBufferAddress;
1604 ULONG ulTargetDsxBufferIndexToUse, ulMaxTry;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001605
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001606 if ((Adapter->ulTotalTargetBuffersAvailable == 0) || (Adapter->ulFreeTargetBufferCnt == 0)) {
1607 ClearTargetDSXBuffer(Adapter, tid, FALSE);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001608 return 0;
1609 }
1610
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001611 ulTargetDsxBufferIndexToUse = Adapter->ulCurrentTargetBuffer;
1612 ulMaxTry = Adapter->ulTotalTargetBuffersAvailable;
1613 while ((ulMaxTry) && (Adapter->astTargetDsxBuffer[ulTargetDsxBufferIndexToUse].valid != 1)) {
1614 ulTargetDsxBufferIndexToUse = (ulTargetDsxBufferIndexToUse+1) % Adapter->ulTotalTargetBuffersAvailable;
1615 ulMaxTry--;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001616 }
1617
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001618 if (ulMaxTry == 0) {
1619 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "\n GetNextTargetBufferLocation : Error No Free Target DSX Buffers FreeCnt : %lx ", Adapter->ulFreeTargetBufferCnt);
1620 ClearTargetDSXBuffer(Adapter, tid, FALSE);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001621 return 0;
1622 }
1623
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001624 ulTargetDSXBufferAddress = Adapter->astTargetDsxBuffer[ulTargetDsxBufferIndexToUse].ulTargetDsxBuffer;
1625 Adapter->astTargetDsxBuffer[ulTargetDsxBufferIndexToUse].valid = 0;
1626 Adapter->astTargetDsxBuffer[ulTargetDsxBufferIndexToUse].tid = tid;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001627 Adapter->ulFreeTargetBufferCnt--;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001628 ulTargetDsxBufferIndexToUse = (ulTargetDsxBufferIndexToUse+1)%Adapter->ulTotalTargetBuffersAvailable;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001629 Adapter->ulCurrentTargetBuffer = ulTargetDsxBufferIndexToUse;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001630 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "GetNextTargetBufferLocation :Returning address %lx tid %d\n", ulTargetDSXBufferAddress, tid);
1631
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001632 return ulTargetDSXBufferAddress;
1633}
1634
Kevin McKinneyce4bbc22012-01-04 20:29:04 -05001635int AllocAdapterDsxBuffer(PMINI_ADAPTER Adapter)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001636{
1637 /*
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001638 * Need to Allocate memory to contain the SUPER Large structures
1639 * Our driver can't create these structures on Stack
1640 */
1641 Adapter->caDsxReqResp = kmalloc(sizeof(stLocalSFAddIndicationAlt)+LEADER_SIZE, GFP_KERNEL);
1642 if (!Adapter->caDsxReqResp)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001643 return -ENOMEM;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001644
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001645 return 0;
1646}
1647
Kevin McKinneyce4bbc22012-01-04 20:29:04 -05001648int FreeAdapterDsxBuffer(PMINI_ADAPTER Adapter)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001649{
Ilia Mirkin23c32982011-03-13 00:28:55 -05001650 kfree(Adapter->caDsxReqResp);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001651 return 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001652}
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001653
1654/*
1655 * @ingroup ctrl_pkt_functions
1656 * This routinue would process the Control responses
1657 * for the Connection Management.
1658 * @return - Queue index for the free SFID else returns Invalid Index.
1659 */
1660BOOLEAN CmControlResponseMessage(PMINI_ADAPTER Adapter, /* <Pointer to the Adapter structure */
1661 PVOID pvBuffer /* Starting Address of the Buffer, that contains the AddIndication Data */)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001662{
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001663 stServiceFlowParamSI *psfLocalSet = NULL;
1664 stLocalSFAddIndicationAlt *pstAddIndication = NULL;
1665 stLocalSFChangeIndicationAlt *pstChangeIndication = NULL;
1666 PLEADER pLeader = NULL;
1667
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001668 /*
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001669 * Otherwise the message contains a target address from where we need to
1670 * read out the rest of the service flow param structure
1671 */
Kevin McKinneycffae182012-01-04 20:29:03 -05001672 pstAddIndication = RestoreCmControlResponseMessage(Adapter, pvBuffer);
1673 if (pstAddIndication == NULL) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001674 ClearTargetDSXBuffer(Adapter, ((stLocalSFAddIndication *)pvBuffer)->u16TID, FALSE);
1675 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "Error in restoring Service Flow param structure from DSx message");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001676 return FALSE;
1677 }
1678
1679 DumpCmControlPacket(pstAddIndication);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001680 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "====>");
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001681 pLeader = (PLEADER)Adapter->caDsxReqResp;
1682
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001683 pLeader->Status = CM_CONTROL_NEWDSX_MULTICLASSIFIER_REQ;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001684 pLeader->Vcid = 0;
1685
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001686 ClearTargetDSXBuffer(Adapter, pstAddIndication->u16TID, FALSE);
1687 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "### TID RECEIVED %d\n", pstAddIndication->u16TID);
1688 switch (pstAddIndication->u8Type) {
1689 case DSA_REQ:
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001690 {
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001691 pLeader->PLength = sizeof(stLocalSFAddIndicationAlt);
1692 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Sending DSA Response....\n");
1693 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SENDING DSA RESPONSE TO MAC %d", pLeader->PLength);
1694 *((stLocalSFAddIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE]))
1695 = *pstAddIndication;
1696 ((stLocalSFAddIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE]))->u8Type = DSA_RSP;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001697
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001698 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, " VCID = %x", ntohs(pstAddIndication->u16VCID));
1699 CopyBufferToControlPacket(Adapter, (PVOID)Adapter->caDsxReqResp);
1700 kfree(pstAddIndication);
1701 }
1702 break;
1703 case DSA_RSP:
1704 {
1705 pLeader->PLength = sizeof(stLocalSFAddIndicationAlt);
1706 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SENDING DSA ACK TO MAC %d",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001707 pLeader->PLength);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001708 *((stLocalSFAddIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE]))
1709 = *pstAddIndication;
1710 ((stLocalSFAddIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE]))->u8Type = DSA_ACK;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001711
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001712 } /* no break here..we should go down. */
1713 case DSA_ACK:
1714 {
1715 UINT uiSearchRuleIndex = 0;
Stephen Hemmingere4d46252010-11-01 11:39:05 -04001716
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001717 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "VCID:0x%X",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001718 ntohs(pstAddIndication->u16VCID));
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001719 uiSearchRuleIndex = SearchFreeSfid(Adapter);
1720 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "uiSearchRuleIndex:0x%X ",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001721 uiSearchRuleIndex);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001722 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Direction:0x%X ",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001723 pstAddIndication->u8Direction);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001724 if ((uiSearchRuleIndex < NO_OF_QUEUES)) {
1725 Adapter->PackInfo[uiSearchRuleIndex].ucDirection =
1726 pstAddIndication->u8Direction;
1727 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "bValid:0x%X ",
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001728 pstAddIndication->sfActiveSet.bValid);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001729 if (pstAddIndication->sfActiveSet.bValid == TRUE)
1730 Adapter->PackInfo[uiSearchRuleIndex].bActiveSet = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001731
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001732 if (pstAddIndication->sfAuthorizedSet.bValid == TRUE)
1733 Adapter->PackInfo[uiSearchRuleIndex].bAuthorizedSet = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001734
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001735 if (pstAddIndication->sfAdmittedSet.bValid == TRUE)
1736 Adapter->PackInfo[uiSearchRuleIndex].bAdmittedSet = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001737
Kevin McKinneycffae182012-01-04 20:29:03 -05001738 if (pstAddIndication->sfActiveSet.bValid == FALSE) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001739 Adapter->PackInfo[uiSearchRuleIndex].bActive = FALSE;
1740 Adapter->PackInfo[uiSearchRuleIndex].bActivateRequestSent = FALSE;
1741 if (pstAddIndication->sfAdmittedSet.bValid)
1742 psfLocalSet = &pstAddIndication->sfAdmittedSet;
1743 else if (pstAddIndication->sfAuthorizedSet.bValid)
1744 psfLocalSet = &pstAddIndication->sfAuthorizedSet;
1745 } else {
1746 psfLocalSet = &pstAddIndication->sfActiveSet;
1747 Adapter->PackInfo[uiSearchRuleIndex].bActive = TRUE;
1748 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001749
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001750 if (!psfLocalSet) {
1751 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "No set is valid\n");
1752 Adapter->PackInfo[uiSearchRuleIndex].bActive = FALSE;
1753 Adapter->PackInfo[uiSearchRuleIndex].bValid = FALSE;
1754 Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value = 0;
1755 kfree(pstAddIndication);
1756 } else if (psfLocalSet->bValid && (pstAddIndication->u8CC == 0)) {
1757 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "DSA ACK");
1758 Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value = ntohs(pstAddIndication->u16VCID);
1759 Adapter->PackInfo[uiSearchRuleIndex].usCID = ntohs(pstAddIndication->u16CID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001760
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001761 if (UPLINK_DIR == pstAddIndication->u8Direction)
1762 atomic_set(&Adapter->PackInfo[uiSearchRuleIndex].uiPerSFTxResourceCount, DEFAULT_PERSFCOUNT);
1763
1764 CopyToAdapter(Adapter, psfLocalSet, uiSearchRuleIndex, DSA_ACK, pstAddIndication);
1765 /* don't free pstAddIndication */
1766
1767 /* Inside CopyToAdapter, Sorting of all the SFs take place.
1768 * Hence any access to the newly added SF through uiSearchRuleIndex is invalid.
1769 * SHOULD BE STRICTLY AVOIDED.
1770 */
1771 /* *(PULONG)(((PUCHAR)pvBuffer)+1)=psfLocalSet->u32SFID; */
1772 memcpy((((PUCHAR)pvBuffer)+1), &psfLocalSet->u32SFID, 4);
1773
1774 if (pstAddIndication->sfActiveSet.bValid == TRUE) {
1775 if (UPLINK_DIR == pstAddIndication->u8Direction) {
1776 if (!Adapter->LinkUpStatus) {
1777 netif_carrier_on(Adapter->dev);
1778 netif_start_queue(Adapter->dev);
1779 Adapter->LinkUpStatus = 1;
1780 if (netif_msg_link(Adapter))
1781 pr_info(PFX "%s: link up\n", Adapter->dev->name);
1782 atomic_set(&Adapter->TxPktAvail, 1);
1783 wake_up(&Adapter->tx_packet_wait_queue);
1784 Adapter->liTimeSinceLastNetEntry = get_seconds();
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001785 }
1786 }
1787 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001788 } else {
1789 Adapter->PackInfo[uiSearchRuleIndex].bActive = FALSE;
1790 Adapter->PackInfo[uiSearchRuleIndex].bValid = FALSE;
1791 Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value = 0;
Stephen Hemminger082e8892010-11-01 09:35:21 -04001792 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001793 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001794 } else {
1795 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "DSA ACK did not get valid SFID");
Stephen Hemminger082e8892010-11-01 09:35:21 -04001796 kfree(pstAddIndication);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001797 return FALSE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001798 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001799 }
1800 break;
1801 case DSC_REQ:
1802 {
1803 pLeader->PLength = sizeof(stLocalSFChangeIndicationAlt);
1804 pstChangeIndication = (stLocalSFChangeIndicationAlt *)pstAddIndication;
1805 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SENDING DSC RESPONSE TO MAC %d", pLeader->PLength);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001806
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001807 *((stLocalSFChangeIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE])) = *pstChangeIndication;
1808 ((stLocalSFChangeIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE]))->u8Type = DSC_RSP;
1809
1810 CopyBufferToControlPacket(Adapter, (PVOID)Adapter->caDsxReqResp);
1811 kfree(pstAddIndication);
1812 }
1813 break;
1814 case DSC_RSP:
1815 {
1816 pLeader->PLength = sizeof(stLocalSFChangeIndicationAlt);
1817 pstChangeIndication = (stLocalSFChangeIndicationAlt *)pstAddIndication;
1818 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SENDING DSC ACK TO MAC %d", pLeader->PLength);
1819 *((stLocalSFChangeIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE])) = *pstChangeIndication;
1820 ((stLocalSFChangeIndicationAlt *)&(Adapter->caDsxReqResp[LEADER_SIZE]))->u8Type = DSC_ACK;
1821 }
1822 case DSC_ACK:
1823 {
1824 UINT uiSearchRuleIndex = 0;
1825
1826 pstChangeIndication = (stLocalSFChangeIndicationAlt *)pstAddIndication;
1827 uiSearchRuleIndex = SearchSfid(Adapter, ntohl(pstChangeIndication->sfActiveSet.u32SFID));
1828 if (uiSearchRuleIndex > NO_OF_QUEUES-1)
1829 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "SF doesn't exist for which DSC_ACK is received");
1830
1831 if ((uiSearchRuleIndex < NO_OF_QUEUES)) {
1832 Adapter->PackInfo[uiSearchRuleIndex].ucDirection = pstChangeIndication->u8Direction;
1833 if (pstChangeIndication->sfActiveSet.bValid == TRUE)
1834 Adapter->PackInfo[uiSearchRuleIndex].bActiveSet = TRUE;
1835
1836 if (pstChangeIndication->sfAuthorizedSet.bValid == TRUE)
1837 Adapter->PackInfo[uiSearchRuleIndex].bAuthorizedSet = TRUE;
1838
1839 if (pstChangeIndication->sfAdmittedSet.bValid == TRUE)
1840 Adapter->PackInfo[uiSearchRuleIndex].bAdmittedSet = TRUE;
1841
Kevin McKinneycffae182012-01-04 20:29:03 -05001842 if (pstChangeIndication->sfActiveSet.bValid == FALSE) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001843 Adapter->PackInfo[uiSearchRuleIndex].bActive = FALSE;
1844 Adapter->PackInfo[uiSearchRuleIndex].bActivateRequestSent = FALSE;
1845
1846 if (pstChangeIndication->sfAdmittedSet.bValid)
1847 psfLocalSet = &pstChangeIndication->sfAdmittedSet;
1848 else if (pstChangeIndication->sfAuthorizedSet.bValid)
1849 psfLocalSet = &pstChangeIndication->sfAuthorizedSet;
1850 } else {
1851 psfLocalSet = &pstChangeIndication->sfActiveSet;
1852 Adapter->PackInfo[uiSearchRuleIndex].bActive = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001853 }
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001854
Kevin McKinneyadc4a3a2012-02-23 23:41:05 -05001855 if (!psfLocalSet) {
1856 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "No set is valid\n");
1857 Adapter->PackInfo[uiSearchRuleIndex].bActive = FALSE;
1858 Adapter->PackInfo[uiSearchRuleIndex].bValid = FALSE;
1859 Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value = 0;
Kevin McKinneycc55bb02012-03-02 00:17:04 -05001860 kfree(pstAddIndication);
Kevin McKinneyadc4a3a2012-02-23 23:41:05 -05001861 } else if (psfLocalSet->bValid && (pstChangeIndication->u8CC == 0)) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001862 Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value = ntohs(pstChangeIndication->u16VCID);
1863 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "CC field is %d bvalid = %d\n",
1864 pstChangeIndication->u8CC, psfLocalSet->bValid);
1865 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "VCID= %d\n", ntohs(pstChangeIndication->u16VCID));
1866 Adapter->PackInfo[uiSearchRuleIndex].usCID = ntohs(pstChangeIndication->u16CID);
1867 CopyToAdapter(Adapter, psfLocalSet, uiSearchRuleIndex, DSC_ACK, pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001868
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001869 *(PULONG)(((PUCHAR)pvBuffer)+1) = psfLocalSet->u32SFID;
1870 } else if (pstChangeIndication->u8CC == 6) {
1871 deleteSFBySfid(Adapter, uiSearchRuleIndex);
Stephen Hemminger082e8892010-11-01 09:35:21 -04001872 kfree(pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001873 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001874 } else {
1875 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "DSC ACK did not get valid SFID");
1876 kfree(pstAddIndication);
1877 return FALSE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001878 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001879 }
1880 break;
1881 case DSD_REQ:
1882 {
1883 UINT uiSearchRuleIndex;
1884 ULONG ulSFID;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001885
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001886 pLeader->PLength = sizeof(stLocalSFDeleteIndication);
1887 *((stLocalSFDeleteIndication *)&(Adapter->caDsxReqResp[LEADER_SIZE])) = *((stLocalSFDeleteIndication *)pstAddIndication);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001888
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001889 ulSFID = ntohl(((stLocalSFDeleteIndication *)pstAddIndication)->u32SFID);
1890 uiSearchRuleIndex = SearchSfid(Adapter, ulSFID);
1891 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "DSD - Removing connection %x", uiSearchRuleIndex);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001892
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001893 if (uiSearchRuleIndex < NO_OF_QUEUES) {
1894 /* Delete All Classifiers Associated with this SFID */
1895 deleteSFBySfid(Adapter, uiSearchRuleIndex);
1896 Adapter->u32TotalDSD++;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001897 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001898
1899 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SENDING DSD RESPONSE TO MAC");
1900 ((stLocalSFDeleteIndication *)&(Adapter->caDsxReqResp[LEADER_SIZE]))->u8Type = DSD_RSP;
1901 CopyBufferToControlPacket(Adapter, (PVOID)Adapter->caDsxReqResp);
1902 }
1903 case DSD_RSP:
1904 {
1905 /* Do nothing as SF has already got Deleted */
1906 }
1907 break;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001908 case DSD_ACK:
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001909 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "DSD ACK Rcd, let App handle it\n");
1910 break;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001911 default:
Stephen Hemminger082e8892010-11-01 09:35:21 -04001912 kfree(pstAddIndication);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001913 return FALSE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001914 }
1915 return TRUE;
1916}
1917
Arnd Bergmann44a17eff2010-09-30 10:24:12 +02001918int get_dsx_sf_data_to_application(PMINI_ADAPTER Adapter, UINT uiSFId, void __user *user_buffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001919{
1920 int status = 0;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001921 struct _packet_info *psSfInfo = NULL;
1922
1923 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "status =%d", status);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001924 status = SearchSfid(Adapter, uiSFId);
Dan Carpenter370adc72010-10-08 15:49:04 +02001925 if (status >= NO_OF_QUEUES) {
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001926 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SFID %d not present in queue !!!", uiSFId);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001927 return -EINVAL;
1928 }
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001929 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "status =%d", status);
1930 psSfInfo = &Adapter->PackInfo[status];
1931 if (psSfInfo->pstSFIndication && copy_to_user(user_buffer,
1932 psSfInfo->pstSFIndication, sizeof(stLocalSFAddIndicationAlt))) {
1933 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_PRINTK, 0, 0, "copy to user failed SFID %d, present in queue !!!", uiSFId);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001934 status = -EFAULT;
1935 return status;
1936 }
1937 return STATUS_SUCCESS;
1938}
1939
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001940VOID OverrideServiceFlowParams(PMINI_ADAPTER Adapter, PUINT puiBuffer)
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001941{
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001942 B_UINT32 u32NumofSFsinMsg = ntohl(*(puiBuffer + 1));
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001943 stIM_SFHostNotify *pHostInfo = NULL;
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001944 UINT uiSearchRuleIndex = 0;
1945 ULONG ulSFID = 0;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001946
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001947 puiBuffer += 2;
1948 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "u32NumofSFsinMsg: 0x%x\n", u32NumofSFsinMsg);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001949
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001950 while (u32NumofSFsinMsg != 0 && u32NumofSFsinMsg < NO_OF_QUEUES) {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001951 u32NumofSFsinMsg--;
1952 pHostInfo = (stIM_SFHostNotify *)puiBuffer;
1953 puiBuffer = (PUINT)(pHostInfo + 1);
1954
1955 ulSFID = ntohl(pHostInfo->SFID);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001956 uiSearchRuleIndex = SearchSfid(Adapter, ulSFID);
1957 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "SFID: 0x%lx\n", ulSFID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001958
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001959 if (uiSearchRuleIndex >= NO_OF_QUEUES || uiSearchRuleIndex == HiPriority) {
1960 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "The SFID <%lx> doesn't exist in host entry or is Invalid\n", ulSFID);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001961 continue;
1962 }
1963
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001964 if (pHostInfo->RetainSF == FALSE) {
1965 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "Going to Delete SF");
1966 deleteSFBySfid(Adapter, uiSearchRuleIndex);
1967 } else {
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001968 Adapter->PackInfo[uiSearchRuleIndex].usVCID_Value = ntohs(pHostInfo->VCID);
1969 Adapter->PackInfo[uiSearchRuleIndex].usCID = ntohs(pHostInfo->newCID);
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001970 Adapter->PackInfo[uiSearchRuleIndex].bActive = FALSE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001971
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001972 BCM_DEBUG_PRINT(Adapter, DBG_TYPE_OTHERS, CONN_MSG, DBG_LVL_ALL, "pHostInfo->QoSParamSet: 0x%x\n", pHostInfo->QoSParamSet);
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001973
Kevin McKinney9937fdb2012-01-04 20:29:00 -05001974 if (pHostInfo->QoSParamSet & 0x1)
1975 Adapter->PackInfo[uiSearchRuleIndex].bAuthorizedSet = TRUE;
1976 if (pHostInfo->QoSParamSet & 0x2)
1977 Adapter->PackInfo[uiSearchRuleIndex].bAdmittedSet = TRUE;
1978 if (pHostInfo->QoSParamSet & 0x4) {
1979 Adapter->PackInfo[uiSearchRuleIndex].bActiveSet = TRUE;
1980 Adapter->PackInfo[uiSearchRuleIndex].bActive = TRUE;
Stephen Hemmingerf8942e02010-09-08 14:46:36 -07001981 }
1982 }
1983 }
1984}