Commit | Line | Data |
---|---|---|
80ff0fd3 DD |
1 | /********************************************************************** |
2 | * Author: Cavium Networks | |
3 | * | |
4 | * Contact: support@caviumnetworks.com | |
5 | * This file is part of the OCTEON SDK | |
6 | * | |
7 | * Copyright (c) 2003-2007 Cavium Networks | |
8 | * | |
9 | * This file is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License, Version 2, as | |
11 | * published by the Free Software Foundation. | |
12 | * | |
13 | * This file is distributed in the hope that it will be useful, but | |
14 | * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty | |
15 | * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or | |
16 | * NONINFRINGEMENT. See the GNU General Public License for more | |
17 | * details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this file; if not, write to the Free Software | |
21 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | |
22 | * or visit http://www.gnu.org/licenses/. | |
23 | * | |
24 | * This file may also be available under a different license from Cavium. | |
25 | * Contact Cavium Networks for more information | |
26 | **********************************************************************/ | |
27 | #include <linux/kernel.h> | |
28 | #include <linux/netdevice.h> | |
29 | #include <linux/mii.h> | |
30 | #include <net/dst.h> | |
31 | ||
32 | #include <asm/octeon/octeon.h> | |
33 | ||
34 | #include "ethernet-defines.h" | |
35 | ||
36 | #include "cvmx-fpa.h" | |
37 | ||
38 | /** | |
39 | * Fill the supplied hardware pool with skbuffs | |
40 | * | |
41 | * @pool: Pool to allocate an skbuff for | |
42 | * @size: Size of the buffer needed for the pool | |
43 | * @elements: Number of buffers to allocate | |
44 | */ | |
45 | static int cvm_oct_fill_hw_skbuff(int pool, int size, int elements) | |
46 | { | |
47 | int freed = elements; | |
48 | while (freed) { | |
49 | ||
50 | struct sk_buff *skb = dev_alloc_skb(size + 128); | |
51 | if (unlikely(skb == NULL)) { | |
52 | pr_warning | |
53 | ("Failed to allocate skb for hardware pool %d\n", | |
54 | pool); | |
55 | break; | |
56 | } | |
57 | ||
58 | skb_reserve(skb, 128 - (((unsigned long)skb->data) & 0x7f)); | |
59 | *(struct sk_buff **)(skb->data - sizeof(void *)) = skb; | |
60 | cvmx_fpa_free(skb->data, pool, DONT_WRITEBACK(size / 128)); | |
61 | freed--; | |
62 | } | |
63 | return elements - freed; | |
64 | } | |
65 | ||
66 | /** | |
67 | * Free the supplied hardware pool of skbuffs | |
68 | * | |
69 | * @pool: Pool to allocate an skbuff for | |
70 | * @size: Size of the buffer needed for the pool | |
71 | * @elements: Number of buffers to allocate | |
72 | */ | |
73 | static void cvm_oct_free_hw_skbuff(int pool, int size, int elements) | |
74 | { | |
75 | char *memory; | |
76 | ||
77 | do { | |
78 | memory = cvmx_fpa_alloc(pool); | |
79 | if (memory) { | |
80 | struct sk_buff *skb = | |
81 | *(struct sk_buff **)(memory - sizeof(void *)); | |
82 | elements--; | |
83 | dev_kfree_skb(skb); | |
84 | } | |
85 | } while (memory); | |
86 | ||
87 | if (elements < 0) | |
88 | pr_warning("Freeing of pool %u had too many skbuffs (%d)\n", | |
89 | pool, elements); | |
90 | else if (elements > 0) | |
91 | pr_warning("Freeing of pool %u is missing %d skbuffs\n", | |
92 | pool, elements); | |
93 | } | |
94 | ||
95 | /** | |
96 | * This function fills a hardware pool with memory. Depending | |
97 | * on the config defines, this memory might come from the | |
98 | * kernel or global 32bit memory allocated with | |
99 | * cvmx_bootmem_alloc. | |
100 | * | |
101 | * @pool: Pool to populate | |
102 | * @size: Size of each buffer in the pool | |
103 | * @elements: Number of buffers to allocate | |
104 | */ | |
105 | static int cvm_oct_fill_hw_memory(int pool, int size, int elements) | |
106 | { | |
107 | char *memory; | |
108 | int freed = elements; | |
109 | ||
110 | if (USE_32BIT_SHARED) { | |
111 | extern uint64_t octeon_reserve32_memory; | |
112 | ||
113 | memory = | |
114 | cvmx_bootmem_alloc_range(elements * size, 128, | |
115 | octeon_reserve32_memory, | |
116 | octeon_reserve32_memory + | |
117 | (CONFIG_CAVIUM_RESERVE32 << 20) - | |
118 | 1); | |
119 | if (memory == NULL) | |
120 | panic("Unable to allocate %u bytes for FPA pool %d\n", | |
121 | elements * size, pool); | |
122 | ||
123 | pr_notice("Memory range %p - %p reserved for " | |
124 | "hardware\n", memory, | |
125 | memory + elements * size - 1); | |
126 | ||
127 | while (freed) { | |
128 | cvmx_fpa_free(memory, pool, 0); | |
129 | memory += size; | |
130 | freed--; | |
131 | } | |
132 | } else { | |
133 | while (freed) { | |
134 | /* We need to force alignment to 128 bytes here */ | |
135 | memory = kmalloc(size + 127, GFP_ATOMIC); | |
136 | if (unlikely(memory == NULL)) { | |
137 | pr_warning("Unable to allocate %u bytes for " | |
138 | "FPA pool %d\n", | |
139 | elements * size, pool); | |
140 | break; | |
141 | } | |
142 | memory = (char *)(((unsigned long)memory + 127) & -128); | |
143 | cvmx_fpa_free(memory, pool, 0); | |
144 | freed--; | |
145 | } | |
146 | } | |
147 | return elements - freed; | |
148 | } | |
149 | ||
150 | /** | |
151 | * Free memory previously allocated with cvm_oct_fill_hw_memory | |
152 | * | |
153 | * @pool: FPA pool to free | |
154 | * @size: Size of each buffer in the pool | |
155 | * @elements: Number of buffers that should be in the pool | |
156 | */ | |
157 | static void cvm_oct_free_hw_memory(int pool, int size, int elements) | |
158 | { | |
159 | if (USE_32BIT_SHARED) { | |
160 | pr_warning("Warning: 32 shared memory is not freeable\n"); | |
161 | } else { | |
162 | char *memory; | |
163 | do { | |
164 | memory = cvmx_fpa_alloc(pool); | |
165 | if (memory) { | |
166 | elements--; | |
167 | kfree(phys_to_virt(cvmx_ptr_to_phys(memory))); | |
168 | } | |
169 | } while (memory); | |
170 | ||
171 | if (elements < 0) | |
172 | pr_warning("Freeing of pool %u had too many " | |
173 | "buffers (%d)\n", | |
174 | pool, elements); | |
175 | else if (elements > 0) | |
176 | pr_warning("Warning: Freeing of pool %u is " | |
177 | "missing %d buffers\n", | |
178 | pool, elements); | |
179 | } | |
180 | } | |
181 | ||
182 | int cvm_oct_mem_fill_fpa(int pool, int size, int elements) | |
183 | { | |
184 | int freed; | |
185 | if (USE_SKBUFFS_IN_HW) | |
186 | freed = cvm_oct_fill_hw_skbuff(pool, size, elements); | |
187 | else | |
188 | freed = cvm_oct_fill_hw_memory(pool, size, elements); | |
189 | return freed; | |
190 | } | |
191 | ||
192 | void cvm_oct_mem_empty_fpa(int pool, int size, int elements) | |
193 | { | |
194 | if (USE_SKBUFFS_IN_HW) | |
195 | cvm_oct_free_hw_skbuff(pool, size, elements); | |
196 | else | |
197 | cvm_oct_free_hw_memory(pool, size, elements); | |
198 | } |