-
Notifications
You must be signed in to change notification settings - Fork 84
/
CWVendorPayloadsAC.c
156 lines (139 loc) · 6.61 KB
/
CWVendorPayloadsAC.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
/************************************************************************************************
* Copyright (c) 2006-2009 Laboratorio di Sistemi di Elaborazione e Bioingegneria Informatica *
* Universita' Campus BioMedico - Italy *
* *
* This program is free software; you can redistribute it and/or modify it under the terms *
* of the GNU General Public License as published by the free Software Foundation; either *
* version 2 of the License, or (at your option) any later version. *
* *
* This program is distributed in the hope that it will be useful, but WITHOUT ANY *
* WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A *
* PARTICULAR PURPOSE. See the GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License along with this *
* program; if not, write to the: *
* Free Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, *
* MA 02111-1307, USA. *
*
* In addition, as a special exception, the copyright holders give permission to link the *
* code of portions of this program with the OpenSSL library under certain conditions as *
* described in each individual source file, and distribute linked combinations including *
* the two. You must obey the GNU General Public License in all respects for all of the *
* code used other than OpenSSL. If you modify file(s) with this exception, you may *
* extend this exception to your version of the file(s), but you are not obligated to do *
* so. If you do not wish to do so, delete this exception statement from your version. *
* If you delete this exception statement from all source files in the program, then also *
* delete it here. *
*
* -------------------------------------------------------------------------------------------- *
* Project: Capwap *
* *
* Authors : Matteo Latini (mtylty@gmail.com) *
*
************************************************************************************************/
#include "CWVendorPayloads.h"
#include "WUM.h"
#include <stdio.h>
#include <stdlib.h>
#include <errno.h>
#include <string.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <sys/un.h>
#include <unistd.h>
#include <signal.h>
#ifdef DMALLOC
#include "../dmalloc-5.5.0/dmalloc.h"
#endif
CWBool CWAssembleWTPVendorPayloadUCI(CWProtocolMessage *msgPtr) {
int* iPtr;
unsigned short msgType;
CWProtocolVendorSpecificValues* valuesPtr;
CWVendorUciValues* uciPtr;
CWLog("Assembling Protocol Configuration Update Request [VENDOR CASE]...");
if(msgPtr == NULL) return CWErrorRaise(CW_ERROR_WRONG_ARG, NULL);
if((iPtr = ((int*)CWThreadGetSpecific(&gIndexSpecific))) == NULL) {
return CW_FALSE;
}
valuesPtr =gWTPs[*iPtr].vendorValues;
switch (valuesPtr->vendorPayloadType){
case CW_MSG_ELEMENT_VENDOR_SPEC_PAYLOAD_UCI:
msgType = CW_MSG_ELEMENT_VENDOR_SPEC_PAYLOAD_UCI;
uciPtr = (CWVendorUciValues *) valuesPtr->payload;
if (uciPtr->commandArgs != NULL) {
/* create message */
CW_CREATE_PROTOCOL_MESSAGE(*msgPtr, sizeof(short)+sizeof(char)+sizeof(int)+(strlen(uciPtr->commandArgs)*sizeof(char)), return CWErrorRaise(CW_ERROR_OUT_OF_MEMORY, NULL););
CWProtocolStore16(msgPtr, (unsigned short) msgType);
CWProtocolStore8(msgPtr, (unsigned char) uciPtr->command);
CWProtocolStore32(msgPtr, (unsigned int) strlen(uciPtr->commandArgs));
CWProtocolStoreStr(msgPtr, uciPtr->commandArgs);
} else {
/* create message */
CW_CREATE_PROTOCOL_MESSAGE(*msgPtr, sizeof(short)+sizeof(char)+sizeof(int), return CWErrorRaise(CW_ERROR_OUT_OF_MEMORY, NULL););
CWProtocolStore16(msgPtr, (unsigned short) msgType);
CWProtocolStore8(msgPtr, (unsigned char) uciPtr->command);
CWProtocolStore32(msgPtr, 0);
}
break;
default:
return CW_FALSE;
break;
}
CWLog("Assembling Protocol Configuration Update Request [VENDOR CASE]: Message Assembled.");
return CWAssembleMsgElem(msgPtr, CW_MSG_ELEMENT_VENDOR_SPEC_PAYLOAD_CW_TYPE);
}
CWBool CWAssembleWTPVendorPayloadWUM(CWProtocolMessage *msgPtr) {
int* iPtr;
unsigned short msgType;
CWProtocolVendorSpecificValues* valuesPtr;
CWVendorWumValues* wumPtr;
CWLog("Assembling Protocol Configuration Update Request [VENDOR CASE]...");
if(msgPtr == NULL) return CWErrorRaise(CW_ERROR_WRONG_ARG, NULL);
if((iPtr = ((int*)CWThreadGetSpecific(&gIndexSpecific))) == NULL) {
return CW_FALSE;
}
valuesPtr =gWTPs[*iPtr].vendorValues;
switch (valuesPtr->vendorPayloadType){
case CW_MSG_ELEMENT_VENDOR_SPEC_PAYLOAD_WUM:
/*
* Here we assemble the WTP Update Messages.
*/
msgType = CW_MSG_ELEMENT_VENDOR_SPEC_PAYLOAD_WUM;
wumPtr = (CWVendorWumValues*) valuesPtr->payload;
switch(wumPtr->type) {
case WTP_VERSION_REQUEST:
case WTP_COMMIT_UPDATE:
case WTP_CANCEL_UPDATE_REQUEST:
CW_CREATE_PROTOCOL_MESSAGE(*msgPtr, sizeof(short)+sizeof(char), return CWErrorRaise(CW_ERROR_OUT_OF_MEMORY, NULL););
break;
case WTP_UPDATE_REQUEST:
CW_CREATE_PROTOCOL_MESSAGE(*msgPtr, sizeof(short)+4*sizeof(char)+sizeof(unsigned int), return CWErrorRaise(CW_ERROR_OUT_OF_MEMORY, NULL););
break;
case WTP_CUP_FRAGMENT:
CW_CREATE_PROTOCOL_MESSAGE(*msgPtr, sizeof(short)+sizeof(char)+2*sizeof(int)+wumPtr->_cup_fragment_size_, return CWErrorRaise(CW_ERROR_OUT_OF_MEMORY, NULL););
break;
default:
CWLog("Error! unknown WUM message type!!!");
return CW_FALSE;
}
CWProtocolStore16(msgPtr, (unsigned short) msgType);
CWProtocolStore8(msgPtr, (unsigned char) wumPtr->type);
if (wumPtr->type == WTP_UPDATE_REQUEST) {
CWProtocolStore8(msgPtr, wumPtr->_major_v_);
CWProtocolStore8(msgPtr, wumPtr->_minor_v_);
CWProtocolStore8(msgPtr, wumPtr->_revision_v_);
CWProtocolStore32(msgPtr, wumPtr->_pack_size_);
} else if (wumPtr->type == WTP_CUP_FRAGMENT) {
CWProtocolStore32(msgPtr, wumPtr->_seq_num_);
CWProtocolStore32(msgPtr, wumPtr->_cup_fragment_size_);
CWProtocolStoreRawBytes(msgPtr, wumPtr->_cup_, wumPtr->_cup_fragment_size_);
CW_FREE_OBJECT(wumPtr->_cup_);
}
break;
default:
return CW_FALSE;
break;
}
CWLog("Assembling Protocol Configuration Update Request [VENDOR CASE]: Message Assembled.");
return CWAssembleMsgElem(msgPtr, CW_MSG_ELEMENT_VENDOR_SPEC_PAYLOAD_CW_TYPE);
}