/** * FreeRDP: A Remote Desktop Protocol client. * Redirected Parallel Port Device Service * * Copyright 2010 O.S. Systems Software Ltda. * Copyright 2010 Eduardo Fiss Beloni * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #include #include #include #include #include #include #include #include #include #ifdef __LINUX__ #include #include #endif #include #include #include #include #include #include #include #include "rdpdr_constants.h" #include "rdpdr_types.h" struct _PARALLEL_DEVICE { DEVICE device; int file; char* path; uint32 id; LIST* irp_list; freerdp_thread* thread; }; typedef struct _PARALLEL_DEVICE PARALLEL_DEVICE; static void parallel_process_irp_create(PARALLEL_DEVICE* parallel, IRP* irp) { uint32 PathLength; char* path; UNICONV* uniconv; stream_seek(irp->input, 28); /* DesiredAccess(4) AllocationSize(8), FileAttributes(4) */ /* SharedAccess(4) CreateDisposition(4), CreateOptions(4) */ stream_read_uint32(irp->input, PathLength); uniconv = freerdp_uniconv_new(); path = freerdp_uniconv_in(uniconv, stream_get_tail(irp->input), PathLength); freerdp_uniconv_free(uniconv); parallel->id = irp->devman->id_sequence++; parallel->file = open(parallel->path, O_RDWR); if (parallel->file < 0) { irp->IoStatus = STATUS_ACCESS_DENIED; parallel->id = 0; DEBUG_WARN("failed to create %s: %s", parallel->path, strerror(errno)); } else { /* all read and write operations should be non-blocking */ if (fcntl(parallel->file, F_SETFL, O_NONBLOCK) == -1) DEBUG_WARN("%s fcntl %s", path, strerror(errno)); DEBUG_SVC("%s(%d) created", parallel->path, parallel->file); } stream_write_uint32(irp->output, parallel->id); stream_write_uint8(irp->output, 0); xfree(path); irp->Complete(irp); } static void parallel_process_irp_close(PARALLEL_DEVICE* parallel, IRP* irp) { if (close(parallel->file) < 0) DEBUG_SVC("failed to close %s(%d)", parallel->path, parallel->id); else DEBUG_SVC("%s(%d) closed", parallel->path, parallel->id); stream_write_zero(irp->output, 5); /* Padding(5) */ irp->Complete(irp); } static void parallel_process_irp_read(PARALLEL_DEVICE* parallel, IRP* irp) { uint32 Length; uint64 Offset; ssize_t status; uint8* buffer = NULL; stream_read_uint32(irp->input, Length); stream_read_uint64(irp->input, Offset); buffer = (uint8*) xmalloc(Length); status = read(parallel->file, irp->output->p, Length); if (status < 0) { irp->IoStatus = STATUS_UNSUCCESSFUL; xfree(buffer); buffer = NULL; Length = 0; DEBUG_WARN("read %s(%d) failed", parallel->path, parallel->id); } else { DEBUG_SVC("read %llu-%llu from %d", Offset, Offset + Length, parallel->id); } stream_write_uint32(irp->output, Length); if (Length > 0) { stream_check_size(irp->output, Length); stream_write(irp->output, buffer, Length); } xfree(buffer); irp->Complete(irp); } static void parallel_process_irp_write(PARALLEL_DEVICE* parallel, IRP* irp) { uint32 Length; uint64 Offset; ssize_t status; uint32 len; stream_read_uint32(irp->input, Length); stream_read_uint64(irp->input, Offset); stream_seek(irp->input, 20); /* Padding */ DEBUG_SVC("Length %u Offset %llu", Length, Offset); len = Length; while (len > 0) { status = write(parallel->file, stream_get_tail(irp->input), len); if (status < 0) { irp->IoStatus = STATUS_UNSUCCESSFUL; Length = 0; DEBUG_WARN("write %s(%d) failed.", parallel->path, parallel->id); break; } stream_seek(irp->input, status); len -= status; } stream_write_uint32(irp->output, Length); stream_write_uint8(irp->output, 0); /* Padding */ irp->Complete(irp); } static void parallel_process_irp_device_control(PARALLEL_DEVICE* parallel, IRP* irp) { DEBUG_SVC("in"); stream_write_uint32(irp->output, 0); /* OutputBufferLength */ irp->Complete(irp); } static void parallel_process_irp(PARALLEL_DEVICE* parallel, IRP* irp) { DEBUG_SVC("MajorFunction %u", irp->MajorFunction); switch (irp->MajorFunction) { case IRP_MJ_CREATE: parallel_process_irp_create(parallel, irp); break; case IRP_MJ_CLOSE: parallel_process_irp_close(parallel, irp); break; case IRP_MJ_READ: parallel_process_irp_read(parallel, irp); break; case IRP_MJ_WRITE: parallel_process_irp_write(parallel, irp); break; case IRP_MJ_DEVICE_CONTROL: parallel_process_irp_device_control(parallel, irp); break; default: DEBUG_WARN("MajorFunction 0x%X not supported", irp->MajorFunction); irp->IoStatus = STATUS_NOT_SUPPORTED; irp->Complete(irp); break; } } static void parallel_process_irp_list(PARALLEL_DEVICE* parallel) { IRP* irp; while (1) { if (freerdp_thread_is_stopped(parallel->thread)) break; freerdp_thread_lock(parallel->thread); irp = (IRP*) list_dequeue(parallel->irp_list); freerdp_thread_unlock(parallel->thread); if (irp == NULL) break; parallel_process_irp(parallel, irp); } } static void* parallel_thread_func(void* arg) { PARALLEL_DEVICE* parallel = (PARALLEL_DEVICE*) arg; while (1) { freerdp_thread_wait(parallel->thread); if (freerdp_thread_is_stopped(parallel->thread)) break; freerdp_thread_reset(parallel->thread); parallel_process_irp_list(parallel); } freerdp_thread_quit(parallel->thread); return NULL; } static void parallel_irp_request(DEVICE* device, IRP* irp) { PARALLEL_DEVICE* parallel = (PARALLEL_DEVICE*) device; freerdp_thread_lock(parallel->thread); list_enqueue(parallel->irp_list, irp); freerdp_thread_unlock(parallel->thread); freerdp_thread_signal(parallel->thread); } static void parallel_free(DEVICE* device) { IRP* irp; PARALLEL_DEVICE* parallel = (PARALLEL_DEVICE*) device; DEBUG_SVC("freeing device"); freerdp_thread_stop(parallel->thread); freerdp_thread_free(parallel->thread); while ((irp = (IRP*) list_dequeue(parallel->irp_list)) != NULL) irp->Discard(irp); list_free(parallel->irp_list); xfree(parallel); } int DeviceServiceEntry(PDEVICE_SERVICE_ENTRY_POINTS pEntryPoints) { char* name; char* path; int i, length; PARALLEL_DEVICE* parallel; name = (char*) pEntryPoints->plugin_data->data[1]; path = (char*) pEntryPoints->plugin_data->data[2]; if (name[0] && path[0]) { parallel = xnew(PARALLEL_DEVICE); parallel->device.type = RDPDR_DTYP_PARALLEL; parallel->device.name = name; parallel->device.IRPRequest = parallel_irp_request; parallel->device.Free = parallel_free; length = strlen(name); parallel->device.data = stream_new(length + 1); for (i = 0; i <= length; i++) stream_write_uint8(parallel->device.data, name[i] < 0 ? '_' : name[i]); parallel->path = path; parallel->irp_list = list_new(); parallel->thread = freerdp_thread_new(); pEntryPoints->RegisterDevice(pEntryPoints->devman, (DEVICE*) parallel); freerdp_thread_start(parallel->thread, parallel_thread_func, parallel); } return 0; }