1*4882a593Smuzhiyun // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2*4882a593Smuzhiyun /* Copyright (c) 2016-2018 Mellanox Technologies. All rights reserved */
3*4882a593Smuzhiyun
4*4882a593Smuzhiyun #include <linux/kernel.h>
5*4882a593Smuzhiyun #include <linux/mutex.h>
6*4882a593Smuzhiyun #include <linux/slab.h>
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include "spectrum.h"
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun struct mlxsw_sp_kvdl {
11*4882a593Smuzhiyun const struct mlxsw_sp_kvdl_ops *kvdl_ops;
12*4882a593Smuzhiyun struct mutex kvdl_lock; /* Protects kvdl allocations */
13*4882a593Smuzhiyun unsigned long priv[];
14*4882a593Smuzhiyun /* priv has to be always the last item */
15*4882a593Smuzhiyun };
16*4882a593Smuzhiyun
mlxsw_sp_kvdl_init(struct mlxsw_sp * mlxsw_sp)17*4882a593Smuzhiyun int mlxsw_sp_kvdl_init(struct mlxsw_sp *mlxsw_sp)
18*4882a593Smuzhiyun {
19*4882a593Smuzhiyun const struct mlxsw_sp_kvdl_ops *kvdl_ops = mlxsw_sp->kvdl_ops;
20*4882a593Smuzhiyun struct mlxsw_sp_kvdl *kvdl;
21*4882a593Smuzhiyun int err;
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun kvdl = kzalloc(sizeof(*mlxsw_sp->kvdl) + kvdl_ops->priv_size,
24*4882a593Smuzhiyun GFP_KERNEL);
25*4882a593Smuzhiyun if (!kvdl)
26*4882a593Smuzhiyun return -ENOMEM;
27*4882a593Smuzhiyun mutex_init(&kvdl->kvdl_lock);
28*4882a593Smuzhiyun kvdl->kvdl_ops = kvdl_ops;
29*4882a593Smuzhiyun mlxsw_sp->kvdl = kvdl;
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun err = kvdl_ops->init(mlxsw_sp, kvdl->priv);
32*4882a593Smuzhiyun if (err)
33*4882a593Smuzhiyun goto err_init;
34*4882a593Smuzhiyun return 0;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun err_init:
37*4882a593Smuzhiyun mutex_destroy(&kvdl->kvdl_lock);
38*4882a593Smuzhiyun kfree(kvdl);
39*4882a593Smuzhiyun return err;
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun
mlxsw_sp_kvdl_fini(struct mlxsw_sp * mlxsw_sp)42*4882a593Smuzhiyun void mlxsw_sp_kvdl_fini(struct mlxsw_sp *mlxsw_sp)
43*4882a593Smuzhiyun {
44*4882a593Smuzhiyun struct mlxsw_sp_kvdl *kvdl = mlxsw_sp->kvdl;
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun kvdl->kvdl_ops->fini(mlxsw_sp, kvdl->priv);
47*4882a593Smuzhiyun mutex_destroy(&kvdl->kvdl_lock);
48*4882a593Smuzhiyun kfree(kvdl);
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun
mlxsw_sp_kvdl_alloc(struct mlxsw_sp * mlxsw_sp,enum mlxsw_sp_kvdl_entry_type type,unsigned int entry_count,u32 * p_entry_index)51*4882a593Smuzhiyun int mlxsw_sp_kvdl_alloc(struct mlxsw_sp *mlxsw_sp,
52*4882a593Smuzhiyun enum mlxsw_sp_kvdl_entry_type type,
53*4882a593Smuzhiyun unsigned int entry_count, u32 *p_entry_index)
54*4882a593Smuzhiyun {
55*4882a593Smuzhiyun struct mlxsw_sp_kvdl *kvdl = mlxsw_sp->kvdl;
56*4882a593Smuzhiyun int err;
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun mutex_lock(&kvdl->kvdl_lock);
59*4882a593Smuzhiyun err = kvdl->kvdl_ops->alloc(mlxsw_sp, kvdl->priv, type,
60*4882a593Smuzhiyun entry_count, p_entry_index);
61*4882a593Smuzhiyun mutex_unlock(&kvdl->kvdl_lock);
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun return err;
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun
mlxsw_sp_kvdl_free(struct mlxsw_sp * mlxsw_sp,enum mlxsw_sp_kvdl_entry_type type,unsigned int entry_count,int entry_index)66*4882a593Smuzhiyun void mlxsw_sp_kvdl_free(struct mlxsw_sp *mlxsw_sp,
67*4882a593Smuzhiyun enum mlxsw_sp_kvdl_entry_type type,
68*4882a593Smuzhiyun unsigned int entry_count, int entry_index)
69*4882a593Smuzhiyun {
70*4882a593Smuzhiyun struct mlxsw_sp_kvdl *kvdl = mlxsw_sp->kvdl;
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun mutex_lock(&kvdl->kvdl_lock);
73*4882a593Smuzhiyun kvdl->kvdl_ops->free(mlxsw_sp, kvdl->priv, type,
74*4882a593Smuzhiyun entry_count, entry_index);
75*4882a593Smuzhiyun mutex_unlock(&kvdl->kvdl_lock);
76*4882a593Smuzhiyun }
77*4882a593Smuzhiyun
mlxsw_sp_kvdl_alloc_count_query(struct mlxsw_sp * mlxsw_sp,enum mlxsw_sp_kvdl_entry_type type,unsigned int entry_count,unsigned int * p_alloc_count)78*4882a593Smuzhiyun int mlxsw_sp_kvdl_alloc_count_query(struct mlxsw_sp *mlxsw_sp,
79*4882a593Smuzhiyun enum mlxsw_sp_kvdl_entry_type type,
80*4882a593Smuzhiyun unsigned int entry_count,
81*4882a593Smuzhiyun unsigned int *p_alloc_count)
82*4882a593Smuzhiyun {
83*4882a593Smuzhiyun struct mlxsw_sp_kvdl *kvdl = mlxsw_sp->kvdl;
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun return kvdl->kvdl_ops->alloc_size_query(mlxsw_sp, kvdl->priv, type,
86*4882a593Smuzhiyun entry_count, p_alloc_count);
87*4882a593Smuzhiyun }
88