Blame channels/urbdrc/client/searchman.c

Packit 1fb8d4
/**
Packit 1fb8d4
 * FreeRDP: A Remote Desktop Protocol Implementation
Packit 1fb8d4
 * RemoteFX USB Redirection
Packit 1fb8d4
 *
Packit 1fb8d4
 * Copyright 2012 Atrust corp.
Packit 1fb8d4
 * Copyright 2012 Alfred Liu <alfred.liu@atruscorp.com>
Packit 1fb8d4
 *
Packit 1fb8d4
 * Licensed under the Apache License, Version 2.0 (the "License");
Packit 1fb8d4
 * you may not use this file except in compliance with the License.
Packit 1fb8d4
 * You may obtain a copy of the License at
Packit 1fb8d4
 *
Packit 1fb8d4
 *	 http://www.apache.org/licenses/LICENSE-2.0
Packit 1fb8d4
 *
Packit 1fb8d4
 * Unless required by applicable law or agreed to in writing, software
Packit 1fb8d4
 * distributed under the License is distributed on an "AS IS" BASIS,
Packit 1fb8d4
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Packit 1fb8d4
 * See the License for the specific language governing permissions and
Packit 1fb8d4
 * limitations under the License.
Packit 1fb8d4
 */
Packit 1fb8d4
Packit 1fb8d4
Packit 1fb8d4
#include <stdio.h>
Packit 1fb8d4
#include <stdlib.h>
Packit 1fb8d4
#include <string.h>
Packit 1fb8d4
#include <unistd.h>
Packit 1fb8d4
Packit 1fb8d4
#include <winpr/crt.h>
Packit 1fb8d4
#include <winpr/synch.h>
Packit 1fb8d4
Packit 1fb8d4
#include "searchman.h"
Packit 1fb8d4
Packit 1fb8d4
static void searchman_rewind(USB_SEARCHMAN* searchman)
Packit 1fb8d4
{
Packit 1fb8d4
	searchman->idev = searchman->head;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static int searchman_has_next(USB_SEARCHMAN* searchman)
Packit 1fb8d4
{
Packit 1fb8d4
	if (searchman->idev == NULL)
Packit 1fb8d4
		return 0;
Packit 1fb8d4
	else
Packit 1fb8d4
		return 1;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static USB_SEARCHDEV* searchman_get_next(USB_SEARCHMAN* searchman)
Packit 1fb8d4
{
Packit 1fb8d4
	USB_SEARCHDEV* search;
Packit 1fb8d4
Packit 1fb8d4
	search = searchman->idev;
Packit 1fb8d4
	searchman->idev = (USB_SEARCHDEV*) searchman->idev->next;
Packit 1fb8d4
Packit 1fb8d4
	return search;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static BOOL searchman_list_add(USB_SEARCHMAN* searchman, UINT16 idVendor, UINT16 idProduct)
Packit 1fb8d4
{
Packit 1fb8d4
	USB_SEARCHDEV*	search;
Packit 1fb8d4
Packit 1fb8d4
	search = (USB_SEARCHDEV*) calloc(1, sizeof(USB_SEARCHDEV));
Packit 1fb8d4
	if (!search)
Packit 1fb8d4
		return FALSE;
Packit 1fb8d4
Packit 1fb8d4
	search->idVendor = idVendor;
Packit 1fb8d4
	search->idProduct = idProduct;
Packit 1fb8d4
Packit 1fb8d4
	if (searchman->head == NULL)
Packit 1fb8d4
	{
Packit 1fb8d4
		/* linked list is empty */
Packit 1fb8d4
		searchman->head = search;
Packit 1fb8d4
		searchman->tail = search;
Packit 1fb8d4
	}
Packit 1fb8d4
	else
Packit 1fb8d4
	{
Packit 1fb8d4
		/* append device to the end of the linked list */
Packit 1fb8d4
		searchman->tail->next = (void*)search;
Packit 1fb8d4
		search->prev = (void*)searchman->tail;
Packit 1fb8d4
		searchman->tail = search;
Packit 1fb8d4
	}
Packit 1fb8d4
	searchman->usb_numbers += 1;
Packit 1fb8d4
Packit 1fb8d4
	return TRUE;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static int searchman_list_remove(USB_SEARCHMAN* searchman, UINT16 idVendor, UINT16 idProduct)
Packit 1fb8d4
{
Packit 1fb8d4
	USB_SEARCHDEV* search;
Packit 1fb8d4
	USB_SEARCHDEV* point;
Packit 1fb8d4
Packit 1fb8d4
	searchman_rewind(searchman);
Packit 1fb8d4
Packit 1fb8d4
	while (searchman_has_next(searchman) != 0)
Packit 1fb8d4
	{
Packit 1fb8d4
		point = searchman_get_next(searchman);
Packit 1fb8d4
Packit 1fb8d4
		if (point->idVendor == idVendor &&
Packit 1fb8d4
		    point->idProduct == idProduct)
Packit 1fb8d4
		{
Packit 1fb8d4
			/* set previous device to point to next device */
Packit 1fb8d4
Packit 1fb8d4
			search = point;
Packit 1fb8d4
			if (search->prev != NULL)
Packit 1fb8d4
			{
Packit 1fb8d4
				/* unregistered device is not the head */
Packit 1fb8d4
				point = (USB_SEARCHDEV*)search->prev;
Packit 1fb8d4
				point->next = search->next;
Packit 1fb8d4
			}
Packit 1fb8d4
			else
Packit 1fb8d4
			{
Packit 1fb8d4
				/* unregistered device is the head, update head */
Packit 1fb8d4
				searchman->head = (USB_SEARCHDEV*)search->next;
Packit 1fb8d4
			}
Packit 1fb8d4
Packit 1fb8d4
			/* set next device to point to previous device */
Packit 1fb8d4
Packit 1fb8d4
			if (search->next != NULL)
Packit 1fb8d4
			{
Packit 1fb8d4
				/* unregistered device is not the tail */
Packit 1fb8d4
				point = (USB_SEARCHDEV*)search->next;
Packit 1fb8d4
				point->prev = search->prev;
Packit 1fb8d4
			}
Packit 1fb8d4
			else
Packit 1fb8d4
			{
Packit 1fb8d4
				/* unregistered device is the tail, update tail */
Packit 1fb8d4
				searchman->tail = (USB_SEARCHDEV*)search->prev;
Packit 1fb8d4
			}
Packit 1fb8d4
			searchman->usb_numbers--;
Packit 1fb8d4
Packit 1fb8d4
			free(search);
Packit 1fb8d4
Packit 1fb8d4
			return 1; /* unregistration successful */
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	/* if we reach this point, the device wasn't found */
Packit 1fb8d4
	return 0;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static BOOL searchman_start(USB_SEARCHMAN* self, void* (*func)(void*))
Packit 1fb8d4
{
Packit 1fb8d4
	pthread_t thread;
Packit 1fb8d4
Packit 1fb8d4
	/* create search thread */
Packit 1fb8d4
	if (pthread_create(&thread, 0, func, self) != 0)
Packit 1fb8d4
		return FALSE;
Packit 1fb8d4
Packit 1fb8d4
	if (pthread_detach(thread) != 0)
Packit 1fb8d4
		return FALSE;
Packit 1fb8d4
Packit 1fb8d4
	self->started = 1;
Packit 1fb8d4
	return TRUE;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/* close thread */
Packit 1fb8d4
static void searchman_close(USB_SEARCHMAN* self)
Packit 1fb8d4
{
Packit 1fb8d4
	SetEvent(self->term_event);
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static void searchman_list_show(USB_SEARCHMAN* self)
Packit 1fb8d4
{
Packit 1fb8d4
	int num = 0;
Packit 1fb8d4
	USB_SEARCHDEV* usb;
Packit 1fb8d4
	WLog_DBG(TAG,  "=========== Usb Search List =========");
Packit 1fb8d4
	self->rewind(self);
Packit 1fb8d4
	while (self->has_next(self))
Packit 1fb8d4
	{
Packit 1fb8d4
		usb = self->get_next(self);
Packit 1fb8d4
		WLog_DBG(TAG,  "  USB %d: ", num++);
Packit 1fb8d4
		WLog_DBG(TAG,  "	idVendor: 0x%04"PRIX16"", usb->idVendor);
Packit 1fb8d4
		WLog_DBG(TAG,  "	idProduct: 0x%04"PRIX16"", usb->idProduct);
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	WLog_DBG(TAG,  "================= END ===============");
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
void searchman_free(USB_SEARCHMAN* self)
Packit 1fb8d4
{
Packit 1fb8d4
	USB_SEARCHDEV * dev;
Packit 1fb8d4
Packit 1fb8d4
	while (self->head != NULL)
Packit 1fb8d4
	{
Packit 1fb8d4
		dev = (USB_SEARCHDEV *)self->head;
Packit 1fb8d4
		self->remove (self, dev->idVendor, dev->idProduct);
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	/* free searchman */
Packit 1fb8d4
	sem_destroy(&self->sem_term);
Packit 1fb8d4
	CloseHandle(self->term_event);
Packit 1fb8d4
	free(self);
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
USB_SEARCHMAN* searchman_new(void * urbdrc, UINT32 UsbDevice)
Packit 1fb8d4
{
Packit 1fb8d4
	int ret;
Packit 1fb8d4
	USB_SEARCHMAN* searchman;
Packit 1fb8d4
Packit 1fb8d4
	searchman = (USB_SEARCHMAN*) calloc(1, sizeof(USB_SEARCHMAN));
Packit 1fb8d4
	if (!searchman)
Packit 1fb8d4
		return NULL;
Packit 1fb8d4
Packit 1fb8d4
	searchman->urbdrc = urbdrc;
Packit 1fb8d4
	searchman->UsbDevice = UsbDevice;
Packit 1fb8d4
Packit 1fb8d4
	ret = pthread_mutex_init(&searchman->mutex, NULL);
Packit 1fb8d4
	if (ret != 0)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "searchman mutex initialization: searchman->mutex failed");
Packit 1fb8d4
		goto out_error_mutex;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	/* load service */
Packit 1fb8d4
	searchman->add = searchman_list_add;
Packit 1fb8d4
	searchman->remove = searchman_list_remove;
Packit 1fb8d4
	searchman->rewind = searchman_rewind;
Packit 1fb8d4
	searchman->get_next = searchman_get_next;
Packit 1fb8d4
	searchman->has_next = searchman_has_next;
Packit 1fb8d4
	searchman->show = searchman_list_show;
Packit 1fb8d4
	searchman->start = searchman_start;
Packit 1fb8d4
	searchman->close = searchman_close;
Packit 1fb8d4
	searchman->free = searchman_free;
Packit 1fb8d4
Packit 1fb8d4
	searchman->started = 0;
Packit 1fb8d4
	searchman->term_event = CreateEvent(NULL, TRUE, FALSE, NULL);
Packit 1fb8d4
	if (!searchman->term_event)
Packit 1fb8d4
		goto out_error_event;
Packit 1fb8d4
Packit 1fb8d4
	if (sem_init(&searchman->sem_term, 0, 0) < 0)
Packit 1fb8d4
		goto out_error_sem;
Packit 1fb8d4
Packit 1fb8d4
	return searchman;
Packit 1fb8d4
Packit 1fb8d4
out_error_sem:
Packit 1fb8d4
	CloseHandle(searchman->term_event);
Packit 1fb8d4
out_error_event:
Packit 1fb8d4
	pthread_mutex_destroy(&searchman->mutex);
Packit 1fb8d4
out_error_mutex:
Packit 1fb8d4
	free(searchman);
Packit 1fb8d4
	return NULL;
Packit 1fb8d4
}