1 /* 2 * drivers/net/ethernet/mellanox/mlxsw/spectrum_kvdl.c 3 * Copyright (c) 2016 Mellanox Technologies. All rights reserved. 4 * Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com> 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions are met: 8 * 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. Neither the names of the copyright holders nor the names of its 15 * contributors may be used to endorse or promote products derived from 16 * this software without specific prior written permission. 17 * 18 * Alternatively, this software may be distributed under the terms of the 19 * GNU General Public License ("GPL") version 2 as published by the Free 20 * Software Foundation. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 32 * POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35 #include <linux/kernel.h> 36 #include <linux/bitops.h> 37 38 #include "spectrum.h" 39 40 #define MLXSW_SP_KVDL_SINGLE_BASE 0 41 #define MLXSW_SP_KVDL_SINGLE_SIZE 16384 42 #define MLXSW_SP_KVDL_CHUNKS_BASE \ 43 (MLXSW_SP_KVDL_SINGLE_BASE + MLXSW_SP_KVDL_SINGLE_SIZE) 44 #define MLXSW_SP_KVDL_CHUNKS_SIZE \ 45 (MLXSW_SP_KVD_LINEAR_SIZE - MLXSW_SP_KVDL_CHUNKS_BASE) 46 #define MLXSW_SP_CHUNK_MAX 32 47 48 int mlxsw_sp_kvdl_alloc(struct mlxsw_sp *mlxsw_sp, unsigned int entry_count, 49 u32 *p_entry_index) 50 { 51 int entry_index; 52 int size; 53 int type_base; 54 int type_size; 55 int type_entries; 56 57 if (entry_count == 0 || entry_count > MLXSW_SP_CHUNK_MAX) { 58 return -EINVAL; 59 } else if (entry_count == 1) { 60 type_base = MLXSW_SP_KVDL_SINGLE_BASE; 61 type_size = MLXSW_SP_KVDL_SINGLE_SIZE; 62 type_entries = 1; 63 } else { 64 type_base = MLXSW_SP_KVDL_CHUNKS_BASE; 65 type_size = MLXSW_SP_KVDL_CHUNKS_SIZE; 66 type_entries = MLXSW_SP_CHUNK_MAX; 67 } 68 69 entry_index = type_base; 70 size = type_base + type_size; 71 for_each_clear_bit_from(entry_index, mlxsw_sp->kvdl.usage, size) { 72 int i; 73 74 for (i = 0; i < type_entries; i++) 75 set_bit(entry_index + i, mlxsw_sp->kvdl.usage); 76 *p_entry_index = entry_index; 77 return 0; 78 } 79 return -ENOBUFS; 80 } 81 82 void mlxsw_sp_kvdl_free(struct mlxsw_sp *mlxsw_sp, int entry_index) 83 { 84 int type_entries; 85 int i; 86 87 if (entry_index < MLXSW_SP_KVDL_CHUNKS_BASE) 88 type_entries = 1; 89 else 90 type_entries = MLXSW_SP_CHUNK_MAX; 91 for (i = 0; i < type_entries; i++) 92 clear_bit(entry_index + i, mlxsw_sp->kvdl.usage); 93 } 94