![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to scsi-cdb.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [The Machine Emulator] / tme / scsi|
Return to scsi-cdb.c CVS log | Up to [The Machine Emulator] / tme / scsi |
1.1 root 1: /* $Id: scsi-cdb.c,v 1.4 2003/10/16 02:48:25 fredette Exp $ */
2:
3: /* scsi/scsi-cdb.c - implementation of generic SCSI device CDB support: */
4:
5: /*
6: * Copyright (c) 2003 Matt Fredette
7: * All rights reserved.
8: *
9: * Redistribution and use in source and binary forms, with or without
10: * modification, are permitted provided that the following conditions
11: * are met:
12: * 1. Redistributions of source code must retain the above copyright
13: * notice, this list of conditions and the following disclaimer.
14: * 2. Redistributions in binary form must reproduce the above copyright
15: * notice, this list of conditions and the following disclaimer in the
16: * documentation and/or other materials provided with the distribution.
17: * 3. All advertising materials mentioning features or use of this software
18: * must display the following acknowledgement:
19: * This product includes software developed by Matt Fredette.
20: * 4. The name of the author may not be used to endorse or promote products
21: * derived from this software without specific prior written permission.
22: *
23: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
24: * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
25: * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
26: * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
27: * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
28: * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
29: * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
31: * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
32: * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33: * POSSIBILITY OF SUCH DAMAGE.
34: */
35:
36: #include <tme/common.h>
37: _TME_RCSID("$Id: scsi-cdb.c,v 1.4 2003/10/16 02:48:25 fredette Exp $");
38:
39: /* includes: */
40: #include <tme/scsi/scsi-cdb.h>
41: #include <tme/scsi/scsi-msg.h>
42:
43: /* this handles any illegal request: */
44: _TME_SCSI_DEVICE_CDB_DECL(tme_scsi_device_cdb_illegal)
45: {
46: struct tme_scsi_device_sense *sense;
47: int lun;
48:
49: /* get the addressed LUN's sense: */
50: lun = scsi_device->tme_scsi_device_addressed_lun;
51: sense = &scsi_device->tme_scsi_device_sense[lun];
52:
53: /* if this target does not support extended sense: */
54: if (scsi_device->tme_scsi_device_sense_no_extended) {
55:
56: /* the error class and error code: */
57: sense->tme_scsi_device_sense_data[0]
58: = 0x20;
59: sense->tme_scsi_device_sense_data[1]
60: = 0;
61: sense->tme_scsi_device_sense_data[2]
62: = 0;
63: sense->tme_scsi_device_sense_data[3]
64: = 0;
65: sense->tme_scsi_device_sense_valid = 4;
66: }
67:
68: /* otherwise, return an extended sense: */
69: else {
70:
71: /* the error class and error code: */
72: sense->tme_scsi_device_sense_data[0]
73: = 0x70;
74:
75: /* the ILLEGAL REQUEST sense key: */
76: sense->tme_scsi_device_sense_data[2]
77: = 0x05;
78:
79: /* the additional sense length: */
80: sense->tme_scsi_device_sense_data[7]
81: = 0x00;
82:
83: sense->tme_scsi_device_sense_valid
84: = TRUE;
85: }
86:
87: /* return the CHECK CONDITION status: */
88: tme_scsi_device_target_do_smf(scsi_device,
89: TME_SCSI_STATUS_CHECK_CONDITION,
90: TME_SCSI_MSG_CMD_COMPLETE);
91: }
92:
93: /* this handles the TEST UNIT READY command: */
94: _TME_SCSI_DEVICE_CDB_DECL(tme_scsi_device_cdb_tur)
95: {
96: /* finish the command: */
97: tme_scsi_device_target_do_smf(scsi_device,
98: TME_SCSI_STATUS_GOOD,
99: TME_SCSI_MSG_CMD_COMPLETE);
100: }
101:
102: /* this handles the REQUEST SENSE command: */
103: _TME_SCSI_DEVICE_CDB_DECL(tme_scsi_device_cdb_request_sense)
104: {
105: int lun;
106: struct tme_scsi_device_sense *sense;
107: unsigned long transfer_length;
108:
109: /* get the addressed LUN's sense: */
110: lun = scsi_device->tme_scsi_device_addressed_lun;
111: sense = &scsi_device->tme_scsi_device_sense[lun];
112:
113: /* if the sense is not valid: */
114: if (!sense->tme_scsi_device_sense_valid) {
115:
116: /* if this device doesn't do extended sense: */
117: if (scsi_device->tme_scsi_device_sense_no_extended) {
118:
119: /* conjure up a no-error nonextended sense: */
120: sense->tme_scsi_device_sense_data[0]
121: = 0;
122: sense->tme_scsi_device_sense_data[1]
123: = 0;
124: sense->tme_scsi_device_sense_data[2]
125: = 0;
126: sense->tme_scsi_device_sense_data[3]
127: = 0;
128: sense->tme_scsi_device_sense_valid = 4;
129: }
130:
131: /* otherwise, this device does do extended sense: */
132: else {
133:
134: /* the error class and error code: */
135: sense->tme_scsi_device_sense_data[0]
136: = 0x70;
137:
138: /* the NO SENSE sense key: */
139: sense->tme_scsi_device_sense_data[2]
140: = 0x00;
141:
142: /* the additional sense length: */
143: sense->tme_scsi_device_sense_data[7]
144: = 0x00;
145: }
146: }
147:
148: /* see how much space for sense bytes the initiator
149: has allocated. zero means four: */
150: transfer_length
151: = scsi_device->tme_scsi_device_cdb[4];
152: if (transfer_length == 0) {
153: transfer_length = 4;
154: }
155:
156: /* bound this with the number of sense bytes we have available. an
157: extended sense has a length of 8 plus the additional sense
158: length. any other sense must specify how long it is in the
159: tme_scsi_device_sense_valid field (a standard nonextended sense
160: always has a length of four): */
161: transfer_length
162: = TME_MIN(transfer_length,
163: (((sense->tme_scsi_device_sense_data[0]
164: & 0x70)
165: == 0x70)
166: ? ((unsigned int) 8
167: + sense->tme_scsi_device_sense_data[7])
168: : sense->tme_scsi_device_sense_valid));
169:
170: /* set up to transfer the sense: */
171: scsi_device->tme_scsi_device_dma.tme_scsi_dma_in
172: = NULL;
173: scsi_device->tme_scsi_device_dma.tme_scsi_dma_out
174: = &sense->tme_scsi_device_sense_data[0];
175: scsi_device->tme_scsi_device_dma.tme_scsi_dma_resid
176: = transfer_length;
177:
178: /* the sense is no longer valid: */
179: sense->tme_scsi_device_sense_valid = FALSE;
180:
181: /* finish the command: */
182: tme_scsi_device_target_do_dsmf(scsi_device,
183: TME_SCSI_STATUS_GOOD,
184: TME_SCSI_MSG_CMD_COMPLETE);
185: }
186:
187: /* this adds one of the inquiry strings to the data: */
188: static tme_uint8_t *
189: _tme_scsi_device_make_inquiry_string(tme_uint8_t *data,
190: const tme_uint8_t *string,
191: unsigned int size)
192: {
193: tme_uint8_t c;
194:
195: for (; size-- > 0; ) {
196: c = *(string++);
197: if (c == '\0') {
198: c = ' ';
199: string--;
200: }
201: *(data++) = c;
202: }
203: return (data);
204: }
205:
206: /* this creates INQUIRY data: */
207: tme_uint8_t *
208: tme_scsi_device_make_inquiry_data(struct tme_scsi_device *scsi_device,
209: const struct tme_scsi_device_inquiry *inquiry)
210: {
211: tme_uint8_t *data;
212:
213: data = &scsi_device->tme_scsi_device_data[0];
214: scsi_device->tme_scsi_device_dma.tme_scsi_dma_out = data;
215: scsi_device->tme_scsi_device_dma.tme_scsi_dma_in = NULL;
216:
217: /* byte 0 is the peripheral device type: */
218: *(data++)
219: = (inquiry->tme_scsi_device_inquiry_type
220: | inquiry->tme_scsi_device_inquiry_lun_state);
221:
222: /* byte 1 is the device type qualifier: */
223: *(data++)
224: = (inquiry->tme_scsi_device_inquiry_type_qualifier
225: | (inquiry->tme_scsi_device_inquiry_lun_removable
226: ? 0x80
227: : 0x00));
228:
229: /* byte 2 is the standards versions: */
230: *(data++)
231: = ((inquiry->tme_scsi_device_inquiry_std_iso << 6)
232: | (inquiry->tme_scsi_device_inquiry_std_ecma << 3)
233: | (inquiry->tme_scsi_device_inquiry_std_iso << 0));
234:
235: /* byte 3 is the response format: */
236: *(data++)
237: = inquiry->tme_scsi_device_response_format;
238:
239: /* byte 4 is the additional length. we will come back and
240: fill it later: */
241: data++;
242:
243: /* bytes 5, 6, and 7 are flags, that we initialize to zero: */
244: *(data++) = 0x00;
245: *(data++) = 0x00;
246: *(data++) = 0x00;
247:
248: /* the next eight bytes are for the vendor: */
249: data
250: = _tme_scsi_device_make_inquiry_string(data,
251: scsi_device->tme_scsi_device_vendor,
252: 8);
253:
254: /* the next 16 bytes are for the product: */
255: data
256: = _tme_scsi_device_make_inquiry_string(data,
257: scsi_device->tme_scsi_device_product,
258: 16);
259:
260: /* the next four bytes are for the revision: */
261: data
262: = _tme_scsi_device_make_inquiry_string(data,
263: scsi_device->tme_scsi_device_revision,
264: 4);
265:
266: /* fill in the additional length byte: */
267: scsi_device->tme_scsi_device_data[4]
268: = (data
269: - &scsi_device->tme_scsi_device_data[5]);
270:
271: return (data);
272: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.