/src/FreeRDP/libfreerdp/utils/pcap.c
Line  | Count  | Source (jump to first uncovered line)  | 
1  |  | /**  | 
2  |  |  * FreeRDP: A Remote Desktop Protocol Implementation  | 
3  |  |  * pcap File Format Utils  | 
4  |  |  *  | 
5  |  |  * Copyright 2011 Marc-Andre Moreau <marcandre.moreau@gmail.com>  | 
6  |  |  *  | 
7  |  |  * Licensed under the Apache License, Version 2.0 (the "License");  | 
8  |  |  * you may not use this file except in compliance with the License.  | 
9  |  |  * You may obtain a copy of the License at  | 
10  |  |  *  | 
11  |  |  *     http://www.apache.org/licenses/LICENSE-2.0  | 
12  |  |  *  | 
13  |  |  * Unless required by applicable law or agreed to in writing, software  | 
14  |  |  * distributed under the License is distributed on an "AS IS" BASIS,  | 
15  |  |  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.  | 
16  |  |  * See the License for the specific language governing permissions and  | 
17  |  |  * limitations under the License.  | 
18  |  |  */  | 
19  |  |  | 
20  |  | #include <freerdp/config.h>  | 
21  |  |  | 
22  |  | #include <stdio.h>  | 
23  |  | #include <stdlib.h>  | 
24  |  | #include <string.h>  | 
25  |  |  | 
26  |  | #include <winpr/wtypes.h>  | 
27  |  | #include <winpr/assert.h>  | 
28  |  | #include <winpr/file.h>  | 
29  |  | #include <winpr/crt.h>  | 
30  |  | #include <winpr/sysinfo.h>  | 
31  |  | #include <freerdp/log.h>  | 
32  |  |  | 
33  |  | #define TAG FREERDP_TAG("utils") | 
34  |  |  | 
35  |  | #include <freerdp/types.h>  | 
36  |  | #include <freerdp/utils/pcap.h>  | 
37  |  |  | 
38  | 0  | #define PCAP_MAGIC 0xA1B2C3D4  | 
39  |  |  | 
40  |  | struct rdp_pcap  | 
41  |  | { | 
42  |  |   FILE* fp;  | 
43  |  |   char* name;  | 
44  |  |   BOOL write;  | 
45  |  |   INT64 file_size;  | 
46  |  |   size_t record_count;  | 
47  |  |   pcap_header header;  | 
48  |  |   pcap_record* head;  | 
49  |  |   pcap_record* tail;  | 
50  |  |   pcap_record* record;  | 
51  |  | };  | 
52  |  |  | 
53  |  | static BOOL pcap_read_header(rdpPcap* pcap, pcap_header* header)  | 
54  | 0  | { | 
55  | 0  |   WINPR_ASSERT(pcap);  | 
56  | 0  |   WINPR_ASSERT(header);  | 
57  |  |  | 
58  | 0  |   return fread(header, sizeof(pcap_header), 1, pcap->fp) == 1;  | 
59  | 0  | }  | 
60  |  |  | 
61  |  | static BOOL pcap_write_header(rdpPcap* pcap, const pcap_header* header)  | 
62  | 0  | { | 
63  | 0  |   WINPR_ASSERT(pcap);  | 
64  | 0  |   WINPR_ASSERT(header);  | 
65  |  |  | 
66  | 0  |   return fwrite(header, sizeof(pcap_header), 1, pcap->fp) == 1;  | 
67  | 0  | }  | 
68  |  |  | 
69  |  | static BOOL pcap_read_record_header(rdpPcap* pcap, pcap_record_header* record)  | 
70  | 0  | { | 
71  | 0  |   WINPR_ASSERT(pcap);  | 
72  | 0  |   WINPR_ASSERT(record);  | 
73  |  |  | 
74  | 0  |   return fread(record, sizeof(pcap_record_header), 1, pcap->fp) == 1;  | 
75  | 0  | }  | 
76  |  |  | 
77  |  | static BOOL pcap_write_record_header(rdpPcap* pcap, const pcap_record_header* record)  | 
78  | 0  | { | 
79  | 0  |   WINPR_ASSERT(pcap);  | 
80  | 0  |   WINPR_ASSERT(record);  | 
81  |  |  | 
82  | 0  |   return fwrite(record, sizeof(pcap_record_header), 1, pcap->fp) == 1;  | 
83  | 0  | }  | 
84  |  |  | 
85  |  | static BOOL pcap_read_record(rdpPcap* pcap, pcap_record* record)  | 
86  | 0  | { | 
87  | 0  |   WINPR_ASSERT(pcap);  | 
88  | 0  |   WINPR_ASSERT(record);  | 
89  |  |  | 
90  | 0  |   if (!pcap_read_record_header(pcap, &record->header))  | 
91  | 0  |     return FALSE;  | 
92  |  |  | 
93  | 0  |   record->length = record->header.incl_len;  | 
94  | 0  |   record->data = malloc(record->length);  | 
95  | 0  |   if (!record->data)  | 
96  | 0  |     return FALSE;  | 
97  |  |  | 
98  | 0  |   if (fread(record->data, record->length, 1, pcap->fp) != 1)  | 
99  | 0  |   { | 
100  | 0  |     free(record->data);  | 
101  | 0  |     record->data = NULL;  | 
102  | 0  |     return FALSE;  | 
103  | 0  |   }  | 
104  | 0  |   return TRUE;  | 
105  | 0  | }  | 
106  |  |  | 
107  |  | static BOOL pcap_write_record(rdpPcap* pcap, const pcap_record* record)  | 
108  | 0  | { | 
109  | 0  |   WINPR_ASSERT(pcap);  | 
110  | 0  |   WINPR_ASSERT(record);  | 
111  |  |  | 
112  | 0  |   return pcap_write_record_header(pcap, &record->header) &&  | 
113  | 0  |          (fwrite(record->cdata, record->length, 1, pcap->fp) == 1);  | 
114  | 0  | }  | 
115  |  |  | 
116  |  | BOOL pcap_add_record(rdpPcap* pcap, const void* data, size_t length)  | 
117  | 0  | { | 
118  | 0  |   WINPR_ASSERT(pcap);  | 
119  | 0  |   WINPR_ASSERT(data || (length == 0));  | 
120  | 0  |   WINPR_ASSERT(length <= UINT32_MAX);  | 
121  |  |  | 
122  | 0  |   pcap_record* record = (pcap_record*)calloc(1, sizeof(pcap_record));  | 
123  | 0  |   if (!record)  | 
124  | 0  |     return FALSE;  | 
125  |  |  | 
126  | 0  |   record->cdata = data;  | 
127  | 0  |   record->length = length;  | 
128  | 0  |   record->header.incl_len = (UINT32)length;  | 
129  | 0  |   record->header.orig_len = (UINT32)length;  | 
130  |  | 
  | 
131  | 0  |   const UINT64 ns = winpr_GetUnixTimeNS();  | 
132  |  | 
  | 
133  | 0  |   record->header.ts_sec = WINPR_TIME_NS_TO_S(ns);  | 
134  | 0  |   record->header.ts_usec = WINPR_TIME_NS_REM_US(ns);  | 
135  |  | 
  | 
136  | 0  |   if (pcap->tail == NULL)  | 
137  | 0  |   { | 
138  | 0  |     pcap->tail = record;  | 
139  | 0  |     if (!pcap->tail)  | 
140  | 0  |       return FALSE;  | 
141  |  |  | 
142  | 0  |     pcap->head = pcap->tail;  | 
143  | 0  |   }  | 
144  | 0  |   else  | 
145  | 0  |   { | 
146  | 0  |     record->next = pcap->tail;  | 
147  | 0  |     pcap->tail = record;  | 
148  | 0  |   }  | 
149  |  |  | 
150  | 0  |   if (pcap->record == NULL)  | 
151  | 0  |     pcap->record = record;  | 
152  |  | 
  | 
153  | 0  |   return TRUE;  | 
154  | 0  | }  | 
155  |  |  | 
156  |  | BOOL pcap_has_next_record(const rdpPcap* pcap)  | 
157  | 0  | { | 
158  | 0  |   WINPR_ASSERT(pcap);  | 
159  |  |  | 
160  | 0  |   if (pcap->file_size - (_ftelli64(pcap->fp)) <= 16)  | 
161  | 0  |     return FALSE;  | 
162  |  |  | 
163  | 0  |   return TRUE;  | 
164  | 0  | }  | 
165  |  |  | 
166  |  | BOOL pcap_get_next_record_header(rdpPcap* pcap, pcap_record* record)  | 
167  | 0  | { | 
168  | 0  |   WINPR_ASSERT(pcap);  | 
169  | 0  |   WINPR_ASSERT(record);  | 
170  |  |  | 
171  | 0  |   if (pcap_has_next_record(pcap) != TRUE)  | 
172  | 0  |     return FALSE;  | 
173  |  |  | 
174  | 0  |   pcap_read_record_header(pcap, &record->header);  | 
175  | 0  |   record->length = record->header.incl_len;  | 
176  |  | 
  | 
177  | 0  |   return TRUE;  | 
178  | 0  | }  | 
179  |  |  | 
180  |  | BOOL pcap_get_next_record_content(rdpPcap* pcap, pcap_record* record)  | 
181  | 0  | { | 
182  | 0  |   WINPR_ASSERT(pcap);  | 
183  | 0  |   WINPR_ASSERT(record);  | 
184  |  |  | 
185  | 0  |   return fread(record->data, record->length, 1, pcap->fp) == 1;  | 
186  | 0  | }  | 
187  |  |  | 
188  |  | BOOL pcap_get_next_record(rdpPcap* pcap, pcap_record* record)  | 
189  | 0  | { | 
190  | 0  |   WINPR_ASSERT(pcap);  | 
191  | 0  |   WINPR_ASSERT(record);  | 
192  |  |  | 
193  | 0  |   return pcap_has_next_record(pcap) && pcap_read_record(pcap, record);  | 
194  | 0  | }  | 
195  |  |  | 
196  |  | rdpPcap* pcap_open(const char* name, BOOL write)  | 
197  | 0  | { | 
198  | 0  |   rdpPcap* pcap = NULL;  | 
199  |  | 
  | 
200  | 0  |   WINPR_ASSERT(name);  | 
201  |  |  | 
202  | 0  |   pcap = (rdpPcap*)calloc(1, sizeof(rdpPcap));  | 
203  | 0  |   if (!pcap)  | 
204  | 0  |     goto fail;  | 
205  |  |  | 
206  | 0  |   pcap->name = _strdup(name);  | 
207  | 0  |   pcap->write = write;  | 
208  | 0  |   pcap->record_count = 0;  | 
209  | 0  |   pcap->fp = winpr_fopen(name, write ? "w+b" : "rb");  | 
210  |  | 
  | 
211  | 0  |   if (pcap->fp == NULL)  | 
212  | 0  |     goto fail;  | 
213  |  |  | 
214  | 0  |   if (write)  | 
215  | 0  |   { | 
216  | 0  |     pcap->header.magic_number = PCAP_MAGIC;  | 
217  | 0  |     pcap->header.version_major = 2;  | 
218  | 0  |     pcap->header.version_minor = 4;  | 
219  | 0  |     pcap->header.thiszone = 0;  | 
220  | 0  |     pcap->header.sigfigs = 0;  | 
221  | 0  |     pcap->header.snaplen = UINT32_MAX;  | 
222  | 0  |     pcap->header.network = 0;  | 
223  | 0  |     if (!pcap_write_header(pcap, &pcap->header))  | 
224  | 0  |       goto fail;  | 
225  | 0  |   }  | 
226  | 0  |   else  | 
227  | 0  |   { | 
228  | 0  |     _fseeki64(pcap->fp, 0, SEEK_END);  | 
229  | 0  |     pcap->file_size = _ftelli64(pcap->fp);  | 
230  | 0  |     _fseeki64(pcap->fp, 0, SEEK_SET);  | 
231  | 0  |     if (!pcap_read_header(pcap, &pcap->header))  | 
232  | 0  |       goto fail;  | 
233  | 0  |   }  | 
234  |  |  | 
235  | 0  |   return pcap;  | 
236  |  |  | 
237  | 0  | fail:  | 
238  | 0  |   pcap_close(pcap);  | 
239  | 0  |   return NULL;  | 
240  | 0  | }  | 
241  |  |  | 
242  |  | void pcap_flush(rdpPcap* pcap)  | 
243  | 0  | { | 
244  | 0  |   WINPR_ASSERT(pcap);  | 
245  |  |  | 
246  | 0  |   while (pcap->record != NULL)  | 
247  | 0  |   { | 
248  | 0  |     pcap_write_record(pcap, pcap->record);  | 
249  | 0  |     pcap->record = pcap->record->next;  | 
250  | 0  |   }  | 
251  |  | 
  | 
252  | 0  |   if (pcap->fp != NULL)  | 
253  | 0  |     (void)fflush(pcap->fp);  | 
254  | 0  | }  | 
255  |  |  | 
256  |  | void pcap_close(rdpPcap* pcap)  | 
257  | 0  | { | 
258  | 0  |   if (!pcap)  | 
259  | 0  |     return;  | 
260  |  |  | 
261  | 0  |   pcap_flush(pcap);  | 
262  |  | 
  | 
263  | 0  |   if (pcap->fp != NULL)  | 
264  | 0  |     (void)fclose(pcap->fp);  | 
265  |  | 
  | 
266  | 0  |   free(pcap->name);  | 
267  | 0  |   free(pcap);  | 
268  | 0  | }  |