1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
|
/*
* 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 <mach/boolean.h>
#include <mach/kern_return.h>
#include <mach/mig_errors.h>
#include <mach/port.h>
#include <mach/notify.h>
#include <device/device_types.h>
#include <device/device_port.h>
#include "device_interface.h"
#include <i386at/dev_hdr.h>
#include <i386at/device_emul.h>
extern struct device_emulation_ops mach_device_emulation_ops;
#ifdef LINUX_DEV
extern struct device_emulation_ops linux_block_emulation_ops;
extern struct device_emulation_ops linux_net_emulation_ops;
#endif
/* List of emulations. */
static struct device_emulation_ops *emulation_list[] =
{
#ifdef LINUX_DEV
&linux_block_emulation_ops,
&linux_net_emulation_ops,
#endif
&mach_device_emulation_ops,
};
#define NUM_EMULATION (sizeof (emulation_list) / sizeof (emulation_list[0]))
io_return_t
ds_device_open (ipc_port_t open_port, ipc_port_t reply_port,
mach_msg_type_name_t reply_port_type, dev_mode_t mode,
char *name, device_t *devp)
{
int i;
device_t dev;
io_return_t err;
/* Open must be called on the master device port. */
if (open_port != master_device_port)
return D_INVALID_OPERATION;
/* There must be a reply port. */
if (! IP_VALID (reply_port))
{
printf ("ds_* invalid reply port\n");
Debugger ("ds_* reply_port");
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);
if (err != D_NO_SUCH_DEVICE)
break;
}
return err;
}
io_return_t
ds_device_close (device_t dev)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
return (dev->emul_ops->close
? (*dev->emul_ops->close) (dev->emul_data)
: D_SUCCESS);
}
io_return_t
ds_device_write (device_t dev, ipc_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)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! data)
return D_INVALID_SIZE;
if (! dev->emul_ops->write)
return D_INVALID_OPERATION;
return (*dev->emul_ops->write) (dev->emul_data, reply_port,
reply_port_type, mode, recnum,
data, count, bytes_written);
}
io_return_t
ds_device_write_inband (device_t dev, ipc_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)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! data)
return D_INVALID_SIZE;
if (! dev->emul_ops->write_inband)
return D_INVALID_OPERATION;
return (*dev->emul_ops->write_inband) (dev->emul_data, reply_port,
reply_port_type, mode, recnum,
data, count, bytes_written);
}
io_return_t
ds_device_read (device_t dev, ipc_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)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->read)
return D_INVALID_OPERATION;
return (*dev->emul_ops->read) (dev->emul_data, reply_port,
reply_port_type, mode, recnum,
count, data, bytes_read);
}
io_return_t
ds_device_read_inband (device_t dev, ipc_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)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->read_inband)
return D_INVALID_OPERATION;
return (*dev->emul_ops->read_inband) (dev->emul_data, reply_port,
reply_port_type, mode, recnum,
count, data, bytes_read);
}
io_return_t
ds_device_set_status (device_t dev, dev_flavor_t flavor,
dev_status_t status, mach_msg_type_number_t status_count)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->set_status)
return D_INVALID_OPERATION;
return (*dev->emul_ops->set_status) (dev->emul_data, flavor, status,
status_count);
}
io_return_t
ds_device_get_status (device_t dev, dev_flavor_t flavor, dev_status_t status,
mach_msg_type_number_t *status_count)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->get_status)
return D_INVALID_OPERATION;
return (*dev->emul_ops->get_status) (dev->emul_data, flavor, status,
status_count);
}
io_return_t
ds_device_set_filter (device_t dev, ipc_port_t receive_port, int priority,
filter_t *filter, unsigned filter_count)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->set_filter)
return D_INVALID_OPERATION;
return (*dev->emul_ops->set_filter) (dev->emul_data, receive_port,
priority, filter, filter_count);
}
io_return_t
ds_device_map (device_t dev, vm_prot_t prot, vm_offset_t offset,
vm_size_t size, ipc_port_t *pager, boolean_t unmap)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->map)
return D_INVALID_OPERATION;
return (*dev->emul_ops->map) (dev->emul_data, prot,
offset, size, pager, unmap);
}
boolean_t
ds_notify (mach_msg_header_t *msg)
{
if (msg->msgh_id == MACH_NOTIFY_NO_SENDERS)
{
device_t dev;
mach_no_senders_notification_t *ns;
ns = (mach_no_senders_notification_t *) msg;
dev = (device_t) ns->not_header.msgh_remote_port;
if (dev->emul_ops->no_senders)
(*dev->emul_ops->no_senders) (ns);
return TRUE;
}
printf ("ds_notify: strange notification %d\n", msg->msgh_id);
return FALSE;
}
io_return_t
ds_device_write_trap (device_t dev, dev_mode_t mode,
recnum_t recnum, vm_offset_t data, vm_size_t count)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->write_trap)
return D_INVALID_OPERATION;
return (*dev->emul_ops->write_trap) (dev->emul_data,
mode, recnum, data, count);
}
io_return_t
ds_device_writev_trap (device_t dev, dev_mode_t mode,
recnum_t recnum, io_buf_vec_t *iovec, vm_size_t count)
{
if (dev == DEVICE_NULL)
return D_NO_SUCH_DEVICE;
if (! dev->emul_ops->writev_trap)
return D_INVALID_OPERATION;
return (*dev->emul_ops->writev_trap) (dev->emul_data,
mode, recnum, iovec, count);
}
void
device_reference (device_t dev)
{
if (dev->emul_ops->reference)
(*dev->emul_ops->reference) (dev->emul_data);
}
void
device_deallocate (device_t dev)
{
if (dev->emul_ops->dealloc)
(*dev->emul_ops->dealloc) (dev->emul_data);
}
|