2 * Copyright (C) 2007 Krzysztof Halasa <khc@pm.waw.pl>
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms of version 2 of the GNU General Public License
6 * as published by the Free Software Foundation.
13 #include <linux/kernel.h>
17 #define HALF_QUEUES 32
19 #define MAX_QUEUE_LENGTH 4 /* in dwords */
21 #define QUEUE_STAT1_EMPTY 1 /* queue status bits */
22 #define QUEUE_STAT1_NEARLY_EMPTY 2
23 #define QUEUE_STAT1_NEARLY_FULL 4
24 #define QUEUE_STAT1_FULL 8
25 #define QUEUE_STAT2_UNDERFLOW 1
26 #define QUEUE_STAT2_OVERFLOW 2
28 #define QUEUE_WATERMARK_0_ENTRIES 0
29 #define QUEUE_WATERMARK_1_ENTRY 1
30 #define QUEUE_WATERMARK_2_ENTRIES 2
31 #define QUEUE_WATERMARK_4_ENTRIES 3
32 #define QUEUE_WATERMARK_8_ENTRIES 4
33 #define QUEUE_WATERMARK_16_ENTRIES 5
34 #define QUEUE_WATERMARK_32_ENTRIES 6
35 #define QUEUE_WATERMARK_64_ENTRIES 7
37 /* queue interrupt request conditions */
38 #define QUEUE_IRQ_SRC_EMPTY 0
39 #define QUEUE_IRQ_SRC_NEARLY_EMPTY 1
40 #define QUEUE_IRQ_SRC_NEARLY_FULL 2
41 #define QUEUE_IRQ_SRC_FULL 3
42 #define QUEUE_IRQ_SRC_NOT_EMPTY 4
43 #define QUEUE_IRQ_SRC_NOT_NEARLY_EMPTY 5
44 #define QUEUE_IRQ_SRC_NOT_NEARLY_FULL 6
45 #define QUEUE_IRQ_SRC_NOT_FULL 7
48 u32 acc[QUEUES][MAX_QUEUE_LENGTH]; /* 0x000 - 0x3FF */
49 u32 stat1[4]; /* 0x400 - 0x40F */
50 u32 stat2[2]; /* 0x410 - 0x417 */
51 u32 statne_h; /* 0x418 - queue nearly empty */
52 u32 statf_h; /* 0x41C - queue full */
53 u32 irqsrc[4]; /* 0x420 - 0x42F IRC source */
54 u32 irqen[2]; /* 0x430 - 0x437 IRQ enabled */
55 u32 irqstat[2]; /* 0x438 - 0x43F - IRQ access only */
57 u32 sram[2048]; /* 0x2000 - 0x3FFF - config and buffer */
60 void qmgr_set_irq(unsigned int queue, int src,
61 void (*handler)(void *pdev), void *pdev);
62 void qmgr_enable_irq(unsigned int queue);
63 void qmgr_disable_irq(unsigned int queue);
65 /* request_ and release_queue() must be called from non-IRQ context */
68 extern char qmgr_queue_descs[QUEUES][32];
70 int qmgr_request_queue(unsigned int queue, unsigned int len /* dwords */,
71 unsigned int nearly_empty_watermark,
72 unsigned int nearly_full_watermark,
73 const char *desc_format, const char* name);
75 int __qmgr_request_queue(unsigned int queue, unsigned int len /* dwords */,
76 unsigned int nearly_empty_watermark,
77 unsigned int nearly_full_watermark);
78 #define qmgr_request_queue(queue, len, nearly_empty_watermark, \
79 nearly_full_watermark, desc_format, name) \
80 __qmgr_request_queue(queue, len, nearly_empty_watermark, \
81 nearly_full_watermark)
84 void qmgr_release_queue(unsigned int queue);
87 static inline void qmgr_put_entry(unsigned int queue, u32 val)
89 extern struct qmgr_regs __iomem *qmgr_regs;
91 BUG_ON(!qmgr_queue_descs[queue]); /* not yet requested */
93 printk(KERN_DEBUG "Queue %s(%i) put %X\n",
94 qmgr_queue_descs[queue], queue, val);
96 __raw_writel(val, &qmgr_regs->acc[queue][0]);
99 static inline u32 qmgr_get_entry(unsigned int queue)
102 extern struct qmgr_regs __iomem *qmgr_regs;
103 val = __raw_readl(&qmgr_regs->acc[queue][0]);
105 BUG_ON(!qmgr_queue_descs[queue]); /* not yet requested */
107 printk(KERN_DEBUG "Queue %s(%i) get %X\n",
108 qmgr_queue_descs[queue], queue, val);
113 static inline int __qmgr_get_stat1(unsigned int queue)
115 extern struct qmgr_regs __iomem *qmgr_regs;
116 return (__raw_readl(&qmgr_regs->stat1[queue >> 3])
117 >> ((queue & 7) << 2)) & 0xF;
120 static inline int __qmgr_get_stat2(unsigned int queue)
122 extern struct qmgr_regs __iomem *qmgr_regs;
123 BUG_ON(queue >= HALF_QUEUES);
124 return (__raw_readl(&qmgr_regs->stat2[queue >> 4])
125 >> ((queue & 0xF) << 1)) & 0x3;
129 * qmgr_stat_empty() - checks if a hardware queue is empty
130 * @queue: queue number
132 * Returns non-zero value if the queue is empty.
134 static inline int qmgr_stat_empty(unsigned int queue)
136 BUG_ON(queue >= HALF_QUEUES);
137 return __qmgr_get_stat1(queue) & QUEUE_STAT1_EMPTY;
141 * qmgr_stat_below_low_watermark() - checks if a queue is below low watermark
142 * @queue: queue number
144 * Returns non-zero value if the queue is below low watermark.
146 static inline int qmgr_stat_below_low_watermark(unsigned int queue)
148 extern struct qmgr_regs __iomem *qmgr_regs;
149 if (queue >= HALF_QUEUES)
150 return (__raw_readl(&qmgr_regs->statne_h) >>
151 (queue - HALF_QUEUES)) & 0x01;
152 return __qmgr_get_stat1(queue) & QUEUE_STAT1_NEARLY_EMPTY;
156 * qmgr_stat_above_high_watermark() - checks if a queue is above high watermark
157 * @queue: queue number
159 * Returns non-zero value if the queue is above high watermark
161 static inline int qmgr_stat_above_high_watermark(unsigned int queue)
163 BUG_ON(queue >= HALF_QUEUES);
164 return __qmgr_get_stat1(queue) & QUEUE_STAT1_NEARLY_FULL;
168 * qmgr_stat_full() - checks if a hardware queue is full
169 * @queue: queue number
171 * Returns non-zero value if the queue is full.
173 static inline int qmgr_stat_full(unsigned int queue)
175 extern struct qmgr_regs __iomem *qmgr_regs;
176 if (queue >= HALF_QUEUES)
177 return (__raw_readl(&qmgr_regs->statf_h) >>
178 (queue - HALF_QUEUES)) & 0x01;
179 return __qmgr_get_stat1(queue) & QUEUE_STAT1_FULL;
183 * qmgr_stat_underflow() - checks if a hardware queue experienced underflow
184 * @queue: queue number
186 * Returns non-zero value if the queue experienced underflow.
188 static inline int qmgr_stat_underflow(unsigned int queue)
190 return __qmgr_get_stat2(queue) & QUEUE_STAT2_UNDERFLOW;
194 * qmgr_stat_overflow() - checks if a hardware queue experienced overflow
195 * @queue: queue number
197 * Returns non-zero value if the queue experienced overflow.
199 static inline int qmgr_stat_overflow(unsigned int queue)
201 return __qmgr_get_stat2(queue) & QUEUE_STAT2_OVERFLOW;