diff options
Diffstat (limited to 'libmachdevdde/ds_routines.c')
-rw-r--r-- | libmachdevdde/ds_routines.c | 341 |
1 files changed, 341 insertions, 0 deletions
diff --git a/libmachdevdde/ds_routines.c b/libmachdevdde/ds_routines.c new file mode 100644 index 000000000..e9fbe9445 --- /dev/null +++ b/libmachdevdde/ds_routines.c @@ -0,0 +1,341 @@ +/* + * Mach Operating System + * Copyright (c) 1993,1991,1990,1989 Carnegie Mellon University + * All Rights Reserved. + * + * Permission to use, copy, modify and distribute this software and its + * documentation is hereby granted, provided that both the copyright + * notice and this permission notice appear in all copies of the + * software, derivative works or modified versions, and any portions + * thereof, and that both notices appear in supporting documentation. + * + * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS" + * CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR + * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE. + * + * Carnegie Mellon requests users of this software to return to + * + * Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU + * School of Computer Science + * Carnegie Mellon University + * Pittsburgh PA 15213-3890 + * + * any improvements or extensions that they make and grant Carnegie Mellon + * the rights to redistribute these changes. + */ +/* + * Author: David B. Golub, Carnegie Mellon University + * Date: 3/89 + */ + +/* + * Mach device server routines (i386at version). + * + * Copyright (c) 1996 The University of Utah and + * the Computer Systems Laboratory at the University of Utah (CSL). + * All rights reserved. + * + * Permission to use, copy, modify and distribute this software is hereby + * granted provided that (1) source code retains these copyright, permission, + * and disclaimer notices, and (2) redistributions including binaries + * reproduce the notices in supporting documentation, and (3) all advertising + * materials mentioning features or use of this software display the following + * acknowledgement: ``This product includes software developed by the + * Computer Systems Laboratory at the University of Utah.'' + * + * THE UNIVERSITY OF UTAH AND CSL ALLOW FREE USE OF THIS SOFTWARE IN ITS "AS + * IS" CONDITION. THE UNIVERSITY OF UTAH AND CSL DISCLAIM ANY LIABILITY OF + * ANY KIND FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE. + * + * CSL requests users of this software to return to csl-dist@cs.utah.edu any + * improvements that they make and grant CSL redistribution rights. + * + * Author: Shantanu Goel, University of Utah CSL + */ + +#include <stdio.h> +#include <string.h> +#include <error.h> + +#include <hurd.h> +#include <mach.h> + +#include <ddekit/thread.h> + +#include "vm_param.h" +#include "device_S.h" +#include "notify_S.h" +#include "io_req.h" +#include "dev_hdr.h" +#include "util.h" +#include "queue.h" +#include "mach_glue.h" + +struct port_bucket *device_bucket; +struct port_class *dev_class; + +#define NUM_EMULATION num_emul +#define MAX_NUM_EMULATION 32 + +/* List of emulations. */ +static struct device_emulation_ops *emulation_list[MAX_NUM_EMULATION]; +static int num_emul; + +boolean_t is_master_device (mach_port_t port); + +/* + * What follows is the interface for the native Mach devices. + */ + +/* Implementation of device interface */ +io_return_t +ds_device_open (mach_port_t open_port, mach_port_t reply_port, + mach_msg_type_name_t reply_port_type, dev_mode_t mode, + char *name, device_t *devp, mach_msg_type_name_t *devicePoly) +{ + int i; + io_return_t err = D_NO_SUCH_DEVICE; + + /* Open must be called on the master device port. */ + if (!is_master_device (open_port)) + return D_INVALID_OPERATION; + + /* There must be a reply port. */ + if (! MACH_PORT_VALID (reply_port)) + { + fprintf (stderr, "ds_* invalid reply port\n"); + return MIG_NO_REPLY; + } + + /* Call each emulation's open routine to find the device. */ + for (i = 0; i < NUM_EMULATION; i++) + { + err = (*emulation_list[i]->open) (reply_port, reply_port_type, + mode, name, devp, devicePoly); + if (err != D_NO_SUCH_DEVICE) + break; + } + + return err; +} + +io_return_t +ds_device_close (struct mach_device *device) +{ + io_return_t ret; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + ret = (device->dev.emul_ops->close + ? (*device->dev.emul_ops->close) (device->dev.emul_data) + : D_SUCCESS); + return ret; +} + +io_return_t +ds_device_write (struct mach_device *device, mach_port_t reply_port, + mach_msg_type_name_t reply_port_type, dev_mode_t mode, + recnum_t recnum, io_buf_ptr_t data, unsigned int count, + int *bytes_written) +{ + io_return_t ret; + + if (data == 0) + return D_INVALID_SIZE; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->write) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->write) (device->dev.emul_data, reply_port, + reply_port_type, mode, recnum, + data, count, bytes_written); + return ret; +} + +io_return_t +ds_device_write_inband (struct mach_device *device, mach_port_t reply_port, + mach_msg_type_name_t reply_port_type, + dev_mode_t mode, recnum_t recnum, + io_buf_ptr_inband_t data, unsigned count, + int *bytes_written) +{ + io_return_t ret; + + if (data == 0) + return D_INVALID_SIZE; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->write_inband) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->write_inband) (device->dev.emul_data, + reply_port, reply_port_type, + mode, recnum, + data, count, bytes_written); + return ret; +} + +io_return_t +ds_device_read (struct mach_device *device, mach_port_t reply_port, + mach_msg_type_name_t reply_port_type, dev_mode_t mode, + recnum_t recnum, int count, io_buf_ptr_t *data, + unsigned *bytes_read) +{ + io_return_t ret; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->read) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->read) (device->dev.emul_data, reply_port, + reply_port_type, mode, recnum, + count, data, bytes_read); + return ret; +} + +io_return_t +ds_device_read_inband (struct mach_device *device, mach_port_t reply_port, + mach_msg_type_name_t reply_port_type, dev_mode_t mode, + recnum_t recnum, int count, char *data, + unsigned *bytes_read) +{ + io_return_t ret; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->read_inband) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->read_inband) (device->dev.emul_data, + reply_port, + reply_port_type, mode, recnum, + count, data, bytes_read); + return ret; +} + +io_return_t +ds_device_set_status (struct mach_device *device, dev_flavor_t flavor, + dev_status_t status, mach_msg_type_number_t status_count) +{ + io_return_t ret; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->set_status) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->set_status) (device->dev.emul_data, flavor, + status, status_count); + return ret; +} + +io_return_t +ds_device_get_status (struct mach_device *device, dev_flavor_t flavor, + dev_status_t status, + mach_msg_type_number_t *status_count) +{ + io_return_t ret; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->get_status) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->get_status) (device->dev.emul_data, flavor, + status, status_count); + return ret; +} + +io_return_t +ds_device_set_filter (struct mach_device *device, mach_port_t receive_port, + int priority, filter_t *filter, unsigned filter_count) +{ + io_return_t ret; + + if (device == NULL) + return D_NO_SUCH_DEVICE; + + if (! device->dev.emul_ops->set_filter) + return D_INVALID_OPERATION; + + ret = (*device->dev.emul_ops->set_filter) (device->dev.emul_data, + receive_port, + priority, filter, filter_count); + return ret; +} + +io_return_t +ds_device_map (struct mach_device *device, vm_prot_t prot, vm_offset_t offset, + vm_size_t size, mach_port_t *pager, boolean_t unmap) +{ + /* Refuse if device is dead or not completely open. */ + if (device == NULL) + return D_NO_SUCH_DEVICE; + + return D_INVALID_OPERATION; +} + +error_t +create_device_port (size_t size, void *result) +{ + return ports_create_port (dev_class, device_bucket, + size, result); +} + +void mach_device_init() +{ + int i; + + device_bucket = ports_create_bucket (); + dev_class = ports_create_class (0, 0); + + for (i = 0; i < NUM_EMULATION; i++) { + if (emulation_list[i]->init) + emulation_list[i]->init(); + } +} + +static int +demuxer (mach_msg_header_t *inp, mach_msg_header_t *outp) +{ + mig_routine_t routine; + if ((routine = device_server_routine (inp)) || + (routine = notify_server_routine (inp))) + { + (*routine) (inp, outp); + return TRUE; + } + else + return FALSE; +} + +void reg_dev_emul (struct device_emulation_ops *ops) +{ + emulation_list[num_emul++] = ops; +} + +void * ds_server(void *arg) +{ + /* This thread calls Linux functions, + * so I need to make it known to the Linux environment. */ + l4dde26_process_from_ddekit (ddekit_thread_myself ()); + + /* Launch. */ + do + { + ports_manage_port_operations_one_thread (device_bucket, demuxer, 0); + } while (1); + + return NULL; +} |