184 lines
4.9 KiB
C
184 lines
4.9 KiB
C
![]() |
/***********************license start***************
|
||
|
* Author: Cavium Networks
|
||
|
*
|
||
|
* Contact: support@caviumnetworks.com
|
||
|
* This file is part of the OCTEON SDK
|
||
|
*
|
||
|
* Copyright (c) 2003-2008 Cavium Networks
|
||
|
*
|
||
|
* This file is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License, Version 2, as
|
||
|
* published by the Free Software Foundation.
|
||
|
*
|
||
|
* This file is distributed in the hope that it will be useful, but
|
||
|
* AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
|
||
|
* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
|
||
|
* NONINFRINGEMENT. See the GNU General Public License for more
|
||
|
* details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License
|
||
|
* along with this file; if not, write to the Free Software
|
||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||
|
* or visit http://www.gnu.org/licenses/.
|
||
|
*
|
||
|
* This file may also be available under a different license from Cavium.
|
||
|
* Contact Cavium Networks for more information
|
||
|
***********************license end**************************************/
|
||
|
|
||
|
/**
|
||
|
* @file
|
||
|
*
|
||
|
* Support library for the hardware Free Pool Allocator.
|
||
|
*
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
#include "cvmx-config.h"
|
||
|
#include "cvmx.h"
|
||
|
#include "cvmx-fpa.h"
|
||
|
#include "cvmx-ipd.h"
|
||
|
|
||
|
/**
|
||
|
* Current state of all the pools. Use access functions
|
||
|
* instead of using it directly.
|
||
|
*/
|
||
|
CVMX_SHARED cvmx_fpa_pool_info_t cvmx_fpa_pool_info[CVMX_FPA_NUM_POOLS];
|
||
|
|
||
|
/**
|
||
|
* Setup a FPA pool to control a new block of memory. The
|
||
|
* buffer pointer must be a physical address.
|
||
|
*
|
||
|
* @pool: Pool to initialize
|
||
|
* 0 <= pool < 8
|
||
|
* @name: Constant character string to name this pool.
|
||
|
* String is not copied.
|
||
|
* @buffer: Pointer to the block of memory to use. This must be
|
||
|
* accessable by all processors and external hardware.
|
||
|
* @block_size: Size for each block controlled by the FPA
|
||
|
* @num_blocks: Number of blocks
|
||
|
*
|
||
|
* Returns 0 on Success,
|
||
|
* -1 on failure
|
||
|
*/
|
||
|
int cvmx_fpa_setup_pool(uint64_t pool, const char *name, void *buffer,
|
||
|
uint64_t block_size, uint64_t num_blocks)
|
||
|
{
|
||
|
char *ptr;
|
||
|
if (!buffer) {
|
||
|
cvmx_dprintf
|
||
|
("ERROR: cvmx_fpa_setup_pool: NULL buffer pointer!\n");
|
||
|
return -1;
|
||
|
}
|
||
|
if (pool >= CVMX_FPA_NUM_POOLS) {
|
||
|
cvmx_dprintf("ERROR: cvmx_fpa_setup_pool: Illegal pool!\n");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
if (block_size < CVMX_FPA_MIN_BLOCK_SIZE) {
|
||
|
cvmx_dprintf
|
||
|
("ERROR: cvmx_fpa_setup_pool: Block size too small.\n");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
if (((unsigned long)buffer & (CVMX_FPA_ALIGNMENT - 1)) != 0) {
|
||
|
cvmx_dprintf
|
||
|
("ERROR: cvmx_fpa_setup_pool: Buffer not aligned properly.\n");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
cvmx_fpa_pool_info[pool].name = name;
|
||
|
cvmx_fpa_pool_info[pool].size = block_size;
|
||
|
cvmx_fpa_pool_info[pool].starting_element_count = num_blocks;
|
||
|
cvmx_fpa_pool_info[pool].base = buffer;
|
||
|
|
||
|
ptr = (char *)buffer;
|
||
|
while (num_blocks--) {
|
||
|
cvmx_fpa_free(ptr, pool, 0);
|
||
|
ptr += block_size;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* Shutdown a Memory pool and validate that it had all of
|
||
|
* the buffers originally placed in it.
|
||
|
*
|
||
|
* @pool: Pool to shutdown
|
||
|
* Returns Zero on success
|
||
|
* - Positive is count of missing buffers
|
||
|
* - Negative is too many buffers or corrupted pointers
|
||
|
*/
|
||
|
uint64_t cvmx_fpa_shutdown_pool(uint64_t pool)
|
||
|
{
|
||
|
uint64_t errors = 0;
|
||
|
uint64_t count = 0;
|
||
|
uint64_t base = cvmx_ptr_to_phys(cvmx_fpa_pool_info[pool].base);
|
||
|
uint64_t finish =
|
||
|
base +
|
||
|
cvmx_fpa_pool_info[pool].size *
|
||
|
cvmx_fpa_pool_info[pool].starting_element_count;
|
||
|
void *ptr;
|
||
|
uint64_t address;
|
||
|
|
||
|
count = 0;
|
||
|
do {
|
||
|
ptr = cvmx_fpa_alloc(pool);
|
||
|
if (ptr)
|
||
|
address = cvmx_ptr_to_phys(ptr);
|
||
|
else
|
||
|
address = 0;
|
||
|
if (address) {
|
||
|
if ((address >= base) && (address < finish) &&
|
||
|
(((address -
|
||
|
base) % cvmx_fpa_pool_info[pool].size) == 0)) {
|
||
|
count++;
|
||
|
} else {
|
||
|
cvmx_dprintf
|
||
|
("ERROR: cvmx_fpa_shutdown_pool: Illegal address 0x%llx in pool %s(%d)\n",
|
||
|
(unsigned long long)address,
|
||
|
cvmx_fpa_pool_info[pool].name, (int)pool);
|
||
|
errors++;
|
||
|
}
|
||
|
}
|
||
|
} while (address);
|
||
|
|
||
|
#ifdef CVMX_ENABLE_PKO_FUNCTIONS
|
||
|
if (pool == 0)
|
||
|
cvmx_ipd_free_ptr();
|
||
|
#endif
|
||
|
|
||
|
if (errors) {
|
||
|
cvmx_dprintf
|
||
|
("ERROR: cvmx_fpa_shutdown_pool: Pool %s(%d) started at 0x%llx, ended at 0x%llx, with a step of 0x%llx\n",
|
||
|
cvmx_fpa_pool_info[pool].name, (int)pool,
|
||
|
(unsigned long long)base, (unsigned long long)finish,
|
||
|
(unsigned long long)cvmx_fpa_pool_info[pool].size);
|
||
|
return -errors;
|
||
|
} else
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
uint64_t cvmx_fpa_get_block_size(uint64_t pool)
|
||
|
{
|
||
|
switch (pool) {
|
||
|
case 0:
|
||
|
return CVMX_FPA_POOL_0_SIZE;
|
||
|
case 1:
|
||
|
return CVMX_FPA_POOL_1_SIZE;
|
||
|
case 2:
|
||
|
return CVMX_FPA_POOL_2_SIZE;
|
||
|
case 3:
|
||
|
return CVMX_FPA_POOL_3_SIZE;
|
||
|
case 4:
|
||
|
return CVMX_FPA_POOL_4_SIZE;
|
||
|
case 5:
|
||
|
return CVMX_FPA_POOL_5_SIZE;
|
||
|
case 6:
|
||
|
return CVMX_FPA_POOL_6_SIZE;
|
||
|
case 7:
|
||
|
return CVMX_FPA_POOL_7_SIZE;
|
||
|
default:
|
||
|
return 0;
|
||
|
}
|
||
|
}
|