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