]>
Commit | Line | Data |
---|---|---|
02941a53 BH |
1 | /* |
2 | * osd_initiator - Main body of the osd initiator library. | |
3 | * | |
4 | * Note: The file does not contain the advanced security functionality which | |
5 | * is only needed by the security_manager's initiators. | |
6 | * | |
7 | * Copyright (C) 2008 Panasas Inc. All rights reserved. | |
8 | * | |
9 | * Authors: | |
10 | * Boaz Harrosh <bharrosh@panasas.com> | |
11 | * Benny Halevy <bhalevy@panasas.com> | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or modify | |
14 | * it under the terms of the GNU General Public License version 2 | |
15 | * | |
16 | * Redistribution and use in source and binary forms, with or without | |
17 | * modification, are permitted provided that the following conditions | |
18 | * are met: | |
19 | * | |
20 | * 1. Redistributions of source code must retain the above copyright | |
21 | * notice, this list of conditions and the following disclaimer. | |
22 | * 2. Redistributions in binary form must reproduce the above copyright | |
23 | * notice, this list of conditions and the following disclaimer in the | |
24 | * documentation and/or other materials provided with the distribution. | |
25 | * 3. Neither the name of the Panasas company nor the names of its | |
26 | * contributors may be used to endorse or promote products derived | |
27 | * from this software without specific prior written permission. | |
28 | * | |
29 | * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED | |
30 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF | |
31 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE | |
32 | * DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE | |
33 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | |
34 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | |
35 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR | |
36 | * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF | |
37 | * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING | |
38 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS | |
39 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
40 | */ | |
41 | ||
42 | #include <scsi/osd_initiator.h> | |
43 | #include <scsi/osd_sec.h> | |
1b9dce94 | 44 | #include <scsi/osd_attributes.h> |
98f3aea2 BH |
45 | #include <scsi/osd_sense.h> |
46 | ||
02941a53 BH |
47 | #include <scsi/scsi_device.h> |
48 | ||
49 | #include "osd_debug.h" | |
50 | ||
4ef1a3d7 BH |
51 | #ifndef __unused |
52 | # define __unused __attribute__((unused)) | |
53 | #endif | |
54 | ||
02941a53 BH |
55 | enum { OSD_REQ_RETRIES = 1 }; |
56 | ||
57 | MODULE_AUTHOR("Boaz Harrosh <bharrosh@panasas.com>"); | |
58 | MODULE_DESCRIPTION("open-osd initiator library libosd.ko"); | |
59 | MODULE_LICENSE("GPL"); | |
60 | ||
61 | static inline void build_test(void) | |
62 | { | |
63 | /* structures were not packed */ | |
64 | BUILD_BUG_ON(sizeof(struct osd_capability) != OSD_CAP_LEN); | |
c6572c98 | 65 | BUILD_BUG_ON(sizeof(struct osdv2_cdb) != OSD_TOTAL_CDB_LEN); |
02941a53 BH |
66 | BUILD_BUG_ON(sizeof(struct osdv1_cdb) != OSDv1_TOTAL_CDB_LEN); |
67 | } | |
68 | ||
1b9dce94 BH |
69 | static const char *_osd_ver_desc(struct osd_request *or) |
70 | { | |
71 | return osd_req_is_ver1(or) ? "OSD1" : "OSD2"; | |
72 | } | |
73 | ||
74 | #define ATTR_DEF_RI(id, len) ATTR_DEF(OSD_APAGE_ROOT_INFORMATION, id, len) | |
75 | ||
76 | static int _osd_print_system_info(struct osd_dev *od, void *caps) | |
77 | { | |
78 | struct osd_request *or; | |
79 | struct osd_attr get_attrs[] = { | |
80 | ATTR_DEF_RI(OSD_ATTR_RI_VENDOR_IDENTIFICATION, 8), | |
81 | ATTR_DEF_RI(OSD_ATTR_RI_PRODUCT_IDENTIFICATION, 16), | |
82 | ATTR_DEF_RI(OSD_ATTR_RI_PRODUCT_MODEL, 32), | |
83 | ATTR_DEF_RI(OSD_ATTR_RI_PRODUCT_REVISION_LEVEL, 4), | |
84 | ATTR_DEF_RI(OSD_ATTR_RI_PRODUCT_SERIAL_NUMBER, 64 /*variable*/), | |
85 | ATTR_DEF_RI(OSD_ATTR_RI_OSD_NAME, 64 /*variable*/), | |
86 | ATTR_DEF_RI(OSD_ATTR_RI_TOTAL_CAPACITY, 8), | |
87 | ATTR_DEF_RI(OSD_ATTR_RI_USED_CAPACITY, 8), | |
88 | ATTR_DEF_RI(OSD_ATTR_RI_NUMBER_OF_PARTITIONS, 8), | |
89 | ATTR_DEF_RI(OSD_ATTR_RI_CLOCK, 6), | |
90 | /* IBM-OSD-SIM Has a bug with this one put it last */ | |
91 | ATTR_DEF_RI(OSD_ATTR_RI_OSD_SYSTEM_ID, 20), | |
92 | }; | |
93 | void *iter = NULL, *pFirst; | |
94 | int nelem = ARRAY_SIZE(get_attrs), a = 0; | |
95 | int ret; | |
96 | ||
97 | or = osd_start_request(od, GFP_KERNEL); | |
98 | if (!or) | |
99 | return -ENOMEM; | |
100 | ||
101 | /* get attrs */ | |
102 | osd_req_get_attributes(or, &osd_root_object); | |
103 | osd_req_add_get_attr_list(or, get_attrs, ARRAY_SIZE(get_attrs)); | |
104 | ||
105 | ret = osd_finalize_request(or, 0, caps, NULL); | |
106 | if (ret) | |
107 | goto out; | |
108 | ||
109 | ret = osd_execute_request(or); | |
110 | if (ret) { | |
111 | OSD_ERR("Failed to detect %s => %d\n", _osd_ver_desc(or), ret); | |
112 | goto out; | |
113 | } | |
114 | ||
115 | osd_req_decode_get_attr_list(or, get_attrs, &nelem, &iter); | |
116 | ||
117 | OSD_INFO("Detected %s device\n", | |
118 | _osd_ver_desc(or)); | |
119 | ||
120 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 121 | OSD_INFO("VENDOR_IDENTIFICATION [%s]\n", |
1b9dce94 BH |
122 | (char *)pFirst); |
123 | ||
124 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 125 | OSD_INFO("PRODUCT_IDENTIFICATION [%s]\n", |
1b9dce94 BH |
126 | (char *)pFirst); |
127 | ||
128 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 129 | OSD_INFO("PRODUCT_MODEL [%s]\n", |
1b9dce94 BH |
130 | (char *)pFirst); |
131 | ||
132 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 133 | OSD_INFO("PRODUCT_REVISION_LEVEL [%u]\n", |
97218a14 | 134 | pFirst ? get_unaligned_be32(pFirst) : ~0U); |
1b9dce94 BH |
135 | |
136 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 137 | OSD_INFO("PRODUCT_SERIAL_NUMBER [%s]\n", |
1b9dce94 BH |
138 | (char *)pFirst); |
139 | ||
140 | pFirst = get_attrs[a].val_ptr; | |
de6b2038 | 141 | OSD_INFO("OSD_NAME [%s]\n", (char *)pFirst); |
1b9dce94 BH |
142 | a++; |
143 | ||
144 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 145 | OSD_INFO("TOTAL_CAPACITY [0x%llx]\n", |
97218a14 | 146 | pFirst ? _LLU(get_unaligned_be64(pFirst)) : ~0ULL); |
1b9dce94 BH |
147 | |
148 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 149 | OSD_INFO("USED_CAPACITY [0x%llx]\n", |
97218a14 | 150 | pFirst ? _LLU(get_unaligned_be64(pFirst)) : ~0ULL); |
1b9dce94 BH |
151 | |
152 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 153 | OSD_INFO("NUMBER_OF_PARTITIONS [%llu]\n", |
97218a14 BH |
154 | pFirst ? _LLU(get_unaligned_be64(pFirst)) : ~0ULL); |
155 | ||
156 | if (a >= nelem) | |
157 | goto out; | |
1b9dce94 BH |
158 | |
159 | /* FIXME: Where are the time utilities */ | |
160 | pFirst = get_attrs[a++].val_ptr; | |
de6b2038 | 161 | OSD_INFO("CLOCK [0x%02x%02x%02x%02x%02x%02x]\n", |
1b9dce94 BH |
162 | ((char *)pFirst)[0], ((char *)pFirst)[1], |
163 | ((char *)pFirst)[2], ((char *)pFirst)[3], | |
164 | ((char *)pFirst)[4], ((char *)pFirst)[5]); | |
165 | ||
166 | if (a < nelem) { /* IBM-OSD-SIM bug, Might not have it */ | |
167 | unsigned len = get_attrs[a].len; | |
168 | char sid_dump[32*4 + 2]; /* 2nibbles+space+ASCII */ | |
169 | ||
170 | hex_dump_to_buffer(get_attrs[a].val_ptr, len, 32, 1, | |
171 | sid_dump, sizeof(sid_dump), true); | |
de6b2038 BH |
172 | OSD_INFO("OSD_SYSTEM_ID(%d)\n" |
173 | " [%s]\n", len, sid_dump); | |
1b9dce94 BH |
174 | a++; |
175 | } | |
176 | out: | |
177 | osd_end_request(or); | |
178 | return ret; | |
179 | } | |
180 | ||
181 | int osd_auto_detect_ver(struct osd_dev *od, void *caps) | |
182 | { | |
183 | int ret; | |
184 | ||
185 | /* Auto-detect the osd version */ | |
186 | ret = _osd_print_system_info(od, caps); | |
187 | if (ret) { | |
188 | osd_dev_set_ver(od, OSD_VER1); | |
189 | OSD_DEBUG("converting to OSD1\n"); | |
190 | ret = _osd_print_system_info(od, caps); | |
191 | } | |
192 | ||
193 | return ret; | |
194 | } | |
195 | EXPORT_SYMBOL(osd_auto_detect_ver); | |
196 | ||
02941a53 BH |
197 | static unsigned _osd_req_cdb_len(struct osd_request *or) |
198 | { | |
c6572c98 | 199 | return osd_req_is_ver1(or) ? OSDv1_TOTAL_CDB_LEN : OSD_TOTAL_CDB_LEN; |
02941a53 BH |
200 | } |
201 | ||
4ef1a3d7 BH |
202 | static unsigned _osd_req_alist_elem_size(struct osd_request *or, unsigned len) |
203 | { | |
c6572c98 BH |
204 | return osd_req_is_ver1(or) ? |
205 | osdv1_attr_list_elem_size(len) : | |
206 | osdv2_attr_list_elem_size(len); | |
4ef1a3d7 BH |
207 | } |
208 | ||
71f32e31 BH |
209 | static void _osd_req_alist_elem_encode(struct osd_request *or, |
210 | void *attr_last, const struct osd_attr *oa) | |
211 | { | |
212 | if (osd_req_is_ver1(or)) { | |
213 | struct osdv1_attributes_list_element *attr = attr_last; | |
214 | ||
215 | attr->attr_page = cpu_to_be32(oa->attr_page); | |
216 | attr->attr_id = cpu_to_be32(oa->attr_id); | |
217 | attr->attr_bytes = cpu_to_be16(oa->len); | |
218 | memcpy(attr->attr_val, oa->val_ptr, oa->len); | |
219 | } else { | |
220 | struct osdv2_attributes_list_element *attr = attr_last; | |
221 | ||
222 | attr->attr_page = cpu_to_be32(oa->attr_page); | |
223 | attr->attr_id = cpu_to_be32(oa->attr_id); | |
224 | attr->attr_bytes = cpu_to_be16(oa->len); | |
225 | memcpy(attr->attr_val, oa->val_ptr, oa->len); | |
226 | } | |
227 | } | |
228 | ||
229 | static int _osd_req_alist_elem_decode(struct osd_request *or, | |
230 | void *cur_p, struct osd_attr *oa, unsigned max_bytes) | |
231 | { | |
232 | unsigned inc; | |
233 | if (osd_req_is_ver1(or)) { | |
234 | struct osdv1_attributes_list_element *attr = cur_p; | |
235 | ||
236 | if (max_bytes < sizeof(*attr)) | |
237 | return -1; | |
238 | ||
239 | oa->len = be16_to_cpu(attr->attr_bytes); | |
240 | inc = _osd_req_alist_elem_size(or, oa->len); | |
241 | if (inc > max_bytes) | |
242 | return -1; | |
243 | ||
244 | oa->attr_page = be32_to_cpu(attr->attr_page); | |
245 | oa->attr_id = be32_to_cpu(attr->attr_id); | |
246 | ||
247 | /* OSD1: On empty attributes we return a pointer to 2 bytes | |
248 | * of zeros. This keeps similar behaviour with OSD2. | |
249 | * (See below) | |
250 | */ | |
251 | oa->val_ptr = likely(oa->len) ? attr->attr_val : | |
252 | (u8 *)&attr->attr_bytes; | |
253 | } else { | |
254 | struct osdv2_attributes_list_element *attr = cur_p; | |
255 | ||
256 | if (max_bytes < sizeof(*attr)) | |
257 | return -1; | |
258 | ||
259 | oa->len = be16_to_cpu(attr->attr_bytes); | |
260 | inc = _osd_req_alist_elem_size(or, oa->len); | |
261 | if (inc > max_bytes) | |
262 | return -1; | |
263 | ||
264 | oa->attr_page = be32_to_cpu(attr->attr_page); | |
265 | oa->attr_id = be32_to_cpu(attr->attr_id); | |
266 | ||
e9da4d7f BH |
267 | /* OSD2: For convenience, on empty attributes, we return 8 bytes |
268 | * of zeros here. This keeps the same behaviour with OSD2r04, | |
269 | * and is nice with null terminating ASCII fields. | |
270 | * oa->val_ptr == NULL marks the end-of-list, or error. | |
271 | */ | |
272 | oa->val_ptr = likely(oa->len) ? attr->attr_val : attr->reserved; | |
71f32e31 BH |
273 | } |
274 | return inc; | |
275 | } | |
276 | ||
4ef1a3d7 BH |
277 | static unsigned _osd_req_alist_size(struct osd_request *or, void *list_head) |
278 | { | |
c6572c98 BH |
279 | return osd_req_is_ver1(or) ? |
280 | osdv1_list_size(list_head) : | |
281 | osdv2_list_size(list_head); | |
4ef1a3d7 BH |
282 | } |
283 | ||
284 | static unsigned _osd_req_sizeof_alist_header(struct osd_request *or) | |
285 | { | |
c6572c98 BH |
286 | return osd_req_is_ver1(or) ? |
287 | sizeof(struct osdv1_attributes_list_header) : | |
288 | sizeof(struct osdv2_attributes_list_header); | |
4ef1a3d7 BH |
289 | } |
290 | ||
291 | static void _osd_req_set_alist_type(struct osd_request *or, | |
292 | void *list, int list_type) | |
293 | { | |
c6572c98 BH |
294 | if (osd_req_is_ver1(or)) { |
295 | struct osdv1_attributes_list_header *attr_list = list; | |
296 | ||
297 | memset(attr_list, 0, sizeof(*attr_list)); | |
298 | attr_list->type = list_type; | |
299 | } else { | |
300 | struct osdv2_attributes_list_header *attr_list = list; | |
4ef1a3d7 | 301 | |
c6572c98 BH |
302 | memset(attr_list, 0, sizeof(*attr_list)); |
303 | attr_list->type = list_type; | |
304 | } | |
4ef1a3d7 BH |
305 | } |
306 | ||
307 | static bool _osd_req_is_alist_type(struct osd_request *or, | |
308 | void *list, int list_type) | |
309 | { | |
310 | if (!list) | |
311 | return false; | |
312 | ||
c6572c98 | 313 | if (osd_req_is_ver1(or)) { |
4ef1a3d7 BH |
314 | struct osdv1_attributes_list_header *attr_list = list; |
315 | ||
c6572c98 BH |
316 | return attr_list->type == list_type; |
317 | } else { | |
318 | struct osdv2_attributes_list_header *attr_list = list; | |
319 | ||
4ef1a3d7 BH |
320 | return attr_list->type == list_type; |
321 | } | |
322 | } | |
323 | ||
3e086130 BH |
324 | /* This is for List-objects not Attributes-Lists */ |
325 | static void _osd_req_encode_olist(struct osd_request *or, | |
326 | struct osd_obj_id_list *list) | |
327 | { | |
328 | struct osd_cdb_head *cdbh = osd_cdb_head(&or->cdb); | |
329 | ||
c6572c98 BH |
330 | if (osd_req_is_ver1(or)) { |
331 | cdbh->v1.list_identifier = list->list_identifier; | |
332 | cdbh->v1.start_address = list->continuation_id; | |
333 | } else { | |
334 | cdbh->v2.list_identifier = list->list_identifier; | |
335 | cdbh->v2.start_address = list->continuation_id; | |
336 | } | |
3e086130 BH |
337 | } |
338 | ||
4ef1a3d7 BH |
339 | static osd_cdb_offset osd_req_encode_offset(struct osd_request *or, |
340 | u64 offset, unsigned *padding) | |
341 | { | |
342 | return __osd_encode_offset(offset, padding, | |
c6572c98 BH |
343 | osd_req_is_ver1(or) ? |
344 | OSDv1_OFFSET_MIN_SHIFT : OSD_OFFSET_MIN_SHIFT, | |
345 | OSD_OFFSET_MAX_SHIFT); | |
4ef1a3d7 BH |
346 | } |
347 | ||
345c435d BH |
348 | static struct osd_security_parameters * |
349 | _osd_req_sec_params(struct osd_request *or) | |
350 | { | |
351 | struct osd_cdb *ocdb = &or->cdb; | |
352 | ||
c6572c98 | 353 | if (osd_req_is_ver1(or)) |
f8d3a644 | 354 | return (struct osd_security_parameters *)&ocdb->v1.sec_params; |
c6572c98 | 355 | else |
f8d3a644 | 356 | return (struct osd_security_parameters *)&ocdb->v2.sec_params; |
345c435d BH |
357 | } |
358 | ||
02941a53 BH |
359 | void osd_dev_init(struct osd_dev *osdd, struct scsi_device *scsi_device) |
360 | { | |
361 | memset(osdd, 0, sizeof(*osdd)); | |
362 | osdd->scsi_device = scsi_device; | |
363 | osdd->def_timeout = BLK_DEFAULT_SG_TIMEOUT; | |
c6572c98 BH |
364 | #ifdef OSD_VER1_SUPPORT |
365 | osdd->version = OSD_VER2; | |
366 | #endif | |
02941a53 BH |
367 | /* TODO: Allocate pools for osd_request attributes ... */ |
368 | } | |
369 | EXPORT_SYMBOL(osd_dev_init); | |
370 | ||
371 | void osd_dev_fini(struct osd_dev *osdd) | |
372 | { | |
373 | /* TODO: De-allocate pools */ | |
374 | ||
375 | osdd->scsi_device = NULL; | |
376 | } | |
377 | EXPORT_SYMBOL(osd_dev_fini); | |
378 | ||
379 | static struct osd_request *_osd_request_alloc(gfp_t gfp) | |
380 | { | |
381 | struct osd_request *or; | |
382 | ||
383 | /* TODO: Use mempool with one saved request */ | |
384 | or = kzalloc(sizeof(*or), gfp); | |
385 | return or; | |
386 | } | |
387 | ||
388 | static void _osd_request_free(struct osd_request *or) | |
389 | { | |
390 | kfree(or); | |
391 | } | |
392 | ||
393 | struct osd_request *osd_start_request(struct osd_dev *dev, gfp_t gfp) | |
394 | { | |
395 | struct osd_request *or; | |
396 | ||
397 | or = _osd_request_alloc(gfp); | |
398 | if (!or) | |
399 | return NULL; | |
400 | ||
401 | or->osd_dev = dev; | |
402 | or->alloc_flags = gfp; | |
403 | or->timeout = dev->def_timeout; | |
404 | or->retries = OSD_REQ_RETRIES; | |
405 | ||
406 | return or; | |
407 | } | |
408 | EXPORT_SYMBOL(osd_start_request); | |
409 | ||
4ef1a3d7 BH |
410 | static void _osd_free_seg(struct osd_request *or __unused, |
411 | struct _osd_req_data_segment *seg) | |
412 | { | |
413 | if (!seg->buff || !seg->alloc_size) | |
414 | return; | |
415 | ||
416 | kfree(seg->buff); | |
417 | seg->buff = NULL; | |
418 | seg->alloc_size = 0; | |
419 | } | |
420 | ||
8c0bacca BH |
421 | static void _put_request(struct request *rq , bool is_async) |
422 | { | |
423 | if (is_async) { | |
424 | WARN_ON(rq->bio); | |
425 | __blk_put_request(rq->q, rq); | |
426 | } else { | |
427 | /* | |
428 | * If osd_finalize_request() was called but the request was not | |
429 | * executed through the block layer, then we must release BIOs. | |
430 | * TODO: Keep error code in or->async_error. Need to audit all | |
431 | * code paths. | |
432 | */ | |
433 | if (unlikely(rq->bio)) | |
434 | blk_end_request(rq, -ENOMEM, blk_rq_bytes(rq)); | |
435 | else | |
436 | blk_put_request(rq); | |
437 | } | |
438 | } | |
439 | ||
02941a53 BH |
440 | void osd_end_request(struct osd_request *or) |
441 | { | |
442 | struct request *rq = or->request; | |
8c0bacca BH |
443 | /* IMPORTANT: make sure this agrees with osd_execute_request_async */ |
444 | bool is_async = (or->request->end_io_data == or); | |
02941a53 | 445 | |
4ef1a3d7 BH |
446 | _osd_free_seg(or, &or->set_attr); |
447 | _osd_free_seg(or, &or->enc_get_attr); | |
448 | _osd_free_seg(or, &or->get_attr); | |
449 | ||
02941a53 BH |
450 | if (rq) { |
451 | if (rq->next_rq) { | |
8c0bacca BH |
452 | _put_request(rq->next_rq, is_async); |
453 | rq->next_rq = NULL; | |
02941a53 BH |
454 | } |
455 | ||
8c0bacca | 456 | _put_request(rq, is_async); |
02941a53 BH |
457 | } |
458 | _osd_request_free(or); | |
459 | } | |
460 | EXPORT_SYMBOL(osd_end_request); | |
461 | ||
462 | int osd_execute_request(struct osd_request *or) | |
463 | { | |
464 | return blk_execute_rq(or->request->q, NULL, or->request, 0); | |
465 | } | |
466 | EXPORT_SYMBOL(osd_execute_request); | |
467 | ||
468 | static void osd_request_async_done(struct request *req, int error) | |
469 | { | |
470 | struct osd_request *or = req->end_io_data; | |
471 | ||
472 | or->async_error = error; | |
473 | ||
474 | if (error) | |
475 | OSD_DEBUG("osd_request_async_done error recieved %d\n", error); | |
476 | ||
477 | if (or->async_done) | |
478 | or->async_done(or, or->async_private); | |
479 | else | |
480 | osd_end_request(or); | |
481 | } | |
482 | ||
483 | int osd_execute_request_async(struct osd_request *or, | |
484 | osd_req_done_fn *done, void *private) | |
485 | { | |
486 | or->request->end_io_data = or; | |
487 | or->async_private = private; | |
488 | or->async_done = done; | |
489 | ||
490 | blk_execute_rq_nowait(or->request->q, NULL, or->request, 0, | |
491 | osd_request_async_done); | |
492 | return 0; | |
493 | } | |
494 | EXPORT_SYMBOL(osd_execute_request_async); | |
495 | ||
4ef1a3d7 BH |
496 | u8 sg_out_pad_buffer[1 << OSDv1_OFFSET_MIN_SHIFT]; |
497 | u8 sg_in_pad_buffer[1 << OSDv1_OFFSET_MIN_SHIFT]; | |
498 | ||
499 | static int _osd_realloc_seg(struct osd_request *or, | |
500 | struct _osd_req_data_segment *seg, unsigned max_bytes) | |
501 | { | |
502 | void *buff; | |
503 | ||
504 | if (seg->alloc_size >= max_bytes) | |
505 | return 0; | |
506 | ||
507 | buff = krealloc(seg->buff, max_bytes, or->alloc_flags); | |
508 | if (!buff) { | |
509 | OSD_ERR("Failed to Realloc %d-bytes was-%d\n", max_bytes, | |
510 | seg->alloc_size); | |
511 | return -ENOMEM; | |
512 | } | |
513 | ||
514 | memset(buff + seg->alloc_size, 0, max_bytes - seg->alloc_size); | |
515 | seg->buff = buff; | |
516 | seg->alloc_size = max_bytes; | |
517 | return 0; | |
518 | } | |
519 | ||
520 | static int _alloc_set_attr_list(struct osd_request *or, | |
521 | const struct osd_attr *oa, unsigned nelem, unsigned add_bytes) | |
522 | { | |
523 | unsigned total_bytes = add_bytes; | |
524 | ||
525 | for (; nelem; --nelem, ++oa) | |
526 | total_bytes += _osd_req_alist_elem_size(or, oa->len); | |
527 | ||
528 | OSD_DEBUG("total_bytes=%d\n", total_bytes); | |
529 | return _osd_realloc_seg(or, &or->set_attr, total_bytes); | |
530 | } | |
531 | ||
532 | static int _alloc_get_attr_desc(struct osd_request *or, unsigned max_bytes) | |
533 | { | |
534 | OSD_DEBUG("total_bytes=%d\n", max_bytes); | |
535 | return _osd_realloc_seg(or, &or->enc_get_attr, max_bytes); | |
536 | } | |
537 | ||
538 | static int _alloc_get_attr_list(struct osd_request *or) | |
539 | { | |
540 | OSD_DEBUG("total_bytes=%d\n", or->get_attr.total_bytes); | |
541 | return _osd_realloc_seg(or, &or->get_attr, or->get_attr.total_bytes); | |
542 | } | |
543 | ||
02941a53 BH |
544 | /* |
545 | * Common to all OSD commands | |
546 | */ | |
547 | ||
548 | static void _osdv1_req_encode_common(struct osd_request *or, | |
549 | __be16 act, const struct osd_obj_id *obj, u64 offset, u64 len) | |
550 | { | |
551 | struct osdv1_cdb *ocdb = &or->cdb.v1; | |
552 | ||
553 | /* | |
554 | * For speed, the commands | |
555 | * OSD_ACT_PERFORM_SCSI_COMMAND , V1 0x8F7E, V2 0x8F7C | |
556 | * OSD_ACT_SCSI_TASK_MANAGEMENT , V1 0x8F7F, V2 0x8F7D | |
557 | * are not supported here. Should pass zero and set after the call | |
558 | */ | |
559 | act &= cpu_to_be16(~0x0080); /* V1 action code */ | |
560 | ||
561 | OSD_DEBUG("OSDv1 execute opcode 0x%x\n", be16_to_cpu(act)); | |
562 | ||
563 | ocdb->h.varlen_cdb.opcode = VARIABLE_LENGTH_CMD; | |
564 | ocdb->h.varlen_cdb.additional_cdb_length = OSD_ADDITIONAL_CDB_LENGTH; | |
565 | ocdb->h.varlen_cdb.service_action = act; | |
566 | ||
567 | ocdb->h.partition = cpu_to_be64(obj->partition); | |
568 | ocdb->h.object = cpu_to_be64(obj->id); | |
569 | ocdb->h.v1.length = cpu_to_be64(len); | |
570 | ocdb->h.v1.start_address = cpu_to_be64(offset); | |
571 | } | |
572 | ||
c6572c98 BH |
573 | static void _osdv2_req_encode_common(struct osd_request *or, |
574 | __be16 act, const struct osd_obj_id *obj, u64 offset, u64 len) | |
575 | { | |
576 | struct osdv2_cdb *ocdb = &or->cdb.v2; | |
577 | ||
578 | OSD_DEBUG("OSDv2 execute opcode 0x%x\n", be16_to_cpu(act)); | |
579 | ||
580 | ocdb->h.varlen_cdb.opcode = VARIABLE_LENGTH_CMD; | |
581 | ocdb->h.varlen_cdb.additional_cdb_length = OSD_ADDITIONAL_CDB_LENGTH; | |
582 | ocdb->h.varlen_cdb.service_action = act; | |
583 | ||
584 | ocdb->h.partition = cpu_to_be64(obj->partition); | |
585 | ocdb->h.object = cpu_to_be64(obj->id); | |
586 | ocdb->h.v2.length = cpu_to_be64(len); | |
587 | ocdb->h.v2.start_address = cpu_to_be64(offset); | |
588 | } | |
589 | ||
02941a53 BH |
590 | static void _osd_req_encode_common(struct osd_request *or, |
591 | __be16 act, const struct osd_obj_id *obj, u64 offset, u64 len) | |
592 | { | |
c6572c98 BH |
593 | if (osd_req_is_ver1(or)) |
594 | _osdv1_req_encode_common(or, act, obj, offset, len); | |
595 | else | |
596 | _osdv2_req_encode_common(or, act, obj, offset, len); | |
02941a53 BH |
597 | } |
598 | ||
599 | /* | |
600 | * Device commands | |
601 | */ | |
ae30c994 BH |
602 | /*TODO: void osd_req_set_master_seed_xchg(struct osd_request *, ...); */ |
603 | /*TODO: void osd_req_set_master_key(struct osd_request *, ...); */ | |
604 | ||
02941a53 BH |
605 | void osd_req_format(struct osd_request *or, u64 tot_capacity) |
606 | { | |
607 | _osd_req_encode_common(or, OSD_ACT_FORMAT_OSD, &osd_root_object, 0, | |
608 | tot_capacity); | |
609 | } | |
610 | EXPORT_SYMBOL(osd_req_format); | |
611 | ||
3e086130 BH |
612 | int osd_req_list_dev_partitions(struct osd_request *or, |
613 | osd_id initial_id, struct osd_obj_id_list *list, unsigned nelem) | |
614 | { | |
615 | return osd_req_list_partition_objects(or, 0, initial_id, list, nelem); | |
616 | } | |
617 | EXPORT_SYMBOL(osd_req_list_dev_partitions); | |
618 | ||
619 | static void _osd_req_encode_flush(struct osd_request *or, | |
620 | enum osd_options_flush_scope_values op) | |
621 | { | |
622 | struct osd_cdb_head *ocdb = osd_cdb_head(&or->cdb); | |
623 | ||
624 | ocdb->command_specific_options = op; | |
625 | } | |
626 | ||
627 | void osd_req_flush_obsd(struct osd_request *or, | |
628 | enum osd_options_flush_scope_values op) | |
629 | { | |
630 | _osd_req_encode_common(or, OSD_ACT_FLUSH_OSD, &osd_root_object, 0, 0); | |
631 | _osd_req_encode_flush(or, op); | |
632 | } | |
633 | EXPORT_SYMBOL(osd_req_flush_obsd); | |
634 | ||
ae30c994 BH |
635 | /*TODO: void osd_req_perform_scsi_command(struct osd_request *, |
636 | const u8 *cdb, ...); */ | |
637 | /*TODO: void osd_req_task_management(struct osd_request *, ...); */ | |
638 | ||
02941a53 BH |
639 | /* |
640 | * Partition commands | |
641 | */ | |
642 | static void _osd_req_encode_partition(struct osd_request *or, | |
643 | __be16 act, osd_id partition) | |
644 | { | |
645 | struct osd_obj_id par = { | |
646 | .partition = partition, | |
647 | .id = 0, | |
648 | }; | |
649 | ||
650 | _osd_req_encode_common(or, act, &par, 0, 0); | |
651 | } | |
652 | ||
653 | void osd_req_create_partition(struct osd_request *or, osd_id partition) | |
654 | { | |
655 | _osd_req_encode_partition(or, OSD_ACT_CREATE_PARTITION, partition); | |
656 | } | |
657 | EXPORT_SYMBOL(osd_req_create_partition); | |
658 | ||
659 | void osd_req_remove_partition(struct osd_request *or, osd_id partition) | |
660 | { | |
661 | _osd_req_encode_partition(or, OSD_ACT_REMOVE_PARTITION, partition); | |
662 | } | |
663 | EXPORT_SYMBOL(osd_req_remove_partition); | |
664 | ||
ae30c994 BH |
665 | /*TODO: void osd_req_set_partition_key(struct osd_request *, |
666 | osd_id partition, u8 new_key_id[OSD_CRYPTO_KEYID_SIZE], | |
667 | u8 seed[OSD_CRYPTO_SEED_SIZE]); */ | |
668 | ||
3e086130 BH |
669 | static int _osd_req_list_objects(struct osd_request *or, |
670 | __be16 action, const struct osd_obj_id *obj, osd_id initial_id, | |
671 | struct osd_obj_id_list *list, unsigned nelem) | |
672 | { | |
673 | struct request_queue *q = or->osd_dev->scsi_device->request_queue; | |
674 | u64 len = nelem * sizeof(osd_id) + sizeof(*list); | |
675 | struct bio *bio; | |
676 | ||
677 | _osd_req_encode_common(or, action, obj, (u64)initial_id, len); | |
678 | ||
679 | if (list->list_identifier) | |
680 | _osd_req_encode_olist(or, list); | |
681 | ||
682 | WARN_ON(or->in.bio); | |
683 | bio = bio_map_kern(q, list, len, or->alloc_flags); | |
bf5e84f6 | 684 | if (IS_ERR(bio)) { |
3e086130 | 685 | OSD_ERR("!!! Failed to allocate list_objects BIO\n"); |
bf5e84f6 | 686 | return PTR_ERR(bio); |
3e086130 BH |
687 | } |
688 | ||
689 | bio->bi_rw &= ~(1 << BIO_RW); | |
690 | or->in.bio = bio; | |
691 | or->in.total_bytes = bio->bi_size; | |
692 | return 0; | |
693 | } | |
694 | ||
695 | int osd_req_list_partition_collections(struct osd_request *or, | |
696 | osd_id partition, osd_id initial_id, struct osd_obj_id_list *list, | |
697 | unsigned nelem) | |
698 | { | |
699 | struct osd_obj_id par = { | |
700 | .partition = partition, | |
701 | .id = 0, | |
702 | }; | |
703 | ||
704 | return osd_req_list_collection_objects(or, &par, initial_id, list, | |
705 | nelem); | |
706 | } | |
707 | EXPORT_SYMBOL(osd_req_list_partition_collections); | |
708 | ||
709 | int osd_req_list_partition_objects(struct osd_request *or, | |
710 | osd_id partition, osd_id initial_id, struct osd_obj_id_list *list, | |
711 | unsigned nelem) | |
712 | { | |
713 | struct osd_obj_id par = { | |
714 | .partition = partition, | |
715 | .id = 0, | |
716 | }; | |
717 | ||
718 | return _osd_req_list_objects(or, OSD_ACT_LIST, &par, initial_id, list, | |
719 | nelem); | |
720 | } | |
721 | EXPORT_SYMBOL(osd_req_list_partition_objects); | |
722 | ||
723 | void osd_req_flush_partition(struct osd_request *or, | |
724 | osd_id partition, enum osd_options_flush_scope_values op) | |
725 | { | |
726 | _osd_req_encode_partition(or, OSD_ACT_FLUSH_PARTITION, partition); | |
727 | _osd_req_encode_flush(or, op); | |
728 | } | |
729 | EXPORT_SYMBOL(osd_req_flush_partition); | |
730 | ||
731 | /* | |
732 | * Collection commands | |
733 | */ | |
ae30c994 BH |
734 | /*TODO: void osd_req_create_collection(struct osd_request *, |
735 | const struct osd_obj_id *); */ | |
736 | /*TODO: void osd_req_remove_collection(struct osd_request *, | |
737 | const struct osd_obj_id *); */ | |
738 | ||
3e086130 BH |
739 | int osd_req_list_collection_objects(struct osd_request *or, |
740 | const struct osd_obj_id *obj, osd_id initial_id, | |
741 | struct osd_obj_id_list *list, unsigned nelem) | |
742 | { | |
743 | return _osd_req_list_objects(or, OSD_ACT_LIST_COLLECTION, obj, | |
744 | initial_id, list, nelem); | |
745 | } | |
746 | EXPORT_SYMBOL(osd_req_list_collection_objects); | |
747 | ||
ae30c994 BH |
748 | /*TODO: void query(struct osd_request *, ...); V2 */ |
749 | ||
3e086130 BH |
750 | void osd_req_flush_collection(struct osd_request *or, |
751 | const struct osd_obj_id *obj, enum osd_options_flush_scope_values op) | |
752 | { | |
753 | _osd_req_encode_common(or, OSD_ACT_FLUSH_PARTITION, obj, 0, 0); | |
754 | _osd_req_encode_flush(or, op); | |
755 | } | |
756 | EXPORT_SYMBOL(osd_req_flush_collection); | |
757 | ||
ae30c994 BH |
758 | /*TODO: void get_member_attrs(struct osd_request *, ...); V2 */ |
759 | /*TODO: void set_member_attrs(struct osd_request *, ...); V2 */ | |
760 | ||
02941a53 BH |
761 | /* |
762 | * Object commands | |
763 | */ | |
764 | void osd_req_create_object(struct osd_request *or, struct osd_obj_id *obj) | |
765 | { | |
766 | _osd_req_encode_common(or, OSD_ACT_CREATE, obj, 0, 0); | |
767 | } | |
768 | EXPORT_SYMBOL(osd_req_create_object); | |
769 | ||
770 | void osd_req_remove_object(struct osd_request *or, struct osd_obj_id *obj) | |
771 | { | |
772 | _osd_req_encode_common(or, OSD_ACT_REMOVE, obj, 0, 0); | |
773 | } | |
774 | EXPORT_SYMBOL(osd_req_remove_object); | |
775 | ||
ae30c994 BH |
776 | |
777 | /*TODO: void osd_req_create_multi(struct osd_request *or, | |
778 | struct osd_obj_id *first, struct osd_obj_id_list *list, unsigned nelem); | |
779 | */ | |
780 | ||
02941a53 BH |
781 | void osd_req_write(struct osd_request *or, |
782 | const struct osd_obj_id *obj, struct bio *bio, u64 offset) | |
783 | { | |
784 | _osd_req_encode_common(or, OSD_ACT_WRITE, obj, offset, bio->bi_size); | |
785 | WARN_ON(or->out.bio || or->out.total_bytes); | |
786 | bio->bi_rw |= (1 << BIO_RW); | |
787 | or->out.bio = bio; | |
788 | or->out.total_bytes = bio->bi_size; | |
789 | } | |
790 | EXPORT_SYMBOL(osd_req_write); | |
791 | ||
0e35afbc BH |
792 | int osd_req_write_kern(struct osd_request *or, |
793 | const struct osd_obj_id *obj, u64 offset, void* buff, u64 len) | |
794 | { | |
795 | struct request_queue *req_q = or->osd_dev->scsi_device->request_queue; | |
796 | struct bio *bio = bio_map_kern(req_q, buff, len, GFP_KERNEL); | |
797 | ||
798 | if (IS_ERR(bio)) | |
799 | return PTR_ERR(bio); | |
800 | ||
801 | osd_req_write(or, obj, bio, offset); | |
802 | return 0; | |
803 | } | |
804 | EXPORT_SYMBOL(osd_req_write_kern); | |
805 | ||
ae30c994 BH |
806 | /*TODO: void osd_req_append(struct osd_request *, |
807 | const struct osd_obj_id *, struct bio *data_out); */ | |
808 | /*TODO: void osd_req_create_write(struct osd_request *, | |
809 | const struct osd_obj_id *, struct bio *data_out, u64 offset); */ | |
810 | /*TODO: void osd_req_clear(struct osd_request *, | |
811 | const struct osd_obj_id *, u64 offset, u64 len); */ | |
812 | /*TODO: void osd_req_punch(struct osd_request *, | |
813 | const struct osd_obj_id *, u64 offset, u64 len); V2 */ | |
814 | ||
3e086130 BH |
815 | void osd_req_flush_object(struct osd_request *or, |
816 | const struct osd_obj_id *obj, enum osd_options_flush_scope_values op, | |
817 | /*V2*/ u64 offset, /*V2*/ u64 len) | |
818 | { | |
c6572c98 BH |
819 | if (unlikely(osd_req_is_ver1(or) && (offset || len))) { |
820 | OSD_DEBUG("OSD Ver1 flush on specific range ignored\n"); | |
821 | offset = 0; | |
822 | len = 0; | |
823 | } | |
824 | ||
3e086130 BH |
825 | _osd_req_encode_common(or, OSD_ACT_FLUSH, obj, offset, len); |
826 | _osd_req_encode_flush(or, op); | |
827 | } | |
828 | EXPORT_SYMBOL(osd_req_flush_object); | |
829 | ||
02941a53 BH |
830 | void osd_req_read(struct osd_request *or, |
831 | const struct osd_obj_id *obj, struct bio *bio, u64 offset) | |
832 | { | |
833 | _osd_req_encode_common(or, OSD_ACT_READ, obj, offset, bio->bi_size); | |
834 | WARN_ON(or->in.bio || or->in.total_bytes); | |
835 | bio->bi_rw &= ~(1 << BIO_RW); | |
836 | or->in.bio = bio; | |
837 | or->in.total_bytes = bio->bi_size; | |
838 | } | |
839 | EXPORT_SYMBOL(osd_req_read); | |
840 | ||
0e35afbc BH |
841 | int osd_req_read_kern(struct osd_request *or, |
842 | const struct osd_obj_id *obj, u64 offset, void* buff, u64 len) | |
843 | { | |
844 | struct request_queue *req_q = or->osd_dev->scsi_device->request_queue; | |
845 | struct bio *bio = bio_map_kern(req_q, buff, len, GFP_KERNEL); | |
846 | ||
847 | if (IS_ERR(bio)) | |
848 | return PTR_ERR(bio); | |
849 | ||
850 | osd_req_read(or, obj, bio, offset); | |
851 | return 0; | |
852 | } | |
853 | EXPORT_SYMBOL(osd_req_read_kern); | |
854 | ||
4ef1a3d7 BH |
855 | void osd_req_get_attributes(struct osd_request *or, |
856 | const struct osd_obj_id *obj) | |
857 | { | |
858 | _osd_req_encode_common(or, OSD_ACT_GET_ATTRIBUTES, obj, 0, 0); | |
859 | } | |
860 | EXPORT_SYMBOL(osd_req_get_attributes); | |
861 | ||
862 | void osd_req_set_attributes(struct osd_request *or, | |
863 | const struct osd_obj_id *obj) | |
864 | { | |
865 | _osd_req_encode_common(or, OSD_ACT_SET_ATTRIBUTES, obj, 0, 0); | |
866 | } | |
867 | EXPORT_SYMBOL(osd_req_set_attributes); | |
868 | ||
869 | /* | |
870 | * Attributes List-mode | |
871 | */ | |
872 | ||
873 | int osd_req_add_set_attr_list(struct osd_request *or, | |
874 | const struct osd_attr *oa, unsigned nelem) | |
875 | { | |
876 | unsigned total_bytes = or->set_attr.total_bytes; | |
877 | void *attr_last; | |
878 | int ret; | |
879 | ||
880 | if (or->attributes_mode && | |
881 | or->attributes_mode != OSD_CDB_GET_SET_ATTR_LISTS) { | |
882 | WARN_ON(1); | |
883 | return -EINVAL; | |
884 | } | |
885 | or->attributes_mode = OSD_CDB_GET_SET_ATTR_LISTS; | |
886 | ||
887 | if (!total_bytes) { /* first-time: allocate and put list header */ | |
888 | total_bytes = _osd_req_sizeof_alist_header(or); | |
889 | ret = _alloc_set_attr_list(or, oa, nelem, total_bytes); | |
890 | if (ret) | |
891 | return ret; | |
892 | _osd_req_set_alist_type(or, or->set_attr.buff, | |
893 | OSD_ATTR_LIST_SET_RETRIEVE); | |
894 | } | |
895 | attr_last = or->set_attr.buff + total_bytes; | |
896 | ||
897 | for (; nelem; --nelem) { | |
4ef1a3d7 BH |
898 | unsigned elem_size = _osd_req_alist_elem_size(or, oa->len); |
899 | ||
900 | total_bytes += elem_size; | |
901 | if (unlikely(or->set_attr.alloc_size < total_bytes)) { | |
902 | or->set_attr.total_bytes = total_bytes - elem_size; | |
903 | ret = _alloc_set_attr_list(or, oa, nelem, total_bytes); | |
904 | if (ret) | |
905 | return ret; | |
906 | attr_last = | |
907 | or->set_attr.buff + or->set_attr.total_bytes; | |
908 | } | |
909 | ||
71f32e31 | 910 | _osd_req_alist_elem_encode(or, attr_last, oa); |
4ef1a3d7 BH |
911 | |
912 | attr_last += elem_size; | |
913 | ++oa; | |
914 | } | |
915 | ||
916 | or->set_attr.total_bytes = total_bytes; | |
917 | return 0; | |
918 | } | |
919 | EXPORT_SYMBOL(osd_req_add_set_attr_list); | |
920 | ||
921 | static int _append_map_kern(struct request *req, | |
922 | void *buff, unsigned len, gfp_t flags) | |
923 | { | |
924 | struct bio *bio; | |
925 | int ret; | |
926 | ||
927 | bio = bio_map_kern(req->q, buff, len, flags); | |
928 | if (IS_ERR(bio)) { | |
929 | OSD_ERR("Failed bio_map_kern(%p, %d) => %ld\n", buff, len, | |
930 | PTR_ERR(bio)); | |
931 | return PTR_ERR(bio); | |
932 | } | |
933 | ret = blk_rq_append_bio(req->q, req, bio); | |
934 | if (ret) { | |
935 | OSD_ERR("Failed blk_rq_append_bio(%p) => %d\n", bio, ret); | |
936 | bio_put(bio); | |
937 | } | |
938 | return ret; | |
939 | } | |
940 | ||
941 | static int _req_append_segment(struct osd_request *or, | |
942 | unsigned padding, struct _osd_req_data_segment *seg, | |
943 | struct _osd_req_data_segment *last_seg, struct _osd_io_info *io) | |
944 | { | |
945 | void *pad_buff; | |
946 | int ret; | |
947 | ||
948 | if (padding) { | |
949 | /* check if we can just add it to last buffer */ | |
950 | if (last_seg && | |
951 | (padding <= last_seg->alloc_size - last_seg->total_bytes)) | |
952 | pad_buff = last_seg->buff + last_seg->total_bytes; | |
953 | else | |
954 | pad_buff = io->pad_buff; | |
955 | ||
956 | ret = _append_map_kern(io->req, pad_buff, padding, | |
957 | or->alloc_flags); | |
958 | if (ret) | |
959 | return ret; | |
960 | io->total_bytes += padding; | |
961 | } | |
962 | ||
963 | ret = _append_map_kern(io->req, seg->buff, seg->total_bytes, | |
964 | or->alloc_flags); | |
965 | if (ret) | |
966 | return ret; | |
967 | ||
968 | io->total_bytes += seg->total_bytes; | |
969 | OSD_DEBUG("padding=%d buff=%p total_bytes=%d\n", padding, seg->buff, | |
970 | seg->total_bytes); | |
971 | return 0; | |
972 | } | |
973 | ||
974 | static int _osd_req_finalize_set_attr_list(struct osd_request *or) | |
975 | { | |
976 | struct osd_cdb_head *cdbh = osd_cdb_head(&or->cdb); | |
977 | unsigned padding; | |
978 | int ret; | |
979 | ||
980 | if (!or->set_attr.total_bytes) { | |
981 | cdbh->attrs_list.set_attr_offset = OSD_OFFSET_UNUSED; | |
982 | return 0; | |
983 | } | |
984 | ||
985 | cdbh->attrs_list.set_attr_bytes = cpu_to_be32(or->set_attr.total_bytes); | |
986 | cdbh->attrs_list.set_attr_offset = | |
987 | osd_req_encode_offset(or, or->out.total_bytes, &padding); | |
988 | ||
989 | ret = _req_append_segment(or, padding, &or->set_attr, | |
990 | or->out.last_seg, &or->out); | |
991 | if (ret) | |
992 | return ret; | |
993 | ||
994 | or->out.last_seg = &or->set_attr; | |
995 | return 0; | |
996 | } | |
997 | ||
998 | int osd_req_add_get_attr_list(struct osd_request *or, | |
999 | const struct osd_attr *oa, unsigned nelem) | |
1000 | { | |
1001 | unsigned total_bytes = or->enc_get_attr.total_bytes; | |
1002 | void *attr_last; | |
1003 | int ret; | |
1004 | ||
1005 | if (or->attributes_mode && | |
1006 | or->attributes_mode != OSD_CDB_GET_SET_ATTR_LISTS) { | |
1007 | WARN_ON(1); | |
1008 | return -EINVAL; | |
1009 | } | |
1010 | or->attributes_mode = OSD_CDB_GET_SET_ATTR_LISTS; | |
1011 | ||
1012 | /* first time calc data-in list header size */ | |
1013 | if (!or->get_attr.total_bytes) | |
1014 | or->get_attr.total_bytes = _osd_req_sizeof_alist_header(or); | |
1015 | ||
1016 | /* calc data-out info */ | |
1017 | if (!total_bytes) { /* first-time: allocate and put list header */ | |
1018 | unsigned max_bytes; | |
1019 | ||
1020 | total_bytes = _osd_req_sizeof_alist_header(or); | |
1021 | max_bytes = total_bytes + | |
1022 | nelem * sizeof(struct osd_attributes_list_attrid); | |
1023 | ret = _alloc_get_attr_desc(or, max_bytes); | |
1024 | if (ret) | |
1025 | return ret; | |
1026 | ||
1027 | _osd_req_set_alist_type(or, or->enc_get_attr.buff, | |
1028 | OSD_ATTR_LIST_GET); | |
1029 | } | |
1030 | attr_last = or->enc_get_attr.buff + total_bytes; | |
1031 | ||
1032 | for (; nelem; --nelem) { | |
1033 | struct osd_attributes_list_attrid *attrid; | |
1034 | const unsigned cur_size = sizeof(*attrid); | |
1035 | ||
1036 | total_bytes += cur_size; | |
1037 | if (unlikely(or->enc_get_attr.alloc_size < total_bytes)) { | |
1038 | or->enc_get_attr.total_bytes = total_bytes - cur_size; | |
1039 | ret = _alloc_get_attr_desc(or, | |
1040 | total_bytes + nelem * sizeof(*attrid)); | |
1041 | if (ret) | |
1042 | return ret; | |
1043 | attr_last = or->enc_get_attr.buff + | |
1044 | or->enc_get_attr.total_bytes; | |
1045 | } | |
1046 | ||
1047 | attrid = attr_last; | |
1048 | attrid->attr_page = cpu_to_be32(oa->attr_page); | |
1049 | attrid->attr_id = cpu_to_be32(oa->attr_id); | |
1050 | ||
1051 | attr_last += cur_size; | |
1052 | ||
1053 | /* calc data-in size */ | |
1054 | or->get_attr.total_bytes += | |
1055 | _osd_req_alist_elem_size(or, oa->len); | |
1056 | ++oa; | |
1057 | } | |
1058 | ||
1059 | or->enc_get_attr.total_bytes = total_bytes; | |
1060 | ||
1061 | OSD_DEBUG( | |
1062 | "get_attr.total_bytes=%u(%u) enc_get_attr.total_bytes=%u(%Zu)\n", | |
1063 | or->get_attr.total_bytes, | |
1064 | or->get_attr.total_bytes - _osd_req_sizeof_alist_header(or), | |
1065 | or->enc_get_attr.total_bytes, | |
1066 | (or->enc_get_attr.total_bytes - _osd_req_sizeof_alist_header(or)) | |
1067 | / sizeof(struct osd_attributes_list_attrid)); | |
1068 | ||
1069 | return 0; | |
1070 | } | |
1071 | EXPORT_SYMBOL(osd_req_add_get_attr_list); | |
1072 | ||
1073 | static int _osd_req_finalize_get_attr_list(struct osd_request *or) | |
1074 | { | |
1075 | struct osd_cdb_head *cdbh = osd_cdb_head(&or->cdb); | |
1076 | unsigned out_padding; | |
1077 | unsigned in_padding; | |
1078 | int ret; | |
1079 | ||
1080 | if (!or->enc_get_attr.total_bytes) { | |
1081 | cdbh->attrs_list.get_attr_desc_offset = OSD_OFFSET_UNUSED; | |
1082 | cdbh->attrs_list.get_attr_offset = OSD_OFFSET_UNUSED; | |
1083 | return 0; | |
1084 | } | |
1085 | ||
1086 | ret = _alloc_get_attr_list(or); | |
1087 | if (ret) | |
1088 | return ret; | |
1089 | ||
1090 | /* The out-going buffer info update */ | |
1091 | OSD_DEBUG("out-going\n"); | |
1092 | cdbh->attrs_list.get_attr_desc_bytes = | |
1093 | cpu_to_be32(or->enc_get_attr.total_bytes); | |
1094 | ||
1095 | cdbh->attrs_list.get_attr_desc_offset = | |
1096 | osd_req_encode_offset(or, or->out.total_bytes, &out_padding); | |
1097 | ||
1098 | ret = _req_append_segment(or, out_padding, &or->enc_get_attr, | |
1099 | or->out.last_seg, &or->out); | |
1100 | if (ret) | |
1101 | return ret; | |
1102 | or->out.last_seg = &or->enc_get_attr; | |
1103 | ||
1104 | /* The incoming buffer info update */ | |
1105 | OSD_DEBUG("in-coming\n"); | |
1106 | cdbh->attrs_list.get_attr_alloc_length = | |
1107 | cpu_to_be32(or->get_attr.total_bytes); | |
1108 | ||
1109 | cdbh->attrs_list.get_attr_offset = | |
1110 | osd_req_encode_offset(or, or->in.total_bytes, &in_padding); | |
1111 | ||
1112 | ret = _req_append_segment(or, in_padding, &or->get_attr, NULL, | |
1113 | &or->in); | |
1114 | if (ret) | |
1115 | return ret; | |
1116 | or->in.last_seg = &or->get_attr; | |
1117 | ||
1118 | return 0; | |
1119 | } | |
1120 | ||
1121 | int osd_req_decode_get_attr_list(struct osd_request *or, | |
1122 | struct osd_attr *oa, int *nelem, void **iterator) | |
1123 | { | |
1124 | unsigned cur_bytes, returned_bytes; | |
1125 | int n; | |
1126 | const unsigned sizeof_attr_list = _osd_req_sizeof_alist_header(or); | |
1127 | void *cur_p; | |
1128 | ||
1129 | if (!_osd_req_is_alist_type(or, or->get_attr.buff, | |
1130 | OSD_ATTR_LIST_SET_RETRIEVE)) { | |
1131 | oa->attr_page = 0; | |
1132 | oa->attr_id = 0; | |
1133 | oa->val_ptr = NULL; | |
1134 | oa->len = 0; | |
1135 | *iterator = NULL; | |
1136 | return 0; | |
1137 | } | |
1138 | ||
1139 | if (*iterator) { | |
1140 | BUG_ON((*iterator < or->get_attr.buff) || | |
1141 | (or->get_attr.buff + or->get_attr.alloc_size < *iterator)); | |
1142 | cur_p = *iterator; | |
1143 | cur_bytes = (*iterator - or->get_attr.buff) - sizeof_attr_list; | |
1144 | returned_bytes = or->get_attr.total_bytes; | |
1145 | } else { /* first time decode the list header */ | |
1146 | cur_bytes = sizeof_attr_list; | |
1147 | returned_bytes = _osd_req_alist_size(or, or->get_attr.buff) + | |
1148 | sizeof_attr_list; | |
1149 | ||
1150 | cur_p = or->get_attr.buff + sizeof_attr_list; | |
1151 | ||
1152 | if (returned_bytes > or->get_attr.alloc_size) { | |
1153 | OSD_DEBUG("target report: space was not big enough! " | |
1154 | "Allocate=%u Needed=%u\n", | |
1155 | or->get_attr.alloc_size, | |
1156 | returned_bytes + sizeof_attr_list); | |
1157 | ||
1158 | returned_bytes = | |
1159 | or->get_attr.alloc_size - sizeof_attr_list; | |
1160 | } | |
1161 | or->get_attr.total_bytes = returned_bytes; | |
1162 | } | |
1163 | ||
1164 | for (n = 0; (n < *nelem) && (cur_bytes < returned_bytes); ++n) { | |
71f32e31 BH |
1165 | int inc = _osd_req_alist_elem_decode(or, cur_p, oa, |
1166 | returned_bytes - cur_bytes); | |
4ef1a3d7 | 1167 | |
71f32e31 | 1168 | if (inc < 0) { |
4ef1a3d7 BH |
1169 | OSD_ERR("BAD FOOD from target. list not valid!" |
1170 | "c=%d r=%d n=%d\n", | |
1171 | cur_bytes, returned_bytes, n); | |
1172 | oa->val_ptr = NULL; | |
1173 | break; | |
1174 | } | |
1175 | ||
71f32e31 | 1176 | cur_bytes += inc; |
4ef1a3d7 BH |
1177 | cur_p += inc; |
1178 | ++oa; | |
1179 | } | |
1180 | ||
1181 | *iterator = (returned_bytes - cur_bytes) ? cur_p : NULL; | |
1182 | *nelem = n; | |
1183 | return returned_bytes - cur_bytes; | |
1184 | } | |
1185 | EXPORT_SYMBOL(osd_req_decode_get_attr_list); | |
1186 | ||
1187 | /* | |
1188 | * Attributes Page-mode | |
1189 | */ | |
1190 | ||
1191 | int osd_req_add_get_attr_page(struct osd_request *or, | |
1192 | u32 page_id, void *attar_page, unsigned max_page_len, | |
1193 | const struct osd_attr *set_one_attr) | |
1194 | { | |
1195 | struct osd_cdb_head *cdbh = osd_cdb_head(&or->cdb); | |
1196 | ||
1197 | if (or->attributes_mode && | |
1198 | or->attributes_mode != OSD_CDB_GET_ATTR_PAGE_SET_ONE) { | |
1199 | WARN_ON(1); | |
1200 | return -EINVAL; | |
1201 | } | |
1202 | or->attributes_mode = OSD_CDB_GET_ATTR_PAGE_SET_ONE; | |
1203 | ||
1204 | or->get_attr.buff = attar_page; | |
1205 | or->get_attr.total_bytes = max_page_len; | |
1206 | ||
1207 | or->set_attr.buff = set_one_attr->val_ptr; | |
1208 | or->set_attr.total_bytes = set_one_attr->len; | |
1209 | ||
1210 | cdbh->attrs_page.get_attr_page = cpu_to_be32(page_id); | |
1211 | cdbh->attrs_page.get_attr_alloc_length = cpu_to_be32(max_page_len); | |
1212 | /* ocdb->attrs_page.get_attr_offset; */ | |
1213 | ||
1214 | cdbh->attrs_page.set_attr_page = cpu_to_be32(set_one_attr->attr_page); | |
1215 | cdbh->attrs_page.set_attr_id = cpu_to_be32(set_one_attr->attr_id); | |
1216 | cdbh->attrs_page.set_attr_length = cpu_to_be32(set_one_attr->len); | |
1217 | /* ocdb->attrs_page.set_attr_offset; */ | |
1218 | return 0; | |
1219 | } | |
1220 | EXPORT_SYMBOL(osd_req_add_get_attr_page); | |
1221 | ||
1222 | static int _osd_req_finalize_attr_page(struct osd_request *or) | |
1223 | { | |
1224 | struct osd_cdb_head *cdbh = osd_cdb_head(&or->cdb); | |
1225 | unsigned in_padding, out_padding; | |
1226 | int ret; | |
1227 | ||
1228 | /* returned page */ | |
1229 | cdbh->attrs_page.get_attr_offset = | |
1230 | osd_req_encode_offset(or, or->in.total_bytes, &in_padding); | |
1231 | ||
1232 | ret = _req_append_segment(or, in_padding, &or->get_attr, NULL, | |
1233 | &or->in); | |
1234 | if (ret) | |
1235 | return ret; | |
1236 | ||
1237 | /* set one value */ | |
1238 | cdbh->attrs_page.set_attr_offset = | |
1239 | osd_req_encode_offset(or, or->out.total_bytes, &out_padding); | |
1240 | ||
1241 | ret = _req_append_segment(or, out_padding, &or->enc_get_attr, NULL, | |
1242 | &or->out); | |
1243 | return ret; | |
1244 | } | |
1245 | ||
f8d3a644 BH |
1246 | static inline void osd_sec_parms_set_out_offset(bool is_v1, |
1247 | struct osd_security_parameters *sec_parms, osd_cdb_offset offset) | |
1248 | { | |
1249 | if (is_v1) | |
1250 | sec_parms->v1.data_out_integrity_check_offset = offset; | |
1251 | else | |
1252 | sec_parms->v2.data_out_integrity_check_offset = offset; | |
1253 | } | |
1254 | ||
1255 | static inline void osd_sec_parms_set_in_offset(bool is_v1, | |
1256 | struct osd_security_parameters *sec_parms, osd_cdb_offset offset) | |
1257 | { | |
1258 | if (is_v1) | |
1259 | sec_parms->v1.data_in_integrity_check_offset = offset; | |
1260 | else | |
1261 | sec_parms->v2.data_in_integrity_check_offset = offset; | |
1262 | } | |
1263 | ||
345c435d | 1264 | static int _osd_req_finalize_data_integrity(struct osd_request *or, |
546881ae | 1265 | bool has_in, bool has_out, u64 out_data_bytes, const u8 *cap_key) |
345c435d BH |
1266 | { |
1267 | struct osd_security_parameters *sec_parms = _osd_req_sec_params(or); | |
1268 | int ret; | |
1269 | ||
1270 | if (!osd_is_sec_alldata(sec_parms)) | |
1271 | return 0; | |
1272 | ||
1273 | if (has_out) { | |
1274 | struct _osd_req_data_segment seg = { | |
1275 | .buff = &or->out_data_integ, | |
1276 | .total_bytes = sizeof(or->out_data_integ), | |
1277 | }; | |
1278 | unsigned pad; | |
1279 | ||
546881ae | 1280 | or->out_data_integ.data_bytes = cpu_to_be64(out_data_bytes); |
345c435d BH |
1281 | or->out_data_integ.set_attributes_bytes = cpu_to_be64( |
1282 | or->set_attr.total_bytes); | |
1283 | or->out_data_integ.get_attributes_bytes = cpu_to_be64( | |
1284 | or->enc_get_attr.total_bytes); | |
1285 | ||
f8d3a644 BH |
1286 | osd_sec_parms_set_out_offset(osd_req_is_ver1(or), sec_parms, |
1287 | osd_req_encode_offset(or, or->out.total_bytes, &pad)); | |
345c435d BH |
1288 | |
1289 | ret = _req_append_segment(or, pad, &seg, or->out.last_seg, | |
1290 | &or->out); | |
1291 | if (ret) | |
1292 | return ret; | |
1293 | or->out.last_seg = NULL; | |
1294 | ||
1295 | /* they are now all chained to request sign them all together */ | |
1296 | osd_sec_sign_data(&or->out_data_integ, or->out.req->bio, | |
1297 | cap_key); | |
1298 | } | |
1299 | ||
1300 | if (has_in) { | |
1301 | struct _osd_req_data_segment seg = { | |
1302 | .buff = &or->in_data_integ, | |
1303 | .total_bytes = sizeof(or->in_data_integ), | |
1304 | }; | |
1305 | unsigned pad; | |
1306 | ||
f8d3a644 BH |
1307 | osd_sec_parms_set_in_offset(osd_req_is_ver1(or), sec_parms, |
1308 | osd_req_encode_offset(or, or->in.total_bytes, &pad)); | |
345c435d BH |
1309 | |
1310 | ret = _req_append_segment(or, pad, &seg, or->in.last_seg, | |
1311 | &or->in); | |
1312 | if (ret) | |
1313 | return ret; | |
1314 | ||
1315 | or->in.last_seg = NULL; | |
1316 | } | |
1317 | ||
1318 | return 0; | |
1319 | } | |
1320 | ||
02941a53 BH |
1321 | /* |
1322 | * osd_finalize_request and helpers | |
1323 | */ | |
1324 | ||
1325 | static int _init_blk_request(struct osd_request *or, | |
1326 | bool has_in, bool has_out) | |
1327 | { | |
1328 | gfp_t flags = or->alloc_flags; | |
1329 | struct scsi_device *scsi_device = or->osd_dev->scsi_device; | |
1330 | struct request_queue *q = scsi_device->request_queue; | |
1331 | struct request *req; | |
1332 | int ret = -ENOMEM; | |
1333 | ||
1334 | req = blk_get_request(q, has_out, flags); | |
1335 | if (!req) | |
1336 | goto out; | |
1337 | ||
1338 | or->request = req; | |
1339 | req->cmd_type = REQ_TYPE_BLOCK_PC; | |
1340 | req->timeout = or->timeout; | |
1341 | req->retries = or->retries; | |
1342 | req->sense = or->sense; | |
1343 | req->sense_len = 0; | |
1344 | ||
1345 | if (has_out) { | |
1346 | or->out.req = req; | |
1347 | if (has_in) { | |
1348 | /* allocate bidi request */ | |
1349 | req = blk_get_request(q, READ, flags); | |
1350 | if (!req) { | |
1351 | OSD_DEBUG("blk_get_request for bidi failed\n"); | |
1352 | goto out; | |
1353 | } | |
1354 | req->cmd_type = REQ_TYPE_BLOCK_PC; | |
1355 | or->in.req = or->request->next_rq = req; | |
1356 | } | |
1357 | } else if (has_in) | |
1358 | or->in.req = req; | |
1359 | ||
1360 | ret = 0; | |
1361 | out: | |
1362 | OSD_DEBUG("or=%p has_in=%d has_out=%d => %d, %p\n", | |
1363 | or, has_in, has_out, ret, or->request); | |
1364 | return ret; | |
1365 | } | |
1366 | ||
1367 | int osd_finalize_request(struct osd_request *or, | |
1368 | u8 options, const void *cap, const u8 *cap_key) | |
1369 | { | |
1370 | struct osd_cdb_head *cdbh = osd_cdb_head(&or->cdb); | |
1371 | bool has_in, has_out; | |
546881ae | 1372 | u64 out_data_bytes = or->out.total_bytes; |
02941a53 BH |
1373 | int ret; |
1374 | ||
1375 | if (options & OSD_REQ_FUA) | |
1376 | cdbh->options |= OSD_CDB_FUA; | |
1377 | ||
1378 | if (options & OSD_REQ_DPO) | |
1379 | cdbh->options |= OSD_CDB_DPO; | |
1380 | ||
1381 | if (options & OSD_REQ_BYPASS_TIMESTAMPS) | |
1382 | cdbh->timestamp_control = OSD_CDB_BYPASS_TIMESTAMPS; | |
1383 | ||
1384 | osd_set_caps(&or->cdb, cap); | |
1385 | ||
1386 | has_in = or->in.bio || or->get_attr.total_bytes; | |
1387 | has_out = or->out.bio || or->set_attr.total_bytes || | |
1388 | or->enc_get_attr.total_bytes; | |
1389 | ||
1390 | ret = _init_blk_request(or, has_in, has_out); | |
1391 | if (ret) { | |
1392 | OSD_DEBUG("_init_blk_request failed\n"); | |
1393 | return ret; | |
1394 | } | |
1395 | ||
1396 | if (or->out.bio) { | |
1397 | ret = blk_rq_append_bio(or->request->q, or->out.req, | |
1398 | or->out.bio); | |
1399 | if (ret) { | |
1400 | OSD_DEBUG("blk_rq_append_bio out failed\n"); | |
1401 | return ret; | |
1402 | } | |
1403 | OSD_DEBUG("out bytes=%llu (bytes_req=%u)\n", | |
1404 | _LLU(or->out.total_bytes), or->out.req->data_len); | |
1405 | } | |
1406 | if (or->in.bio) { | |
1407 | ret = blk_rq_append_bio(or->request->q, or->in.req, or->in.bio); | |
1408 | if (ret) { | |
1409 | OSD_DEBUG("blk_rq_append_bio in failed\n"); | |
1410 | return ret; | |
1411 | } | |
1412 | OSD_DEBUG("in bytes=%llu (bytes_req=%u)\n", | |
1413 | _LLU(or->in.total_bytes), or->in.req->data_len); | |
1414 | } | |
1415 | ||
4ef1a3d7 BH |
1416 | or->out.pad_buff = sg_out_pad_buffer; |
1417 | or->in.pad_buff = sg_in_pad_buffer; | |
1418 | ||
02941a53 BH |
1419 | if (!or->attributes_mode) |
1420 | or->attributes_mode = OSD_CDB_GET_SET_ATTR_LISTS; | |
1421 | cdbh->command_specific_options |= or->attributes_mode; | |
4ef1a3d7 BH |
1422 | if (or->attributes_mode == OSD_CDB_GET_ATTR_PAGE_SET_ONE) { |
1423 | ret = _osd_req_finalize_attr_page(or); | |
1424 | } else { | |
1425 | /* TODO: I think that for the GET_ATTR command these 2 should | |
1426 | * be reversed to keep them in execution order (for embeded | |
1427 | * targets with low memory footprint) | |
1428 | */ | |
1429 | ret = _osd_req_finalize_set_attr_list(or); | |
1430 | if (ret) { | |
1431 | OSD_DEBUG("_osd_req_finalize_set_attr_list failed\n"); | |
1432 | return ret; | |
1433 | } | |
1434 | ||
1435 | ret = _osd_req_finalize_get_attr_list(or); | |
1436 | if (ret) { | |
1437 | OSD_DEBUG("_osd_req_finalize_get_attr_list failed\n"); | |
1438 | return ret; | |
1439 | } | |
1440 | } | |
02941a53 | 1441 | |
546881ae BH |
1442 | ret = _osd_req_finalize_data_integrity(or, has_in, has_out, |
1443 | out_data_bytes, cap_key); | |
345c435d BH |
1444 | if (ret) |
1445 | return ret; | |
1446 | ||
1447 | osd_sec_sign_cdb(&or->cdb, cap_key); | |
1448 | ||
02941a53 BH |
1449 | or->request->cmd = or->cdb.buff; |
1450 | or->request->cmd_len = _osd_req_cdb_len(or); | |
1451 | ||
1452 | return 0; | |
1453 | } | |
1454 | EXPORT_SYMBOL(osd_finalize_request); | |
1455 | ||
98f3aea2 BH |
1456 | #define OSD_SENSE_PRINT1(fmt, a...) \ |
1457 | do { \ | |
1458 | if (__cur_sense_need_output) \ | |
1459 | OSD_ERR(fmt, ##a); \ | |
1460 | } while (0) | |
1461 | ||
1462 | #define OSD_SENSE_PRINT2(fmt, a...) OSD_SENSE_PRINT1(" " fmt, ##a) | |
1463 | ||
1464 | int osd_req_decode_sense_full(struct osd_request *or, | |
1465 | struct osd_sense_info *osi, bool silent, | |
1466 | struct osd_obj_id *bad_obj_list __unused, int max_obj __unused, | |
1467 | struct osd_attr *bad_attr_list, int max_attr) | |
1468 | { | |
1469 | int sense_len, original_sense_len; | |
1470 | struct osd_sense_info local_osi; | |
1471 | struct scsi_sense_descriptor_based *ssdb; | |
1472 | void *cur_descriptor; | |
1473 | #if (CONFIG_SCSI_OSD_DPRINT_SENSE == 0) | |
1474 | const bool __cur_sense_need_output = false; | |
1475 | #else | |
1476 | bool __cur_sense_need_output = !silent; | |
1477 | #endif | |
1478 | ||
1479 | if (!or->request->errors) | |
1480 | return 0; | |
1481 | ||
1482 | ssdb = or->request->sense; | |
1483 | sense_len = or->request->sense_len; | |
1484 | if ((sense_len < (int)sizeof(*ssdb) || !ssdb->sense_key)) { | |
1485 | OSD_ERR("Block-layer returned error(0x%x) but " | |
1486 | "sense_len(%u) || key(%d) is empty\n", | |
1487 | or->request->errors, sense_len, ssdb->sense_key); | |
1488 | return -EIO; | |
1489 | } | |
1490 | ||
1491 | if ((ssdb->response_code != 0x72) && (ssdb->response_code != 0x73)) { | |
1492 | OSD_ERR("Unrecognized scsi sense: rcode=%x length=%d\n", | |
1493 | ssdb->response_code, sense_len); | |
1494 | return -EIO; | |
1495 | } | |
1496 | ||
1497 | osi = osi ? : &local_osi; | |
1498 | memset(osi, 0, sizeof(*osi)); | |
1499 | osi->key = ssdb->sense_key; | |
1500 | osi->additional_code = be16_to_cpu(ssdb->additional_sense_code); | |
1501 | original_sense_len = ssdb->additional_sense_length + 8; | |
1502 | ||
1503 | #if (CONFIG_SCSI_OSD_DPRINT_SENSE == 1) | |
1504 | if (__cur_sense_need_output) | |
1505 | __cur_sense_need_output = (osi->key > scsi_sk_recovered_error); | |
1506 | #endif | |
1507 | OSD_SENSE_PRINT1("Main Sense information key=0x%x length(%d, %d) " | |
1508 | "additional_code=0x%x\n", | |
1509 | osi->key, original_sense_len, sense_len, | |
1510 | osi->additional_code); | |
1511 | ||
1512 | if (original_sense_len < sense_len) | |
1513 | sense_len = original_sense_len; | |
1514 | ||
1515 | cur_descriptor = ssdb->ssd; | |
1516 | sense_len -= sizeof(*ssdb); | |
1517 | while (sense_len > 0) { | |
1518 | struct scsi_sense_descriptor *ssd = cur_descriptor; | |
1519 | int cur_len = ssd->additional_length + 2; | |
1520 | ||
1521 | sense_len -= cur_len; | |
1522 | ||
1523 | if (sense_len < 0) | |
1524 | break; /* sense was truncated */ | |
1525 | ||
1526 | switch (ssd->descriptor_type) { | |
1527 | case scsi_sense_information: | |
1528 | case scsi_sense_command_specific_information: | |
1529 | { | |
1530 | struct scsi_sense_command_specific_data_descriptor | |
1531 | *sscd = cur_descriptor; | |
1532 | ||
1533 | osi->command_info = | |
1534 | get_unaligned_be64(&sscd->information) ; | |
1535 | OSD_SENSE_PRINT2( | |
1536 | "command_specific_information 0x%llx \n", | |
1537 | _LLU(osi->command_info)); | |
1538 | break; | |
1539 | } | |
1540 | case scsi_sense_key_specific: | |
1541 | { | |
1542 | struct scsi_sense_key_specific_data_descriptor | |
1543 | *ssks = cur_descriptor; | |
1544 | ||
1545 | osi->sense_info = get_unaligned_be16(&ssks->value); | |
1546 | OSD_SENSE_PRINT2( | |
1547 | "sense_key_specific_information %u" | |
1548 | "sksv_cd_bpv_bp (0x%x)\n", | |
1549 | osi->sense_info, ssks->sksv_cd_bpv_bp); | |
1550 | break; | |
1551 | } | |
1552 | case osd_sense_object_identification: | |
1553 | { /*FIXME: Keep first not last, Store in array*/ | |
1554 | struct osd_sense_identification_data_descriptor | |
1555 | *osidd = cur_descriptor; | |
1556 | ||
1557 | osi->not_initiated_command_functions = | |
1558 | le32_to_cpu(osidd->not_initiated_functions); | |
1559 | osi->completed_command_functions = | |
1560 | le32_to_cpu(osidd->completed_functions); | |
1561 | osi->obj.partition = be64_to_cpu(osidd->partition_id); | |
1562 | osi->obj.id = be64_to_cpu(osidd->object_id); | |
1563 | OSD_SENSE_PRINT2( | |
1564 | "object_identification pid=0x%llx oid=0x%llx\n", | |
1565 | _LLU(osi->obj.partition), _LLU(osi->obj.id)); | |
1566 | OSD_SENSE_PRINT2( | |
1567 | "not_initiated_bits(%x) " | |
1568 | "completed_command_bits(%x)\n", | |
1569 | osi->not_initiated_command_functions, | |
1570 | osi->completed_command_functions); | |
1571 | break; | |
1572 | } | |
1573 | case osd_sense_response_integrity_check: | |
1574 | { | |
1575 | struct osd_sense_response_integrity_check_descriptor | |
1576 | *osricd = cur_descriptor; | |
1577 | const unsigned len = | |
1578 | sizeof(osricd->integrity_check_value); | |
1579 | char key_dump[len*4 + 2]; /* 2nibbles+space+ASCII */ | |
1580 | ||
1581 | hex_dump_to_buffer(osricd->integrity_check_value, len, | |
1582 | 32, 1, key_dump, sizeof(key_dump), true); | |
1583 | OSD_SENSE_PRINT2("response_integrity [%s]\n", key_dump); | |
1584 | } | |
1585 | case osd_sense_attribute_identification: | |
1586 | { | |
1587 | struct osd_sense_attributes_data_descriptor | |
1588 | *osadd = cur_descriptor; | |
1589 | int len = min(cur_len, sense_len); | |
1590 | int i = 0; | |
1591 | struct osd_sense_attr *pattr = osadd->sense_attrs; | |
1592 | ||
1593 | while (len < 0) { | |
1594 | u32 attr_page = be32_to_cpu(pattr->attr_page); | |
1595 | u32 attr_id = be32_to_cpu(pattr->attr_id); | |
1596 | ||
1597 | if (i++ == 0) { | |
1598 | osi->attr.attr_page = attr_page; | |
1599 | osi->attr.attr_id = attr_id; | |
1600 | } | |
1601 | ||
1602 | if (bad_attr_list && max_attr) { | |
1603 | bad_attr_list->attr_page = attr_page; | |
1604 | bad_attr_list->attr_id = attr_id; | |
1605 | bad_attr_list++; | |
1606 | max_attr--; | |
1607 | } | |
1608 | OSD_SENSE_PRINT2( | |
1609 | "osd_sense_attribute_identification" | |
1610 | "attr_page=0x%x attr_id=0x%x\n", | |
1611 | attr_page, attr_id); | |
1612 | } | |
1613 | } | |
1614 | /*These are not legal for OSD*/ | |
1615 | case scsi_sense_field_replaceable_unit: | |
1616 | OSD_SENSE_PRINT2("scsi_sense_field_replaceable_unit\n"); | |
1617 | break; | |
1618 | case scsi_sense_stream_commands: | |
1619 | OSD_SENSE_PRINT2("scsi_sense_stream_commands\n"); | |
1620 | break; | |
1621 | case scsi_sense_block_commands: | |
1622 | OSD_SENSE_PRINT2("scsi_sense_block_commands\n"); | |
1623 | break; | |
1624 | case scsi_sense_ata_return: | |
1625 | OSD_SENSE_PRINT2("scsi_sense_ata_return\n"); | |
1626 | break; | |
1627 | default: | |
1628 | if (ssd->descriptor_type <= scsi_sense_Reserved_last) | |
1629 | OSD_SENSE_PRINT2( | |
1630 | "scsi_sense Reserved descriptor (0x%x)", | |
1631 | ssd->descriptor_type); | |
1632 | else | |
1633 | OSD_SENSE_PRINT2( | |
1634 | "scsi_sense Vendor descriptor (0x%x)", | |
1635 | ssd->descriptor_type); | |
1636 | } | |
1637 | ||
1638 | cur_descriptor += cur_len; | |
1639 | } | |
1640 | ||
1641 | return (osi->key > scsi_sk_recovered_error) ? -EIO : 0; | |
1642 | } | |
1643 | EXPORT_SYMBOL(osd_req_decode_sense_full); | |
1644 | ||
02941a53 BH |
1645 | /* |
1646 | * Implementation of osd_sec.h API | |
1647 | * TODO: Move to a separate osd_sec.c file at a later stage. | |
1648 | */ | |
1649 | ||
1650 | enum { OSD_SEC_CAP_V1_ALL_CAPS = | |
1651 | OSD_SEC_CAP_APPEND | OSD_SEC_CAP_OBJ_MGMT | OSD_SEC_CAP_REMOVE | | |
1652 | OSD_SEC_CAP_CREATE | OSD_SEC_CAP_SET_ATTR | OSD_SEC_CAP_GET_ATTR | | |
1653 | OSD_SEC_CAP_WRITE | OSD_SEC_CAP_READ | OSD_SEC_CAP_POL_SEC | | |
1654 | OSD_SEC_CAP_GLOBAL | OSD_SEC_CAP_DEV_MGMT | |
1655 | }; | |
1656 | ||
c6572c98 BH |
1657 | enum { OSD_SEC_CAP_V2_ALL_CAPS = |
1658 | OSD_SEC_CAP_V1_ALL_CAPS | OSD_SEC_CAP_QUERY | OSD_SEC_CAP_M_OBJECT | |
1659 | }; | |
1660 | ||
02941a53 BH |
1661 | void osd_sec_init_nosec_doall_caps(void *caps, |
1662 | const struct osd_obj_id *obj, bool is_collection, const bool is_v1) | |
1663 | { | |
1664 | struct osd_capability *cap = caps; | |
1665 | u8 type; | |
1666 | u8 descriptor_type; | |
1667 | ||
1668 | if (likely(obj->id)) { | |
1669 | if (unlikely(is_collection)) { | |
1670 | type = OSD_SEC_OBJ_COLLECTION; | |
1671 | descriptor_type = is_v1 ? OSD_SEC_OBJ_DESC_OBJ : | |
1672 | OSD_SEC_OBJ_DESC_COL; | |
1673 | } else { | |
1674 | type = OSD_SEC_OBJ_USER; | |
1675 | descriptor_type = OSD_SEC_OBJ_DESC_OBJ; | |
1676 | } | |
1677 | WARN_ON(!obj->partition); | |
1678 | } else { | |
1679 | type = obj->partition ? OSD_SEC_OBJ_PARTITION : | |
1680 | OSD_SEC_OBJ_ROOT; | |
1681 | descriptor_type = OSD_SEC_OBJ_DESC_PAR; | |
1682 | } | |
1683 | ||
1684 | memset(cap, 0, sizeof(*cap)); | |
1685 | ||
1686 | cap->h.format = OSD_SEC_CAP_FORMAT_VER1; | |
1687 | cap->h.integrity_algorithm__key_version = 0; /* MAKE_BYTE(0, 0); */ | |
1688 | cap->h.security_method = OSD_SEC_NOSEC; | |
1689 | /* cap->expiration_time; | |
1690 | cap->AUDIT[30-10]; | |
1691 | cap->discriminator[42-30]; | |
1692 | cap->object_created_time; */ | |
1693 | cap->h.object_type = type; | |
1694 | osd_sec_set_caps(&cap->h, OSD_SEC_CAP_V1_ALL_CAPS); | |
1695 | cap->h.object_descriptor_type = descriptor_type; | |
1696 | cap->od.obj_desc.policy_access_tag = 0; | |
1697 | cap->od.obj_desc.allowed_partition_id = cpu_to_be64(obj->partition); | |
1698 | cap->od.obj_desc.allowed_object_id = cpu_to_be64(obj->id); | |
1699 | } | |
1700 | EXPORT_SYMBOL(osd_sec_init_nosec_doall_caps); | |
1701 | ||
c6572c98 BH |
1702 | /* FIXME: Extract version from caps pointer. |
1703 | * Also Pete's target only supports caps from OSDv1 for now | |
1704 | */ | |
02941a53 BH |
1705 | void osd_set_caps(struct osd_cdb *cdb, const void *caps) |
1706 | { | |
c6572c98 BH |
1707 | bool is_ver1 = true; |
1708 | /* NOTE: They start at same address */ | |
1709 | memcpy(&cdb->v1.caps, caps, is_ver1 ? OSDv1_CAP_LEN : OSD_CAP_LEN); | |
02941a53 | 1710 | } |
4ef1a3d7 | 1711 | |
345c435d BH |
1712 | bool osd_is_sec_alldata(struct osd_security_parameters *sec_parms __unused) |
1713 | { | |
1714 | return false; | |
1715 | } | |
1716 | ||
1717 | void osd_sec_sign_cdb(struct osd_cdb *ocdb __unused, const u8 *cap_key __unused) | |
1718 | { | |
1719 | } | |
1720 | ||
1721 | void osd_sec_sign_data(void *data_integ __unused, | |
1722 | struct bio *bio __unused, const u8 *cap_key __unused) | |
1723 | { | |
1724 | } | |
1725 | ||
4ef1a3d7 BH |
1726 | /* |
1727 | * Declared in osd_protocol.h | |
1728 | * 4.12.5 Data-In and Data-Out buffer offsets | |
1729 | * byte offset = mantissa * (2^(exponent+8)) | |
1730 | * Returns the smallest allowed encoded offset that contains given @offset | |
1731 | * The actual encoded offset returned is @offset + *@padding. | |
1732 | */ | |
1733 | osd_cdb_offset __osd_encode_offset( | |
1734 | u64 offset, unsigned *padding, int min_shift, int max_shift) | |
1735 | { | |
1736 | u64 try_offset = -1, mod, align; | |
1737 | osd_cdb_offset be32_offset; | |
1738 | int shift; | |
1739 | ||
1740 | *padding = 0; | |
1741 | if (!offset) | |
1742 | return 0; | |
1743 | ||
1744 | for (shift = min_shift; shift < max_shift; ++shift) { | |
1745 | try_offset = offset >> shift; | |
1746 | if (try_offset < (1 << OSD_OFFSET_MAX_BITS)) | |
1747 | break; | |
1748 | } | |
1749 | ||
1750 | BUG_ON(shift == max_shift); | |
1751 | ||
1752 | align = 1 << shift; | |
1753 | mod = offset & (align - 1); | |
1754 | if (mod) { | |
1755 | *padding = align - mod; | |
1756 | try_offset += 1; | |
1757 | } | |
1758 | ||
1759 | try_offset |= ((shift - 8) & 0xf) << 28; | |
1760 | be32_offset = cpu_to_be32((u32)try_offset); | |
1761 | ||
1762 | OSD_DEBUG("offset=%llu mantissa=%llu exp=%d encoded=%x pad=%d\n", | |
1763 | _LLU(offset), _LLU(try_offset & 0x0FFFFFFF), shift, | |
1764 | be32_offset, *padding); | |
1765 | return be32_offset; | |
1766 | } |