Blame libfreerdp/utils/pcap.c

Packit Service fa4841
/**
Packit Service fa4841
 * FreeRDP: A Remote Desktop Protocol Implementation
Packit Service fa4841
 * pcap File Format Utils
Packit Service fa4841
 *
Packit Service fa4841
 * Copyright 2011 Marc-Andre Moreau <marcandre.moreau@gmail.com>
Packit Service fa4841
 *
Packit Service fa4841
 * Licensed under the Apache License, Version 2.0 (the "License");
Packit Service fa4841
 * you may not use this file except in compliance with the License.
Packit Service fa4841
 * You may obtain a copy of the License at
Packit Service fa4841
 *
Packit Service fa4841
 *     http://www.apache.org/licenses/LICENSE-2.0
Packit Service fa4841
 *
Packit Service fa4841
 * Unless required by applicable law or agreed to in writing, software
Packit Service fa4841
 * distributed under the License is distributed on an "AS IS" BASIS,
Packit Service fa4841
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Packit Service fa4841
 * See the License for the specific language governing permissions and
Packit Service fa4841
 * limitations under the License.
Packit Service fa4841
 */
Packit Service fa4841
Packit Service fa4841
#ifdef HAVE_CONFIG_H
Packit Service fa4841
#include "config.h"
Packit Service fa4841
#endif
Packit Service fa4841
Packit Service fa4841
#include <stdio.h>
Packit Service fa4841
#include <stdlib.h>
Packit Service fa4841
#include <string.h>
Packit Service fa4841
Packit Service fa4841
#include <winpr/wtypes.h>
Packit Service fa4841
#include <winpr/crt.h>
Packit Service fa4841
#include <freerdp/log.h>
Packit Service fa4841
Packit Service fa4841
#define TAG FREERDP_TAG("utils")
Packit Service fa4841
Packit Service fa4841
#ifndef _WIN32
Packit Service fa4841
#include <sys/time.h>
Packit Service fa4841
#else
Packit Service fa4841
#include <time.h>
Packit Service fa4841
#include <sys/timeb.h>
Packit Service fa4841
#include <winpr/windows.h>
Packit Service fa4841
Packit Service fa4841
int gettimeofday(struct timeval* tp, void* tz)
Packit Service fa4841
{
Packit Service fa4841
	struct _timeb timebuffer;
Packit Service fa4841
	_ftime(&timebuffer);
Packit Service fa4841
	tp->tv_sec = (long)timebuffer.time;
Packit Service fa4841
	tp->tv_usec = timebuffer.millitm * 1000;
Packit Service fa4841
	return 0;
Packit Service fa4841
}
Packit Service fa4841
#endif
Packit Service fa4841
Packit Service fa4841
#include <freerdp/types.h>
Packit Service fa4841
#include <freerdp/utils/pcap.h>
Packit Service fa4841
Packit Service fa4841
#define PCAP_MAGIC 0xA1B2C3D4
Packit Service fa4841
Packit Service fa4841
static BOOL pcap_read_header(rdpPcap* pcap, pcap_header* header)
Packit Service fa4841
{
Packit Service fa4841
	return fread((void*)header, sizeof(pcap_header), 1, pcap->fp) == 1;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
static BOOL pcap_write_header(rdpPcap* pcap, pcap_header* header)
Packit Service fa4841
{
Packit Service fa4841
	return fwrite((void*)header, sizeof(pcap_header), 1, pcap->fp) == 1;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
static BOOL pcap_read_record_header(rdpPcap* pcap, pcap_record_header* record)
Packit Service fa4841
{
Packit Service fa4841
	return fread((void*)record, sizeof(pcap_record_header), 1, pcap->fp) == 1;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
static BOOL pcap_write_record_header(rdpPcap* pcap, pcap_record_header* record)
Packit Service fa4841
{
Packit Service fa4841
	return fwrite((void*)record, sizeof(pcap_record_header), 1, pcap->fp) == 1;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
static BOOL pcap_read_record(rdpPcap* pcap, pcap_record* record)
Packit Service fa4841
{
Packit Service fa4841
	if (!pcap_read_record_header(pcap, &record->header))
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	record->length = record->header.incl_len;
Packit Service fa4841
	record->data = malloc(record->length);
Packit Service fa4841
	if (!record->data)
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	if (fread(record->data, record->length, 1, pcap->fp) != 1)
Packit Service fa4841
	{
Packit Service fa4841
		free(record->data);
Packit Service fa4841
		record->data = NULL;
Packit Service fa4841
		return FALSE;
Packit Service fa4841
	}
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
static BOOL pcap_write_record(rdpPcap* pcap, pcap_record* record)
Packit Service fa4841
{
Packit Service fa4841
	return pcap_write_record_header(pcap, &record->header) &&
Packit Service fa4841
	       (fwrite(record->data, record->length, 1, pcap->fp) == 1);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
BOOL pcap_add_record(rdpPcap* pcap, void* data, UINT32 length)
Packit Service fa4841
{
Packit Service fa4841
	pcap_record* record;
Packit Service fa4841
	struct timeval tp;
Packit Service fa4841
Packit Service fa4841
	if (pcap->tail == NULL)
Packit Service fa4841
	{
Packit Service fa4841
		pcap->tail = (pcap_record*)calloc(1, sizeof(pcap_record));
Packit Service fa4841
		if (!pcap->tail)
Packit Service fa4841
			return FALSE;
Packit Service fa4841
Packit Service fa4841
		pcap->head = pcap->tail;
Packit Service fa4841
		pcap->record = pcap->head;
Packit Service fa4841
		record = pcap->tail;
Packit Service fa4841
	}
Packit Service fa4841
	else
Packit Service fa4841
	{
Packit Service fa4841
		record = (pcap_record*)calloc(1, sizeof(pcap_record));
Packit Service fa4841
		if (!record)
Packit Service fa4841
			return FALSE;
Packit Service fa4841
Packit Service fa4841
		pcap->tail->next = record;
Packit Service fa4841
		pcap->tail = record;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	if (pcap->record == NULL)
Packit Service fa4841
		pcap->record = record;
Packit Service fa4841
Packit Service fa4841
	record->data = data;
Packit Service fa4841
	record->length = length;
Packit Service fa4841
	record->header.incl_len = length;
Packit Service fa4841
	record->header.orig_len = length;
Packit Service fa4841
Packit Service fa4841
	gettimeofday(&tp, 0);
Packit Service fa4841
	record->header.ts_sec = tp.tv_sec;
Packit Service fa4841
	record->header.ts_usec = tp.tv_usec;
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
BOOL pcap_has_next_record(rdpPcap* pcap)
Packit Service fa4841
{
Packit Service fa4841
	if (pcap->file_size - (_ftelli64(pcap->fp)) <= 16)
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
BOOL pcap_get_next_record_header(rdpPcap* pcap, pcap_record* record)
Packit Service fa4841
{
Packit Service fa4841
	if (pcap_has_next_record(pcap) != TRUE)
Packit Service fa4841
		return FALSE;
Packit Service fa4841
Packit Service fa4841
	pcap_read_record_header(pcap, &record->header);
Packit Service fa4841
	record->length = record->header.incl_len;
Packit Service fa4841
Packit Service fa4841
	return TRUE;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
BOOL pcap_get_next_record_content(rdpPcap* pcap, pcap_record* record)
Packit Service fa4841
{
Packit Service fa4841
	return fread(record->data, record->length, 1, pcap->fp) == 1;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
BOOL pcap_get_next_record(rdpPcap* pcap, pcap_record* record)
Packit Service fa4841
{
Packit Service fa4841
	return pcap_has_next_record(pcap) && pcap_read_record(pcap, record);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
rdpPcap* pcap_open(char* name, BOOL write)
Packit Service fa4841
{
Packit Service fa4841
	rdpPcap* pcap;
Packit Service fa4841
Packit Service fa4841
	pcap = (rdpPcap*)calloc(1, sizeof(rdpPcap));
Packit Service fa4841
	if (!pcap)
Packit Service fa4841
		goto fail;
Packit Service fa4841
Packit Service fa4841
	pcap->name = name;
Packit Service fa4841
	pcap->write = write;
Packit Service fa4841
	pcap->record_count = 0;
Packit Service fa4841
	pcap->fp = fopen(name, write ? "w+b" : "rb");
Packit Service fa4841
Packit Service fa4841
	if (pcap->fp == NULL)
Packit Service fa4841
		goto fail;
Packit Service fa4841
Packit Service fa4841
	if (write)
Packit Service fa4841
	{
Packit Service fa4841
		pcap->header.magic_number = 0xA1B2C3D4;
Packit Service fa4841
		pcap->header.version_major = 2;
Packit Service fa4841
		pcap->header.version_minor = 4;
Packit Service fa4841
		pcap->header.thiszone = 0;
Packit Service fa4841
		pcap->header.sigfigs = 0;
Packit Service fa4841
		pcap->header.snaplen = 0xFFFFFFFF;
Packit Service fa4841
		pcap->header.network = 0;
Packit Service fa4841
		if (!pcap_write_header(pcap, &pcap->header))
Packit Service fa4841
			goto fail;
Packit Service fa4841
	}
Packit Service fa4841
	else
Packit Service fa4841
	{
Packit Service fa4841
		_fseeki64(pcap->fp, 0, SEEK_END);
Packit Service fa4841
		pcap->file_size = _ftelli64(pcap->fp);
Packit Service fa4841
		_fseeki64(pcap->fp, 0, SEEK_SET);
Packit Service fa4841
		if (!pcap_read_header(pcap, &pcap->header))
Packit Service fa4841
			goto fail;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	return pcap;
Packit Service fa4841
Packit Service fa4841
fail:
Packit Service fa4841
	pcap_close(pcap);
Packit Service fa4841
	return NULL;
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
void pcap_flush(rdpPcap* pcap)
Packit Service fa4841
{
Packit Service fa4841
	while (pcap->record != NULL)
Packit Service fa4841
	{
Packit Service fa4841
		pcap_write_record(pcap, pcap->record);
Packit Service fa4841
		pcap->record = pcap->record->next;
Packit Service fa4841
	}
Packit Service fa4841
Packit Service fa4841
	if (pcap->fp != NULL)
Packit Service fa4841
		fflush(pcap->fp);
Packit Service fa4841
}
Packit Service fa4841
Packit Service fa4841
void pcap_close(rdpPcap* pcap)
Packit Service fa4841
{
Packit Service fa4841
	if (!pcap)
Packit Service fa4841
		return;
Packit Service fa4841
Packit Service fa4841
	pcap_flush(pcap);
Packit Service fa4841
Packit Service fa4841
	if (pcap->fp != NULL)
Packit Service fa4841
		fclose(pcap->fp);
Packit Service fa4841
Packit Service fa4841
	free(pcap);
Packit Service fa4841
}