]> Pileus Git - ~andy/linux/blob - drivers/infiniband/ulp/iser/iser_initiator.c
622e9857c86913899b3e1ad1e8be01a84686ca92
[~andy/linux] / drivers / infiniband / ulp / iser / iser_initiator.c
1 /*
2  * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32 #include <linux/kernel.h>
33 #include <linux/slab.h>
34 #include <linux/mm.h>
35 #include <linux/scatterlist.h>
36 #include <linux/kfifo.h>
37 #include <scsi/scsi_cmnd.h>
38 #include <scsi/scsi_host.h>
39
40 #include "iscsi_iser.h"
41
42 /* Register user buffer memory and initialize passive rdma
43  *  dto descriptor. Total data size is stored in
44  *  iser_task->data[ISER_DIR_IN].data_len
45  */
46 static int iser_prepare_read_cmd(struct iscsi_task *task,
47                                  unsigned int edtl)
48
49 {
50         struct iscsi_iser_task *iser_task = task->dd_data;
51         struct iser_regd_buf *regd_buf;
52         int err;
53         struct iser_hdr *hdr = &iser_task->desc.iser_header;
54         struct iser_data_buf *buf_in = &iser_task->data[ISER_DIR_IN];
55
56         err = iser_dma_map_task_data(iser_task,
57                                      buf_in,
58                                      ISER_DIR_IN,
59                                      DMA_FROM_DEVICE);
60         if (err)
61                 return err;
62
63         if (edtl > iser_task->data[ISER_DIR_IN].data_len) {
64                 iser_err("Total data length: %ld, less than EDTL: "
65                          "%d, in READ cmd BHS itt: %d, conn: 0x%p\n",
66                          iser_task->data[ISER_DIR_IN].data_len, edtl,
67                          task->itt, iser_task->iser_conn);
68                 return -EINVAL;
69         }
70
71         err = iser_reg_rdma_mem(iser_task,ISER_DIR_IN);
72         if (err) {
73                 iser_err("Failed to set up Data-IN RDMA\n");
74                 return err;
75         }
76         regd_buf = &iser_task->rdma_regd[ISER_DIR_IN];
77
78         hdr->flags    |= ISER_RSV;
79         hdr->read_stag = cpu_to_be32(regd_buf->reg.rkey);
80         hdr->read_va   = cpu_to_be64(regd_buf->reg.va);
81
82         iser_dbg("Cmd itt:%d READ tags RKEY:%#.4X VA:%#llX\n",
83                  task->itt, regd_buf->reg.rkey,
84                  (unsigned long long)regd_buf->reg.va);
85
86         return 0;
87 }
88
89 /* Register user buffer memory and initialize passive rdma
90  *  dto descriptor. Total data size is stored in
91  *  task->data[ISER_DIR_OUT].data_len
92  */
93 static int
94 iser_prepare_write_cmd(struct iscsi_task *task,
95                        unsigned int imm_sz,
96                        unsigned int unsol_sz,
97                        unsigned int edtl)
98 {
99         struct iscsi_iser_task *iser_task = task->dd_data;
100         struct iser_regd_buf *regd_buf;
101         int err;
102         struct iser_hdr *hdr = &iser_task->desc.iser_header;
103         struct iser_data_buf *buf_out = &iser_task->data[ISER_DIR_OUT];
104         struct ib_sge *tx_dsg = &iser_task->desc.tx_sg[1];
105
106         err = iser_dma_map_task_data(iser_task,
107                                      buf_out,
108                                      ISER_DIR_OUT,
109                                      DMA_TO_DEVICE);
110         if (err)
111                 return err;
112
113         if (edtl > iser_task->data[ISER_DIR_OUT].data_len) {
114                 iser_err("Total data length: %ld, less than EDTL: %d, "
115                          "in WRITE cmd BHS itt: %d, conn: 0x%p\n",
116                          iser_task->data[ISER_DIR_OUT].data_len,
117                          edtl, task->itt, task->conn);
118                 return -EINVAL;
119         }
120
121         err = iser_reg_rdma_mem(iser_task,ISER_DIR_OUT);
122         if (err != 0) {
123                 iser_err("Failed to register write cmd RDMA mem\n");
124                 return err;
125         }
126
127         regd_buf = &iser_task->rdma_regd[ISER_DIR_OUT];
128
129         if (unsol_sz < edtl) {
130                 hdr->flags     |= ISER_WSV;
131                 hdr->write_stag = cpu_to_be32(regd_buf->reg.rkey);
132                 hdr->write_va   = cpu_to_be64(regd_buf->reg.va + unsol_sz);
133
134                 iser_dbg("Cmd itt:%d, WRITE tags, RKEY:%#.4X "
135                          "VA:%#llX + unsol:%d\n",
136                          task->itt, regd_buf->reg.rkey,
137                          (unsigned long long)regd_buf->reg.va, unsol_sz);
138         }
139
140         if (imm_sz > 0) {
141                 iser_dbg("Cmd itt:%d, WRITE, adding imm.data sz: %d\n",
142                          task->itt, imm_sz);
143                 tx_dsg->addr   = regd_buf->reg.va;
144                 tx_dsg->length = imm_sz;
145                 tx_dsg->lkey   = regd_buf->reg.lkey;
146                 iser_task->desc.num_sge = 2;
147         }
148
149         return 0;
150 }
151
152 /* creates a new tx descriptor and adds header regd buffer */
153 static void iser_create_send_desc(struct iser_conn      *ib_conn,
154                                   struct iser_tx_desc   *tx_desc)
155 {
156         struct iser_device *device = ib_conn->device;
157
158         ib_dma_sync_single_for_cpu(device->ib_device,
159                 tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
160
161         memset(&tx_desc->iser_header, 0, sizeof(struct iser_hdr));
162         tx_desc->iser_header.flags = ISER_VER;
163
164         tx_desc->num_sge = 1;
165
166         if (tx_desc->tx_sg[0].lkey != device->mr->lkey) {
167                 tx_desc->tx_sg[0].lkey = device->mr->lkey;
168                 iser_dbg("sdesc %p lkey mismatch, fixing\n", tx_desc);
169         }
170 }
171
172
173 static int iser_alloc_rx_descriptors(struct iser_conn *ib_conn)
174 {
175         int i, j;
176         u64 dma_addr;
177         struct iser_rx_desc *rx_desc;
178         struct ib_sge       *rx_sg;
179         struct iser_device  *device = ib_conn->device;
180
181         ib_conn->rx_descs = kmalloc(ISER_QP_MAX_RECV_DTOS *
182                                 sizeof(struct iser_rx_desc), GFP_KERNEL);
183         if (!ib_conn->rx_descs)
184                 goto rx_desc_alloc_fail;
185
186         rx_desc = ib_conn->rx_descs;
187
188         for (i = 0; i < ISER_QP_MAX_RECV_DTOS; i++, rx_desc++)  {
189                 dma_addr = ib_dma_map_single(device->ib_device, (void *)rx_desc,
190                                         ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
191                 if (ib_dma_mapping_error(device->ib_device, dma_addr))
192                         goto rx_desc_dma_map_failed;
193
194                 rx_desc->dma_addr = dma_addr;
195
196                 rx_sg = &rx_desc->rx_sg;
197                 rx_sg->addr   = rx_desc->dma_addr;
198                 rx_sg->length = ISER_RX_PAYLOAD_SIZE;
199                 rx_sg->lkey   = device->mr->lkey;
200         }
201
202         ib_conn->rx_desc_head = 0;
203         return 0;
204
205 rx_desc_dma_map_failed:
206         rx_desc = ib_conn->rx_descs;
207         for (j = 0; j < i; j++, rx_desc++)
208                 ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
209                         ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
210         kfree(ib_conn->rx_descs);
211         ib_conn->rx_descs = NULL;
212 rx_desc_alloc_fail:
213         iser_err("failed allocating rx descriptors / data buffers\n");
214         return -ENOMEM;
215 }
216
217 void iser_free_rx_descriptors(struct iser_conn *ib_conn)
218 {
219         int i;
220         struct iser_rx_desc *rx_desc;
221         struct iser_device *device = ib_conn->device;
222
223         if (!ib_conn->rx_descs)
224                 return;
225
226         rx_desc = ib_conn->rx_descs;
227         for (i = 0; i < ISER_QP_MAX_RECV_DTOS; i++, rx_desc++)
228                 ib_dma_unmap_single(device->ib_device, rx_desc->dma_addr,
229                         ISER_RX_PAYLOAD_SIZE, DMA_FROM_DEVICE);
230         kfree(ib_conn->rx_descs);
231 }
232
233 /**
234  *  iser_conn_set_full_featured_mode - (iSER API)
235  */
236 int iser_conn_set_full_featured_mode(struct iscsi_conn *conn)
237 {
238         struct iscsi_iser_conn *iser_conn = conn->dd_data;
239
240         iser_dbg("Initially post: %d\n", ISER_MIN_POSTED_RX);
241
242         /* Check that there is no posted recv or send buffers left - */
243         /* they must be consumed during the login phase */
244         BUG_ON(iser_conn->ib_conn->post_recv_buf_count != 0);
245         BUG_ON(atomic_read(&iser_conn->ib_conn->post_send_buf_count) != 0);
246
247         if (iser_alloc_rx_descriptors(iser_conn->ib_conn))
248                 return -ENOMEM;
249
250         /* Initial post receive buffers */
251         if (iser_post_recvm(iser_conn->ib_conn, ISER_MIN_POSTED_RX))
252                 return -ENOMEM;
253
254         return 0;
255 }
256
257 /**
258  * iser_send_command - send command PDU
259  */
260 int iser_send_command(struct iscsi_conn *conn,
261                       struct iscsi_task *task)
262 {
263         struct iscsi_iser_conn *iser_conn = conn->dd_data;
264         struct iscsi_iser_task *iser_task = task->dd_data;
265         unsigned long edtl;
266         int err;
267         struct iser_data_buf *data_buf;
268         struct iscsi_scsi_req *hdr = (struct iscsi_scsi_req *)task->hdr;
269         struct scsi_cmnd *sc  =  task->sc;
270         struct iser_tx_desc *tx_desc = &iser_task->desc;
271
272         edtl = ntohl(hdr->data_length);
273
274         /* build the tx desc regd header and add it to the tx desc dto */
275         tx_desc->type = ISCSI_TX_SCSI_COMMAND;
276         iser_create_send_desc(iser_conn->ib_conn, tx_desc);
277
278         if (hdr->flags & ISCSI_FLAG_CMD_READ)
279                 data_buf = &iser_task->data[ISER_DIR_IN];
280         else
281                 data_buf = &iser_task->data[ISER_DIR_OUT];
282
283         if (scsi_sg_count(sc)) { /* using a scatter list */
284                 data_buf->buf  = scsi_sglist(sc);
285                 data_buf->size = scsi_sg_count(sc);
286         }
287
288         data_buf->data_len = scsi_bufflen(sc);
289
290         if (hdr->flags & ISCSI_FLAG_CMD_READ) {
291                 err = iser_prepare_read_cmd(task, edtl);
292                 if (err)
293                         goto send_command_error;
294         }
295         if (hdr->flags & ISCSI_FLAG_CMD_WRITE) {
296                 err = iser_prepare_write_cmd(task,
297                                              task->imm_count,
298                                              task->imm_count +
299                                              task->unsol_r2t.data_length,
300                                              edtl);
301                 if (err)
302                         goto send_command_error;
303         }
304
305         iser_task->status = ISER_TASK_STATUS_STARTED;
306
307         err = iser_post_send(iser_conn->ib_conn, tx_desc);
308         if (!err)
309                 return 0;
310
311 send_command_error:
312         iser_err("conn %p failed task->itt %d err %d\n",conn, task->itt, err);
313         return err;
314 }
315
316 /**
317  * iser_send_data_out - send data out PDU
318  */
319 int iser_send_data_out(struct iscsi_conn *conn,
320                        struct iscsi_task *task,
321                        struct iscsi_data *hdr)
322 {
323         struct iscsi_iser_conn *iser_conn = conn->dd_data;
324         struct iscsi_iser_task *iser_task = task->dd_data;
325         struct iser_tx_desc *tx_desc = NULL;
326         struct iser_regd_buf *regd_buf;
327         unsigned long buf_offset;
328         unsigned long data_seg_len;
329         uint32_t itt;
330         int err = 0;
331         struct ib_sge *tx_dsg;
332
333         itt = (__force uint32_t)hdr->itt;
334         data_seg_len = ntoh24(hdr->dlength);
335         buf_offset   = ntohl(hdr->offset);
336
337         iser_dbg("%s itt %d dseg_len %d offset %d\n",
338                  __func__,(int)itt,(int)data_seg_len,(int)buf_offset);
339
340         tx_desc = kmem_cache_zalloc(ig.desc_cache, GFP_ATOMIC);
341         if (tx_desc == NULL) {
342                 iser_err("Failed to alloc desc for post dataout\n");
343                 return -ENOMEM;
344         }
345
346         tx_desc->type = ISCSI_TX_DATAOUT;
347         tx_desc->iser_header.flags = ISER_VER;
348         memcpy(&tx_desc->iscsi_header, hdr, sizeof(struct iscsi_hdr));
349
350         /* build the tx desc */
351         iser_initialize_task_headers(task, tx_desc);
352
353         regd_buf = &iser_task->rdma_regd[ISER_DIR_OUT];
354         tx_dsg = &tx_desc->tx_sg[1];
355         tx_dsg->addr    = regd_buf->reg.va + buf_offset;
356         tx_dsg->length  = data_seg_len;
357         tx_dsg->lkey    = regd_buf->reg.lkey;
358         tx_desc->num_sge = 2;
359
360         if (buf_offset + data_seg_len > iser_task->data[ISER_DIR_OUT].data_len) {
361                 iser_err("Offset:%ld & DSL:%ld in Data-Out "
362                          "inconsistent with total len:%ld, itt:%d\n",
363                          buf_offset, data_seg_len,
364                          iser_task->data[ISER_DIR_OUT].data_len, itt);
365                 err = -EINVAL;
366                 goto send_data_out_error;
367         }
368         iser_dbg("data-out itt: %d, offset: %ld, sz: %ld\n",
369                  itt, buf_offset, data_seg_len);
370
371
372         err = iser_post_send(iser_conn->ib_conn, tx_desc);
373         if (!err)
374                 return 0;
375
376 send_data_out_error:
377         kmem_cache_free(ig.desc_cache, tx_desc);
378         iser_err("conn %p failed err %d\n",conn, err);
379         return err;
380 }
381
382 int iser_send_control(struct iscsi_conn *conn,
383                       struct iscsi_task *task)
384 {
385         struct iscsi_iser_conn *iser_conn = conn->dd_data;
386         struct iscsi_iser_task *iser_task = task->dd_data;
387         struct iser_tx_desc *mdesc = &iser_task->desc;
388         unsigned long data_seg_len;
389         int err = 0;
390         struct iser_device *device;
391         struct iser_conn *ib_conn = iser_conn->ib_conn;
392
393         /* build the tx desc regd header and add it to the tx desc dto */
394         mdesc->type = ISCSI_TX_CONTROL;
395         iser_create_send_desc(iser_conn->ib_conn, mdesc);
396
397         device = iser_conn->ib_conn->device;
398
399         data_seg_len = ntoh24(task->hdr->dlength);
400
401         if (data_seg_len > 0) {
402                 struct ib_sge *tx_dsg = &mdesc->tx_sg[1];
403                 if (task != conn->login_task) {
404                         iser_err("data present on non login task!!!\n");
405                         goto send_control_error;
406                 }
407
408                 ib_dma_sync_single_for_cpu(device->ib_device,
409                         ib_conn->login_req_dma, task->data_count,
410                         DMA_TO_DEVICE);
411
412                 memcpy(iser_conn->ib_conn->login_req_buf, task->data,
413                                                         task->data_count);
414
415                 ib_dma_sync_single_for_device(device->ib_device,
416                         ib_conn->login_req_dma, task->data_count,
417                         DMA_TO_DEVICE);
418
419                 tx_dsg->addr    = iser_conn->ib_conn->login_req_dma;
420                 tx_dsg->length  = task->data_count;
421                 tx_dsg->lkey    = device->mr->lkey;
422                 mdesc->num_sge = 2;
423         }
424
425         if (task == conn->login_task) {
426                 err = iser_post_recvl(iser_conn->ib_conn);
427                 if (err)
428                         goto send_control_error;
429         }
430
431         err = iser_post_send(iser_conn->ib_conn, mdesc);
432         if (!err)
433                 return 0;
434
435 send_control_error:
436         iser_err("conn %p failed err %d\n",conn, err);
437         return err;
438 }
439
440 /**
441  * iser_rcv_dto_completion - recv DTO completion
442  */
443 void iser_rcv_completion(struct iser_rx_desc *rx_desc,
444                          unsigned long rx_xfer_len,
445                          struct iser_conn *ib_conn)
446 {
447         struct iscsi_iser_conn *conn = ib_conn->iser_conn;
448         struct iscsi_hdr *hdr;
449         u64 rx_dma;
450         int rx_buflen, outstanding, count, err;
451
452         /* differentiate between login to all other PDUs */
453         if ((char *)rx_desc == ib_conn->login_resp_buf) {
454                 rx_dma = ib_conn->login_resp_dma;
455                 rx_buflen = ISER_RX_LOGIN_SIZE;
456         } else {
457                 rx_dma = rx_desc->dma_addr;
458                 rx_buflen = ISER_RX_PAYLOAD_SIZE;
459         }
460
461         ib_dma_sync_single_for_cpu(ib_conn->device->ib_device, rx_dma,
462                         rx_buflen, DMA_FROM_DEVICE);
463
464         hdr = &rx_desc->iscsi_header;
465
466         iser_dbg("op 0x%x itt 0x%x dlen %d\n", hdr->opcode,
467                         hdr->itt, (int)(rx_xfer_len - ISER_HEADERS_LEN));
468
469         iscsi_iser_recv(conn->iscsi_conn, hdr,
470                 rx_desc->data, rx_xfer_len - ISER_HEADERS_LEN);
471
472         ib_dma_sync_single_for_device(ib_conn->device->ib_device, rx_dma,
473                         rx_buflen, DMA_FROM_DEVICE);
474
475         /* decrementing conn->post_recv_buf_count only --after-- freeing the   *
476          * task eliminates the need to worry on tasks which are completed in   *
477          * parallel to the execution of iser_conn_term. So the code that waits *
478          * for the posted rx bufs refcount to become zero handles everything   */
479         conn->ib_conn->post_recv_buf_count--;
480
481         if (rx_dma == ib_conn->login_resp_dma)
482                 return;
483
484         outstanding = ib_conn->post_recv_buf_count;
485         if (outstanding + ISER_MIN_POSTED_RX <= ISER_QP_MAX_RECV_DTOS) {
486                 count = min(ISER_QP_MAX_RECV_DTOS - outstanding,
487                                                 ISER_MIN_POSTED_RX);
488                 err = iser_post_recvm(ib_conn, count);
489                 if (err)
490                         iser_err("posting %d rx bufs err %d\n", count, err);
491         }
492 }
493
494 void iser_snd_completion(struct iser_tx_desc *tx_desc,
495                         struct iser_conn *ib_conn)
496 {
497         struct iscsi_task *task;
498         struct iser_device *device = ib_conn->device;
499
500         if (tx_desc->type == ISCSI_TX_DATAOUT) {
501                 ib_dma_unmap_single(device->ib_device, tx_desc->dma_addr,
502                                         ISER_HEADERS_LEN, DMA_TO_DEVICE);
503                 kmem_cache_free(ig.desc_cache, tx_desc);
504         }
505
506         atomic_dec(&ib_conn->post_send_buf_count);
507
508         if (tx_desc->type == ISCSI_TX_CONTROL) {
509                 /* this arithmetic is legal by libiscsi dd_data allocation */
510                 task = (void *) ((long)(void *)tx_desc -
511                                   sizeof(struct iscsi_task));
512                 if (task->hdr->itt == RESERVED_ITT)
513                         iscsi_put_task(task);
514         }
515 }
516
517 void iser_task_rdma_init(struct iscsi_iser_task *iser_task)
518
519 {
520         iser_task->status = ISER_TASK_STATUS_INIT;
521
522         iser_task->dir[ISER_DIR_IN] = 0;
523         iser_task->dir[ISER_DIR_OUT] = 0;
524
525         iser_task->data[ISER_DIR_IN].data_len  = 0;
526         iser_task->data[ISER_DIR_OUT].data_len = 0;
527
528         memset(&iser_task->rdma_regd[ISER_DIR_IN], 0,
529                sizeof(struct iser_regd_buf));
530         memset(&iser_task->rdma_regd[ISER_DIR_OUT], 0,
531                sizeof(struct iser_regd_buf));
532 }
533
534 void iser_task_rdma_finalize(struct iscsi_iser_task *iser_task)
535 {
536         int is_rdma_aligned = 1;
537         struct iser_regd_buf *regd;
538
539         /* if we were reading, copy back to unaligned sglist,
540          * anyway dma_unmap and free the copy
541          */
542         if (iser_task->data_copy[ISER_DIR_IN].copy_buf != NULL) {
543                 is_rdma_aligned = 0;
544                 iser_finalize_rdma_unaligned_sg(iser_task, ISER_DIR_IN);
545         }
546         if (iser_task->data_copy[ISER_DIR_OUT].copy_buf != NULL) {
547                 is_rdma_aligned = 0;
548                 iser_finalize_rdma_unaligned_sg(iser_task, ISER_DIR_OUT);
549         }
550
551         if (iser_task->dir[ISER_DIR_IN]) {
552                 regd = &iser_task->rdma_regd[ISER_DIR_IN];
553                 if (regd->reg.is_fmr)
554                         iser_unreg_mem(&regd->reg);
555         }
556
557         if (iser_task->dir[ISER_DIR_OUT]) {
558                 regd = &iser_task->rdma_regd[ISER_DIR_OUT];
559                 if (regd->reg.is_fmr)
560                         iser_unreg_mem(&regd->reg);
561         }
562
563        /* if the data was unaligned, it was already unmapped and then copied */
564        if (is_rdma_aligned)
565                 iser_dma_unmap_task_data(iser_task);
566 }