1 /***********************license start***************
2 * Author: Cavium Networks
3 *
4 * Contact: support@caviumnetworks.com
5 * This file is part of the OCTEON SDK
6 *
7 * Copyright (c) 2003-2008 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 ***********************license end**************************************/
27
28 /*
29 * Simple allocate only memory allocator. Used to allocate memory at
30 * application start time.
31 */
32
33 #include <linux/export.h>
34 #include <linux/kernel.h>
35
36 #include <asm/octeon/cvmx.h>
37 #include <asm/octeon/cvmx-spinlock.h>
38 #include <asm/octeon/cvmx-bootmem.h>
39
40 /*#define DEBUG */
41
42
43 static struct cvmx_bootmem_desc *cvmx_bootmem_desc;
44
45 /* See header file for descriptions of functions */
46
47 /**
48 * This macro returns the size of a member of a structure.
49 * Logically it is the same as "sizeof(s::field)" in C++, but
50 * C lacks the "::" operator.
51 */
52 #define SIZEOF_FIELD(s, field) sizeof(((s *)NULL)->field)
53
54 /**
55 * This macro returns a member of the
56 * cvmx_bootmem_named_block_desc_t structure. These members can't
57 * be directly addressed as they might be in memory not directly
58 * reachable. In the case where bootmem is compiled with
59 * LINUX_HOST, the structure itself might be located on a remote
60 * Octeon. The argument "field" is the member name of the
61 * cvmx_bootmem_named_block_desc_t to read. Regardless of the type
62 * of the field, the return type is always a uint64_t. The "addr"
63 * parameter is the physical address of the structure.
64 */
65 #define CVMX_BOOTMEM_NAMED_GET_FIELD(addr, field) \
66 __cvmx_bootmem_desc_get(addr, \
67 offsetof(struct cvmx_bootmem_named_block_desc, field), \
68 SIZEOF_FIELD(struct cvmx_bootmem_named_block_desc, field))
69
70 /**
71 * This function is the implementation of the get macros defined
72 * for individual structure members. The argument are generated
73 * by the macros inorder to read only the needed memory.
74 *
75 * @param base 64bit physical address of the complete structure
76 * @param offset Offset from the beginning of the structure to the member being
77 * accessed.
78 * @param size Size of the structure member.
79 *
80 * @return Value of the structure member promoted into a uint64_t.
81 */
__cvmx_bootmem_desc_get(uint64_t base,int offset,int size)82 static inline uint64_t __cvmx_bootmem_desc_get(uint64_t base, int offset,
83 int size)
84 {
85 base = (1ull << 63) | (base + offset);
86 switch (size) {
87 case 4:
88 return cvmx_read64_uint32(base);
89 case 8:
90 return cvmx_read64_uint64(base);
91 default:
92 return 0;
93 }
94 }
95
96 /*
97 * Wrapper functions are provided for reading/writing the size and
98 * next block values as these may not be directly addressible (in 32
99 * bit applications, for instance.) Offsets of data elements in
100 * bootmem list, must match cvmx_bootmem_block_header_t.
101 */
102 #define NEXT_OFFSET 0
103 #define SIZE_OFFSET 8
104
cvmx_bootmem_phy_set_size(uint64_t addr,uint64_t size)105 static void cvmx_bootmem_phy_set_size(uint64_t addr, uint64_t size)
106 {
107 cvmx_write64_uint64((addr + SIZE_OFFSET) | (1ull << 63), size);
108 }
109
cvmx_bootmem_phy_set_next(uint64_t addr,uint64_t next)110 static void cvmx_bootmem_phy_set_next(uint64_t addr, uint64_t next)
111 {
112 cvmx_write64_uint64((addr + NEXT_OFFSET) | (1ull << 63), next);
113 }
114
cvmx_bootmem_phy_get_size(uint64_t addr)115 static uint64_t cvmx_bootmem_phy_get_size(uint64_t addr)
116 {
117 return cvmx_read64_uint64((addr + SIZE_OFFSET) | (1ull << 63));
118 }
119
cvmx_bootmem_phy_get_next(uint64_t addr)120 static uint64_t cvmx_bootmem_phy_get_next(uint64_t addr)
121 {
122 return cvmx_read64_uint64((addr + NEXT_OFFSET) | (1ull << 63));
123 }
124
125 /**
126 * Allocate a block of memory from the free list that was
127 * passed to the application by the bootloader within a specified
128 * address range. This is an allocate-only algorithm, so
129 * freeing memory is not possible. Allocation will fail if
130 * memory cannot be allocated in the requested range.
131 *
132 * @size: Size in bytes of block to allocate
133 * @min_addr: defines the minimum address of the range
134 * @max_addr: defines the maximum address of the range
135 * @alignment: Alignment required - must be power of 2
136 * Returns pointer to block of memory, NULL on error
137 */
cvmx_bootmem_alloc_range(uint64_t size,uint64_t alignment,uint64_t min_addr,uint64_t max_addr)138 static void *cvmx_bootmem_alloc_range(uint64_t size, uint64_t alignment,
139 uint64_t min_addr, uint64_t max_addr)
140 {
141 int64_t address;
142 address =
143 cvmx_bootmem_phy_alloc(size, min_addr, max_addr, alignment, 0);
144
145 if (address > 0)
146 return cvmx_phys_to_ptr(address);
147 else
148 return NULL;
149 }
150
cvmx_bootmem_alloc_address(uint64_t size,uint64_t address,uint64_t alignment)151 void *cvmx_bootmem_alloc_address(uint64_t size, uint64_t address,
152 uint64_t alignment)
153 {
154 return cvmx_bootmem_alloc_range(size, alignment, address,
155 address + size);
156 }
157
cvmx_bootmem_alloc_named_range(uint64_t size,uint64_t min_addr,uint64_t max_addr,uint64_t align,char * name)158 void *cvmx_bootmem_alloc_named_range(uint64_t size, uint64_t min_addr,
159 uint64_t max_addr, uint64_t align,
160 char *name)
161 {
162 int64_t addr;
163
164 addr = cvmx_bootmem_phy_named_block_alloc(size, min_addr, max_addr,
165 align, name, 0);
166 if (addr >= 0)
167 return cvmx_phys_to_ptr(addr);
168 else
169 return NULL;
170 }
171
cvmx_bootmem_alloc_named(uint64_t size,uint64_t alignment,char * name)172 void *cvmx_bootmem_alloc_named(uint64_t size, uint64_t alignment, char *name)
173 {
174 return cvmx_bootmem_alloc_named_range(size, 0, 0, alignment, name);
175 }
176 EXPORT_SYMBOL(cvmx_bootmem_alloc_named);
177
cvmx_bootmem_lock(void)178 void cvmx_bootmem_lock(void)
179 {
180 cvmx_spinlock_lock((cvmx_spinlock_t *) &(cvmx_bootmem_desc->lock));
181 }
182
cvmx_bootmem_unlock(void)183 void cvmx_bootmem_unlock(void)
184 {
185 cvmx_spinlock_unlock((cvmx_spinlock_t *) &(cvmx_bootmem_desc->lock));
186 }
187
cvmx_bootmem_init(void * mem_desc_ptr)188 int cvmx_bootmem_init(void *mem_desc_ptr)
189 {
190 /* Here we set the global pointer to the bootmem descriptor
191 * block. This pointer will be used directly, so we will set
192 * it up to be directly usable by the application. It is set
193 * up as follows for the various runtime/ABI combinations:
194 *
195 * Linux 64 bit: Set XKPHYS bit
196 * Linux 32 bit: use mmap to create mapping, use virtual address
197 * CVMX 64 bit: use physical address directly
198 * CVMX 32 bit: use physical address directly
199 *
200 * Note that the CVMX environment assumes the use of 1-1 TLB
201 * mappings so that the physical addresses can be used
202 * directly
203 */
204 if (!cvmx_bootmem_desc) {
205 #if defined(CVMX_ABI_64)
206 /* Set XKPHYS bit */
207 cvmx_bootmem_desc = cvmx_phys_to_ptr(CAST64(mem_desc_ptr));
208 #else
209 cvmx_bootmem_desc = (struct cvmx_bootmem_desc *) mem_desc_ptr;
210 #endif
211 }
212
213 return 0;
214 }
215
216 /*
217 * The cvmx_bootmem_phy* functions below return 64 bit physical
218 * addresses, and expose more features that the cvmx_bootmem_functions
219 * above. These are required for full memory space access in 32 bit
220 * applications, as well as for using some advance features. Most
221 * applications should not need to use these.
222 */
223
cvmx_bootmem_phy_alloc(uint64_t req_size,uint64_t address_min,uint64_t address_max,uint64_t alignment,uint32_t flags)224 int64_t cvmx_bootmem_phy_alloc(uint64_t req_size, uint64_t address_min,
225 uint64_t address_max, uint64_t alignment,
226 uint32_t flags)
227 {
228
229 uint64_t head_addr;
230 uint64_t ent_addr;
231 /* points to previous list entry, NULL current entry is head of list */
232 uint64_t prev_addr = 0;
233 uint64_t new_ent_addr = 0;
234 uint64_t desired_min_addr;
235
236 #ifdef DEBUG
237 cvmx_dprintf("cvmx_bootmem_phy_alloc: req_size: 0x%llx, "
238 "min_addr: 0x%llx, max_addr: 0x%llx, align: 0x%llx\n",
239 (unsigned long long)req_size,
240 (unsigned long long)address_min,
241 (unsigned long long)address_max,
242 (unsigned long long)alignment);
243 #endif
244
245 if (cvmx_bootmem_desc->major_version > 3) {
246 cvmx_dprintf("ERROR: Incompatible bootmem descriptor "
247 "version: %d.%d at addr: %p\n",
248 (int)cvmx_bootmem_desc->major_version,
249 (int)cvmx_bootmem_desc->minor_version,
250 cvmx_bootmem_desc);
251 goto error_out;
252 }
253
254 /*
255 * Do a variety of checks to validate the arguments. The
256 * allocator code will later assume that these checks have
257 * been made. We validate that the requested constraints are
258 * not self-contradictory before we look through the list of
259 * available memory.
260 */
261
262 /* 0 is not a valid req_size for this allocator */
263 if (!req_size)
264 goto error_out;
265
266 /* Round req_size up to mult of minimum alignment bytes */
267 req_size = (req_size + (CVMX_BOOTMEM_ALIGNMENT_SIZE - 1)) &
268 ~(CVMX_BOOTMEM_ALIGNMENT_SIZE - 1);
269
270 /*
271 * Convert !0 address_min and 0 address_max to special case of
272 * range that specifies an exact memory block to allocate. Do
273 * this before other checks and adjustments so that this
274 * tranformation will be validated.
275 */
276 if (address_min && !address_max)
277 address_max = address_min + req_size;
278 else if (!address_min && !address_max)
279 address_max = ~0ull; /* If no limits given, use max limits */
280
281
282 /*
283 * Enforce minimum alignment (this also keeps the minimum free block
284 * req_size the same as the alignment req_size.
285 */
286 if (alignment < CVMX_BOOTMEM_ALIGNMENT_SIZE)
287 alignment = CVMX_BOOTMEM_ALIGNMENT_SIZE;
288
289 /*
290 * Adjust address minimum based on requested alignment (round
291 * up to meet alignment). Do this here so we can reject
292 * impossible requests up front. (NOP for address_min == 0)
293 */
294 if (alignment)
295 address_min = ALIGN(address_min, alignment);
296
297 /*
298 * Reject inconsistent args. We have adjusted these, so this
299 * may fail due to our internal changes even if this check
300 * would pass for the values the user supplied.
301 */
302 if (req_size > address_max - address_min)
303 goto error_out;
304
305 /* Walk through the list entries - first fit found is returned */
306
307 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
308 cvmx_bootmem_lock();
309 head_addr = cvmx_bootmem_desc->head_addr;
310 ent_addr = head_addr;
311 for (; ent_addr;
312 prev_addr = ent_addr,
313 ent_addr = cvmx_bootmem_phy_get_next(ent_addr)) {
314 uint64_t usable_base, usable_max;
315 uint64_t ent_size = cvmx_bootmem_phy_get_size(ent_addr);
316
317 if (cvmx_bootmem_phy_get_next(ent_addr)
318 && ent_addr > cvmx_bootmem_phy_get_next(ent_addr)) {
319 cvmx_dprintf("Internal bootmem_alloc() error: ent: "
320 "0x%llx, next: 0x%llx\n",
321 (unsigned long long)ent_addr,
322 (unsigned long long)
323 cvmx_bootmem_phy_get_next(ent_addr));
324 goto error_out;
325 }
326
327 /*
328 * Determine if this is an entry that can satisify the
329 * request Check to make sure entry is large enough to
330 * satisfy request.
331 */
332 usable_base =
333 ALIGN(max(address_min, ent_addr), alignment);
334 usable_max = min(address_max, ent_addr + ent_size);
335 /*
336 * We should be able to allocate block at address
337 * usable_base.
338 */
339
340 desired_min_addr = usable_base;
341 /*
342 * Determine if request can be satisfied from the
343 * current entry.
344 */
345 if (!((ent_addr + ent_size) > usable_base
346 && ent_addr < address_max
347 && req_size <= usable_max - usable_base))
348 continue;
349 /*
350 * We have found an entry that has room to satisfy the
351 * request, so allocate it from this entry. If end
352 * CVMX_BOOTMEM_FLAG_END_ALLOC set, then allocate from
353 * the end of this block rather than the beginning.
354 */
355 if (flags & CVMX_BOOTMEM_FLAG_END_ALLOC) {
356 desired_min_addr = usable_max - req_size;
357 /*
358 * Align desired address down to required
359 * alignment.
360 */
361 desired_min_addr &= ~(alignment - 1);
362 }
363
364 /* Match at start of entry */
365 if (desired_min_addr == ent_addr) {
366 if (req_size < ent_size) {
367 /*
368 * big enough to create a new block
369 * from top portion of block.
370 */
371 new_ent_addr = ent_addr + req_size;
372 cvmx_bootmem_phy_set_next(new_ent_addr,
373 cvmx_bootmem_phy_get_next(ent_addr));
374 cvmx_bootmem_phy_set_size(new_ent_addr,
375 ent_size -
376 req_size);
377
378 /*
379 * Adjust next pointer as following
380 * code uses this.
381 */
382 cvmx_bootmem_phy_set_next(ent_addr,
383 new_ent_addr);
384 }
385
386 /*
387 * adjust prev ptr or head to remove this
388 * entry from list.
389 */
390 if (prev_addr)
391 cvmx_bootmem_phy_set_next(prev_addr,
392 cvmx_bootmem_phy_get_next(ent_addr));
393 else
394 /*
395 * head of list being returned, so
396 * update head ptr.
397 */
398 cvmx_bootmem_desc->head_addr =
399 cvmx_bootmem_phy_get_next(ent_addr);
400
401 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
402 cvmx_bootmem_unlock();
403 return desired_min_addr;
404 }
405 /*
406 * block returned doesn't start at beginning of entry,
407 * so we know that we will be splitting a block off
408 * the front of this one. Create a new block from the
409 * beginning, add to list, and go to top of loop
410 * again.
411 *
412 * create new block from high portion of
413 * block, so that top block starts at desired
414 * addr.
415 */
416 new_ent_addr = desired_min_addr;
417 cvmx_bootmem_phy_set_next(new_ent_addr,
418 cvmx_bootmem_phy_get_next
419 (ent_addr));
420 cvmx_bootmem_phy_set_size(new_ent_addr,
421 cvmx_bootmem_phy_get_size
422 (ent_addr) -
423 (desired_min_addr -
424 ent_addr));
425 cvmx_bootmem_phy_set_size(ent_addr,
426 desired_min_addr - ent_addr);
427 cvmx_bootmem_phy_set_next(ent_addr, new_ent_addr);
428 /* Loop again to handle actual alloc from new block */
429 }
430 error_out:
431 /* We didn't find anything, so return error */
432 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
433 cvmx_bootmem_unlock();
434 return -1;
435 }
436
__cvmx_bootmem_phy_free(uint64_t phy_addr,uint64_t size,uint32_t flags)437 int __cvmx_bootmem_phy_free(uint64_t phy_addr, uint64_t size, uint32_t flags)
438 {
439 uint64_t cur_addr;
440 uint64_t prev_addr = 0; /* zero is invalid */
441 int retval = 0;
442
443 #ifdef DEBUG
444 cvmx_dprintf("__cvmx_bootmem_phy_free addr: 0x%llx, size: 0x%llx\n",
445 (unsigned long long)phy_addr, (unsigned long long)size);
446 #endif
447 if (cvmx_bootmem_desc->major_version > 3) {
448 cvmx_dprintf("ERROR: Incompatible bootmem descriptor "
449 "version: %d.%d at addr: %p\n",
450 (int)cvmx_bootmem_desc->major_version,
451 (int)cvmx_bootmem_desc->minor_version,
452 cvmx_bootmem_desc);
453 return 0;
454 }
455
456 /* 0 is not a valid size for this allocator */
457 if (!size)
458 return 0;
459
460 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
461 cvmx_bootmem_lock();
462 cur_addr = cvmx_bootmem_desc->head_addr;
463 if (cur_addr == 0 || phy_addr < cur_addr) {
464 /* add at front of list - special case with changing head ptr */
465 if (cur_addr && phy_addr + size > cur_addr)
466 goto bootmem_free_done; /* error, overlapping section */
467 else if (phy_addr + size == cur_addr) {
468 /* Add to front of existing first block */
469 cvmx_bootmem_phy_set_next(phy_addr,
470 cvmx_bootmem_phy_get_next
471 (cur_addr));
472 cvmx_bootmem_phy_set_size(phy_addr,
473 cvmx_bootmem_phy_get_size
474 (cur_addr) + size);
475 cvmx_bootmem_desc->head_addr = phy_addr;
476
477 } else {
478 /* New block before first block. OK if cur_addr is 0 */
479 cvmx_bootmem_phy_set_next(phy_addr, cur_addr);
480 cvmx_bootmem_phy_set_size(phy_addr, size);
481 cvmx_bootmem_desc->head_addr = phy_addr;
482 }
483 retval = 1;
484 goto bootmem_free_done;
485 }
486
487 /* Find place in list to add block */
488 while (cur_addr && phy_addr > cur_addr) {
489 prev_addr = cur_addr;
490 cur_addr = cvmx_bootmem_phy_get_next(cur_addr);
491 }
492
493 if (!cur_addr) {
494 /*
495 * We have reached the end of the list, add on to end,
496 * checking to see if we need to combine with last
497 * block
498 */
499 if (prev_addr + cvmx_bootmem_phy_get_size(prev_addr) ==
500 phy_addr) {
501 cvmx_bootmem_phy_set_size(prev_addr,
502 cvmx_bootmem_phy_get_size
503 (prev_addr) + size);
504 } else {
505 cvmx_bootmem_phy_set_next(prev_addr, phy_addr);
506 cvmx_bootmem_phy_set_size(phy_addr, size);
507 cvmx_bootmem_phy_set_next(phy_addr, 0);
508 }
509 retval = 1;
510 goto bootmem_free_done;
511 } else {
512 /*
513 * insert between prev and cur nodes, checking for
514 * merge with either/both.
515 */
516 if (prev_addr + cvmx_bootmem_phy_get_size(prev_addr) ==
517 phy_addr) {
518 /* Merge with previous */
519 cvmx_bootmem_phy_set_size(prev_addr,
520 cvmx_bootmem_phy_get_size
521 (prev_addr) + size);
522 if (phy_addr + size == cur_addr) {
523 /* Also merge with current */
524 cvmx_bootmem_phy_set_size(prev_addr,
525 cvmx_bootmem_phy_get_size(cur_addr) +
526 cvmx_bootmem_phy_get_size(prev_addr));
527 cvmx_bootmem_phy_set_next(prev_addr,
528 cvmx_bootmem_phy_get_next(cur_addr));
529 }
530 retval = 1;
531 goto bootmem_free_done;
532 } else if (phy_addr + size == cur_addr) {
533 /* Merge with current */
534 cvmx_bootmem_phy_set_size(phy_addr,
535 cvmx_bootmem_phy_get_size
536 (cur_addr) + size);
537 cvmx_bootmem_phy_set_next(phy_addr,
538 cvmx_bootmem_phy_get_next
539 (cur_addr));
540 cvmx_bootmem_phy_set_next(prev_addr, phy_addr);
541 retval = 1;
542 goto bootmem_free_done;
543 }
544
545 /* It is a standalone block, add in between prev and cur */
546 cvmx_bootmem_phy_set_size(phy_addr, size);
547 cvmx_bootmem_phy_set_next(phy_addr, cur_addr);
548 cvmx_bootmem_phy_set_next(prev_addr, phy_addr);
549
550 }
551 retval = 1;
552
553 bootmem_free_done:
554 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
555 cvmx_bootmem_unlock();
556 return retval;
557
558 }
559
560 /**
561 * Finds a named memory block by name.
562 * Also used for finding an unused entry in the named block table.
563 *
564 * @name: Name of memory block to find. If NULL pointer given, then
565 * finds unused descriptor, if available.
566 *
567 * @flags: Flags to control options for the allocation.
568 *
569 * Returns Pointer to memory block descriptor, NULL if not found.
570 * If NULL returned when name parameter is NULL, then no memory
571 * block descriptors are available.
572 */
573 static struct cvmx_bootmem_named_block_desc *
cvmx_bootmem_phy_named_block_find(char * name,uint32_t flags)574 cvmx_bootmem_phy_named_block_find(char *name, uint32_t flags)
575 {
576 unsigned int i;
577 struct cvmx_bootmem_named_block_desc *named_block_array_ptr;
578
579 #ifdef DEBUG
580 cvmx_dprintf("cvmx_bootmem_phy_named_block_find: %s\n", name);
581 #endif
582 /*
583 * Lock the structure to make sure that it is not being
584 * changed while we are examining it.
585 */
586 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
587 cvmx_bootmem_lock();
588
589 /* Use XKPHYS for 64 bit linux */
590 named_block_array_ptr = (struct cvmx_bootmem_named_block_desc *)
591 cvmx_phys_to_ptr(cvmx_bootmem_desc->named_block_array_addr);
592
593 #ifdef DEBUG
594 cvmx_dprintf
595 ("cvmx_bootmem_phy_named_block_find: named_block_array_ptr: %p\n",
596 named_block_array_ptr);
597 #endif
598 if (cvmx_bootmem_desc->major_version == 3) {
599 for (i = 0;
600 i < cvmx_bootmem_desc->named_block_num_blocks; i++) {
601 if ((name && named_block_array_ptr[i].size
602 && !strncmp(name, named_block_array_ptr[i].name,
603 cvmx_bootmem_desc->named_block_name_len
604 - 1))
605 || (!name && !named_block_array_ptr[i].size)) {
606 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
607 cvmx_bootmem_unlock();
608
609 return &(named_block_array_ptr[i]);
610 }
611 }
612 } else {
613 cvmx_dprintf("ERROR: Incompatible bootmem descriptor "
614 "version: %d.%d at addr: %p\n",
615 (int)cvmx_bootmem_desc->major_version,
616 (int)cvmx_bootmem_desc->minor_version,
617 cvmx_bootmem_desc);
618 }
619 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
620 cvmx_bootmem_unlock();
621
622 return NULL;
623 }
624
cvmx_bootmem_alloc_named_range_once(uint64_t size,uint64_t min_addr,uint64_t max_addr,uint64_t align,char * name,void (* init)(void *))625 void *cvmx_bootmem_alloc_named_range_once(uint64_t size, uint64_t min_addr,
626 uint64_t max_addr, uint64_t align,
627 char *name,
628 void (*init) (void *))
629 {
630 int64_t addr;
631 void *ptr;
632 uint64_t named_block_desc_addr;
633
634 named_block_desc_addr = (uint64_t)
635 cvmx_bootmem_phy_named_block_find(name,
636 (uint32_t)CVMX_BOOTMEM_FLAG_NO_LOCKING);
637
638 if (named_block_desc_addr) {
639 addr = CVMX_BOOTMEM_NAMED_GET_FIELD(named_block_desc_addr,
640 base_addr);
641 return cvmx_phys_to_ptr(addr);
642 }
643
644 addr = cvmx_bootmem_phy_named_block_alloc(size, min_addr, max_addr,
645 align, name,
646 (uint32_t)CVMX_BOOTMEM_FLAG_NO_LOCKING);
647
648 if (addr < 0)
649 return NULL;
650 ptr = cvmx_phys_to_ptr(addr);
651
652 if (init)
653 init(ptr);
654 else
655 memset(ptr, 0, size);
656
657 return ptr;
658 }
659 EXPORT_SYMBOL(cvmx_bootmem_alloc_named_range_once);
660
cvmx_bootmem_find_named_block(char * name)661 struct cvmx_bootmem_named_block_desc *cvmx_bootmem_find_named_block(char *name)
662 {
663 return cvmx_bootmem_phy_named_block_find(name, 0);
664 }
665 EXPORT_SYMBOL(cvmx_bootmem_find_named_block);
666
667 /**
668 * Frees a named block.
669 *
670 * @name: name of block to free
671 * @flags: flags for passing options
672 *
673 * Returns 0 on failure
674 * 1 on success
675 */
cvmx_bootmem_phy_named_block_free(char * name,uint32_t flags)676 static int cvmx_bootmem_phy_named_block_free(char *name, uint32_t flags)
677 {
678 struct cvmx_bootmem_named_block_desc *named_block_ptr;
679
680 if (cvmx_bootmem_desc->major_version != 3) {
681 cvmx_dprintf("ERROR: Incompatible bootmem descriptor version: "
682 "%d.%d at addr: %p\n",
683 (int)cvmx_bootmem_desc->major_version,
684 (int)cvmx_bootmem_desc->minor_version,
685 cvmx_bootmem_desc);
686 return 0;
687 }
688 #ifdef DEBUG
689 cvmx_dprintf("cvmx_bootmem_phy_named_block_free: %s\n", name);
690 #endif
691
692 /*
693 * Take lock here, as name lookup/block free/name free need to
694 * be atomic.
695 */
696 cvmx_bootmem_lock();
697
698 named_block_ptr =
699 cvmx_bootmem_phy_named_block_find(name,
700 CVMX_BOOTMEM_FLAG_NO_LOCKING);
701 if (named_block_ptr) {
702 #ifdef DEBUG
703 cvmx_dprintf("cvmx_bootmem_phy_named_block_free: "
704 "%s, base: 0x%llx, size: 0x%llx\n",
705 name,
706 (unsigned long long)named_block_ptr->base_addr,
707 (unsigned long long)named_block_ptr->size);
708 #endif
709 __cvmx_bootmem_phy_free(named_block_ptr->base_addr,
710 named_block_ptr->size,
711 CVMX_BOOTMEM_FLAG_NO_LOCKING);
712 named_block_ptr->size = 0;
713 /* Set size to zero to indicate block not used. */
714 }
715
716 cvmx_bootmem_unlock();
717 return named_block_ptr != NULL; /* 0 on failure, 1 on success */
718 }
719
cvmx_bootmem_free_named(char * name)720 int cvmx_bootmem_free_named(char *name)
721 {
722 return cvmx_bootmem_phy_named_block_free(name, 0);
723 }
724
cvmx_bootmem_phy_named_block_alloc(uint64_t size,uint64_t min_addr,uint64_t max_addr,uint64_t alignment,char * name,uint32_t flags)725 int64_t cvmx_bootmem_phy_named_block_alloc(uint64_t size, uint64_t min_addr,
726 uint64_t max_addr,
727 uint64_t alignment,
728 char *name,
729 uint32_t flags)
730 {
731 int64_t addr_allocated;
732 struct cvmx_bootmem_named_block_desc *named_block_desc_ptr;
733
734 #ifdef DEBUG
735 cvmx_dprintf("cvmx_bootmem_phy_named_block_alloc: size: 0x%llx, min: "
736 "0x%llx, max: 0x%llx, align: 0x%llx, name: %s\n",
737 (unsigned long long)size,
738 (unsigned long long)min_addr,
739 (unsigned long long)max_addr,
740 (unsigned long long)alignment,
741 name);
742 #endif
743 if (cvmx_bootmem_desc->major_version != 3) {
744 cvmx_dprintf("ERROR: Incompatible bootmem descriptor version: "
745 "%d.%d at addr: %p\n",
746 (int)cvmx_bootmem_desc->major_version,
747 (int)cvmx_bootmem_desc->minor_version,
748 cvmx_bootmem_desc);
749 return -1;
750 }
751
752 /*
753 * Take lock here, as name lookup/block alloc/name add need to
754 * be atomic.
755 */
756 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
757 cvmx_spinlock_lock((cvmx_spinlock_t *)&(cvmx_bootmem_desc->lock));
758
759 /* Get pointer to first available named block descriptor */
760 named_block_desc_ptr =
761 cvmx_bootmem_phy_named_block_find(NULL,
762 flags | CVMX_BOOTMEM_FLAG_NO_LOCKING);
763
764 /*
765 * Check to see if name already in use, return error if name
766 * not available or no more room for blocks.
767 */
768 if (cvmx_bootmem_phy_named_block_find(name,
769 flags | CVMX_BOOTMEM_FLAG_NO_LOCKING) || !named_block_desc_ptr) {
770 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
771 cvmx_spinlock_unlock((cvmx_spinlock_t *)&(cvmx_bootmem_desc->lock));
772 return -1;
773 }
774
775
776 /*
777 * Round size up to mult of minimum alignment bytes We need
778 * the actual size allocated to allow for blocks to be
779 * coalesced when they are freed. The alloc routine does the
780 * same rounding up on all allocations.
781 */
782 size = ALIGN(size, CVMX_BOOTMEM_ALIGNMENT_SIZE);
783
784 addr_allocated = cvmx_bootmem_phy_alloc(size, min_addr, max_addr,
785 alignment,
786 flags | CVMX_BOOTMEM_FLAG_NO_LOCKING);
787 if (addr_allocated >= 0) {
788 named_block_desc_ptr->base_addr = addr_allocated;
789 named_block_desc_ptr->size = size;
790 strncpy(named_block_desc_ptr->name, name,
791 cvmx_bootmem_desc->named_block_name_len);
792 named_block_desc_ptr->name[cvmx_bootmem_desc->named_block_name_len - 1] = 0;
793 }
794
795 if (!(flags & CVMX_BOOTMEM_FLAG_NO_LOCKING))
796 cvmx_spinlock_unlock((cvmx_spinlock_t *)&(cvmx_bootmem_desc->lock));
797 return addr_allocated;
798 }
799
cvmx_bootmem_get_desc(void)800 struct cvmx_bootmem_desc *cvmx_bootmem_get_desc(void)
801 {
802 return cvmx_bootmem_desc;
803 }
804