git.oblomov.eu Git - linux-2.6/blob - drivers/infiniband/hw/amso1100/c2_alloc.c

   1 /*
   2  * Copyright (c) 2004 Topspin Communications.  All rights reserved.
   3  * Copyright (c) 2005 Open Grid Computing, Inc. All rights reserved.
   4  *
   5  * This software is available to you under a choice of one of two
   6  * licenses.  You may choose to be licensed under the terms of the GNU
   7  * General Public License (GPL) Version 2, available from the file
   8  * COPYING in the main directory of this source tree, or the
   9  * OpenIB.org BSD license below:
  10  *
  11  *     Redistribution and use in source and binary forms, with or
  12  *     without modification, are permitted provided that the following
  13  *     conditions are met:
  14  *
  15  *      - Redistributions of source code must retain the above
  16  *        copyright notice, this list of conditions and the following
  17  *        disclaimer.
  18  *
  19  *      - Redistributions in binary form must reproduce the above
  20  *        copyright notice, this list of conditions and the following
  21  *        disclaimer in the documentation and/or other materials
  22  *        provided with the distribution.
  23  *
  24  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31  * SOFTWARE.
  32  */
  33
  34 #include <linux/errno.h>
  35 #include <linux/slab.h>
  36 #include <linux/bitmap.h>
  37
  38 #include "c2.h"
  39
  40 static int c2_alloc_mqsp_chunk(struct c2_dev *c2dev, gfp_t gfp_mask,
  41                                struct sp_chunk **head)
  42 {
  43         int i;
  44         struct sp_chunk *new_head;
  45
  46         new_head = (struct sp_chunk *) __get_free_page(gfp_mask);
  47         if (new_head == NULL)
  48                 return -ENOMEM;
  49
  50         new_head->dma_addr = dma_map_single(c2dev->ibdev.dma_device, new_head,
  51                                             PAGE_SIZE, DMA_FROM_DEVICE);
  52         pci_unmap_addr_set(new_head, mapping, new_head->dma_addr);
  53
  54         new_head->next = NULL;
  55         new_head->head = 0;
  56
  57         /* build list where each index is the next free slot */
  58         for (i = 0;
  59              i < (PAGE_SIZE - sizeof(struct sp_chunk) -
  60                   sizeof(u16)) / sizeof(u16) - 1;
  61              i++) {
  62                 new_head->shared_ptr[i] = i + 1;
  63         }
  64         /* terminate list */
  65         new_head->shared_ptr[i] = 0xFFFF;
  66
  67         *head = new_head;
  68         return 0;
  69 }
  70
  71 int c2_init_mqsp_pool(struct c2_dev *c2dev, gfp_t gfp_mask,
  72                       struct sp_chunk **root)
  73 {
  74         return c2_alloc_mqsp_chunk(c2dev, gfp_mask, root);
  75 }
  76
  77 void c2_free_mqsp_pool(struct c2_dev *c2dev, struct sp_chunk *root)
  78 {
  79         struct sp_chunk *next;
  80
  81         while (root) {
  82                 next = root->next;
  83                 dma_unmap_single(c2dev->ibdev.dma_device,
  84                                  pci_unmap_addr(root, mapping), PAGE_SIZE,
  85                                  DMA_FROM_DEVICE);
  86                 __free_page((struct page *) root);
  87                 root = next;
  88         }
  89 }
  90
  91 u16 *c2_alloc_mqsp(struct c2_dev *c2dev, struct sp_chunk *head,
  92                    dma_addr_t *dma_addr, gfp_t gfp_mask)
  93 {
  94         u16 mqsp;
  95
  96         while (head) {
  97                 mqsp = head->head;
  98                 if (mqsp != 0xFFFF) {
  99                         head->head = head->shared_ptr[mqsp];
 100                         break;
 101                 } else if (head->next == NULL) {
 102                         if (c2_alloc_mqsp_chunk(c2dev, gfp_mask, &head->next) ==
 103                             0) {
 104                                 head = head->next;
 105                                 mqsp = head->head;
 106                                 head->head = head->shared_ptr[mqsp];
 107                                 break;
 108                         } else
 109                                 return NULL;
 110                 } else
 111                         head = head->next;
 112         }
 113         if (head) {
 114                 *dma_addr = head->dma_addr +
 115                             ((unsigned long) &(head->shared_ptr[mqsp]) -
 116                              (unsigned long) head);
 117                 pr_debug("%s addr %p dma_addr %llx\n", __FUNCTION__,
 118                          &(head->shared_ptr[mqsp]), (unsigned long long) *dma_addr);
 119                 return &(head->shared_ptr[mqsp]);
 120         }
 121         return NULL;
 122 }
 123
 124 void c2_free_mqsp(u16 * mqsp)
 125 {
 126         struct sp_chunk *head;
 127         u16 idx;
 128
 129         /* The chunk containing this ptr begins at the page boundary */
 130         head = (struct sp_chunk *) ((unsigned long) mqsp & PAGE_MASK);
 131
 132         /* Link head to new mqsp */
 133         *mqsp = head->head;
 134
 135         /* Compute the shared_ptr index */
 136         idx = ((unsigned long) mqsp & ~PAGE_MASK) >> 1;
 137         idx -= (unsigned long) &(((struct sp_chunk *) 0)->shared_ptr[0]) >> 1;
 138
 139         /* Point this index at the head */
 140         head->shared_ptr[idx] = head->head;
 141
 142         /* Point head at this index */
 143         head->head = idx;
 144 }