Merge git://git.kernel.org/pub/scm/linux/kernel/git/sfrench/cifs-2.6
[linux-2.6] / drivers / infiniband / hw / amso1100 / c2_mq.c
1 /*
2  * Copyright (c) 2005 Ammasso, Inc. 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 #include "c2.h"
34 #include "c2_mq.h"
35
36 void *c2_mq_alloc(struct c2_mq *q)
37 {
38         BUG_ON(q->magic != C2_MQ_MAGIC);
39         BUG_ON(q->type != C2_MQ_ADAPTER_TARGET);
40
41         if (c2_mq_full(q)) {
42                 return NULL;
43         } else {
44 #ifdef DEBUG
45                 struct c2wr_hdr *m =
46                     (struct c2wr_hdr *) (q->msg_pool.host + q->priv * q->msg_size);
47 #ifdef CCMSGMAGIC
48                 BUG_ON(m->magic != be32_to_cpu(~CCWR_MAGIC));
49                 m->magic = cpu_to_be32(CCWR_MAGIC);
50 #endif
51                 return m;
52 #else
53                 return q->msg_pool.host + q->priv * q->msg_size;
54 #endif
55         }
56 }
57
58 void c2_mq_produce(struct c2_mq *q)
59 {
60         BUG_ON(q->magic != C2_MQ_MAGIC);
61         BUG_ON(q->type != C2_MQ_ADAPTER_TARGET);
62
63         if (!c2_mq_full(q)) {
64                 q->priv = (q->priv + 1) % q->q_size;
65                 q->hint_count++;
66                 /* Update peer's offset. */
67                 __raw_writew(cpu_to_be16(q->priv), &q->peer->shared);
68         }
69 }
70
71 void *c2_mq_consume(struct c2_mq *q)
72 {
73         BUG_ON(q->magic != C2_MQ_MAGIC);
74         BUG_ON(q->type != C2_MQ_HOST_TARGET);
75
76         if (c2_mq_empty(q)) {
77                 return NULL;
78         } else {
79 #ifdef DEBUG
80                 struct c2wr_hdr *m = (struct c2wr_hdr *)
81                     (q->msg_pool.host + q->priv * q->msg_size);
82 #ifdef CCMSGMAGIC
83                 BUG_ON(m->magic != be32_to_cpu(CCWR_MAGIC));
84 #endif
85                 return m;
86 #else
87                 return q->msg_pool.host + q->priv * q->msg_size;
88 #endif
89         }
90 }
91
92 void c2_mq_free(struct c2_mq *q)
93 {
94         BUG_ON(q->magic != C2_MQ_MAGIC);
95         BUG_ON(q->type != C2_MQ_HOST_TARGET);
96
97         if (!c2_mq_empty(q)) {
98
99 #ifdef CCMSGMAGIC
100                 {
101                         struct c2wr_hdr __iomem *m = (struct c2wr_hdr __iomem *)
102                             (q->msg_pool.adapter + q->priv * q->msg_size);
103                         __raw_writel(cpu_to_be32(~CCWR_MAGIC), &m->magic);
104                 }
105 #endif
106                 q->priv = (q->priv + 1) % q->q_size;
107                 /* Update peer's offset. */
108                 __raw_writew(cpu_to_be16(q->priv), &q->peer->shared);
109         }
110 }
111
112
113 void c2_mq_lconsume(struct c2_mq *q, u32 wqe_count)
114 {
115         BUG_ON(q->magic != C2_MQ_MAGIC);
116         BUG_ON(q->type != C2_MQ_ADAPTER_TARGET);
117
118         while (wqe_count--) {
119                 BUG_ON(c2_mq_empty(q));
120                 *q->shared = cpu_to_be16((be16_to_cpu(*q->shared)+1) % q->q_size);
121         }
122 }
123
124 #if 0
125 u32 c2_mq_count(struct c2_mq *q)
126 {
127         s32 count;
128
129         if (q->type == C2_MQ_HOST_TARGET)
130                 count = be16_to_cpu(*q->shared) - q->priv;
131         else
132                 count = q->priv - be16_to_cpu(*q->shared);
133
134         if (count < 0)
135                 count += q->q_size;
136
137         return (u32) count;
138 }
139 #endif  /*  0  */
140
141 void c2_mq_req_init(struct c2_mq *q, u32 index, u32 q_size, u32 msg_size,
142                     u8 __iomem *pool_start, u16 __iomem *peer, u32 type)
143 {
144         BUG_ON(!q->shared);
145
146         /* This code assumes the byte swapping has already been done! */
147         q->index = index;
148         q->q_size = q_size;
149         q->msg_size = msg_size;
150         q->msg_pool.adapter = pool_start;
151         q->peer = (struct c2_mq_shared __iomem *) peer;
152         q->magic = C2_MQ_MAGIC;
153         q->type = type;
154         q->priv = 0;
155         q->hint_count = 0;
156         return;
157 }
158 void c2_mq_rep_init(struct c2_mq *q, u32 index, u32 q_size, u32 msg_size,
159                     u8 *pool_start, u16 __iomem *peer, u32 type)
160 {
161         BUG_ON(!q->shared);
162
163         /* This code assumes the byte swapping has already been done! */
164         q->index = index;
165         q->q_size = q_size;
166         q->msg_size = msg_size;
167         q->msg_pool.host = pool_start;
168         q->peer = (struct c2_mq_shared __iomem *) peer;
169         q->magic = C2_MQ_MAGIC;
170         q->type = type;
171         q->priv = 0;
172         q->hint_count = 0;
173         return;
174 }