1 /*
2 This file is provided under a dual BSD/GPLv2 license. When using or
3 redistributing this file, you may do so under either license.
4
5 GPL LICENSE SUMMARY
6 Copyright(c) 2014 Intel Corporation.
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of version 2 of the GNU General Public License as
9 published by the Free Software Foundation.
10
11 This program is distributed in the hope that it will be useful, but
12 WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 General Public License for more details.
15
16 Contact Information:
17 qat-linux@intel.com
18
19 BSD LICENSE
20 Copyright(c) 2014 Intel Corporation.
21 Redistribution and use in source and binary forms, with or without
22 modification, are permitted provided that the following conditions
23 are met:
24
25 * Redistributions of source code must retain the above copyright
26 notice, this list of conditions and the following disclaimer.
27 * Redistributions in binary form must reproduce the above copyright
28 notice, this list of conditions and the following disclaimer in
29 the documentation and/or other materials provided with the
30 distribution.
31 * Neither the name of Intel Corporation nor the names of its
32 contributors may be used to endorse or promote products derived
33 from this software without specific prior written permission.
34
35 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
36 "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
37 LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
38 A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
39 OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
40 SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
41 LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
42 DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
43 THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
44 (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
45 OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
46 */
47 #include <linux/mutex.h>
48 #include <linux/list.h>
49 #include "adf_cfg.h"
50 #include "adf_common_drv.h"
51
52 static LIST_HEAD(accel_table);
53 static LIST_HEAD(vfs_table);
54 static DEFINE_MUTEX(table_lock);
55 static uint32_t num_devices;
56 static u8 id_map[ADF_MAX_DEVICES];
57
58 struct vf_id_map {
59 u32 bdf;
60 u32 id;
61 u32 fake_id;
62 bool attached;
63 struct list_head list;
64 };
65
adf_get_vf_id(struct adf_accel_dev * vf)66 static int adf_get_vf_id(struct adf_accel_dev *vf)
67 {
68 return ((7 * (PCI_SLOT(accel_to_pci_dev(vf)->devfn) - 1)) +
69 PCI_FUNC(accel_to_pci_dev(vf)->devfn) +
70 (PCI_SLOT(accel_to_pci_dev(vf)->devfn) - 1));
71 }
72
adf_get_vf_num(struct adf_accel_dev * vf)73 static int adf_get_vf_num(struct adf_accel_dev *vf)
74 {
75 return (accel_to_pci_dev(vf)->bus->number << 8) | adf_get_vf_id(vf);
76 }
77
adf_find_vf(u32 bdf)78 static struct vf_id_map *adf_find_vf(u32 bdf)
79 {
80 struct list_head *itr;
81
82 list_for_each(itr, &vfs_table) {
83 struct vf_id_map *ptr =
84 list_entry(itr, struct vf_id_map, list);
85
86 if (ptr->bdf == bdf)
87 return ptr;
88 }
89 return NULL;
90 }
91
adf_get_vf_real_id(u32 fake)92 static int adf_get_vf_real_id(u32 fake)
93 {
94 struct list_head *itr;
95
96 list_for_each(itr, &vfs_table) {
97 struct vf_id_map *ptr =
98 list_entry(itr, struct vf_id_map, list);
99 if (ptr->fake_id == fake)
100 return ptr->id;
101 }
102 return -1;
103 }
104
105 /**
106 * adf_clean_vf_map() - Cleans VF id mapings
107 *
108 * Function cleans internal ids for virtual functions.
109 * @vf: flag indicating whether mappings is cleaned
110 * for vfs only or for vfs and pfs
111 */
adf_clean_vf_map(bool vf)112 void adf_clean_vf_map(bool vf)
113 {
114 struct vf_id_map *map;
115 struct list_head *ptr, *tmp;
116
117 mutex_lock(&table_lock);
118 list_for_each_safe(ptr, tmp, &vfs_table) {
119 map = list_entry(ptr, struct vf_id_map, list);
120 if (map->bdf != -1) {
121 id_map[map->id] = 0;
122 num_devices--;
123 }
124
125 if (vf && map->bdf == -1)
126 continue;
127
128 list_del(ptr);
129 kfree(map);
130 }
131 mutex_unlock(&table_lock);
132 }
133 EXPORT_SYMBOL_GPL(adf_clean_vf_map);
134
135 /**
136 * adf_devmgr_update_class_index() - Update internal index
137 * @hw_data: Pointer to internal device data.
138 *
139 * Function updates internal dev index for VFs
140 */
adf_devmgr_update_class_index(struct adf_hw_device_data * hw_data)141 void adf_devmgr_update_class_index(struct adf_hw_device_data *hw_data)
142 {
143 struct adf_hw_device_class *class = hw_data->dev_class;
144 struct list_head *itr;
145 int i = 0;
146
147 list_for_each(itr, &accel_table) {
148 struct adf_accel_dev *ptr =
149 list_entry(itr, struct adf_accel_dev, list);
150
151 if (ptr->hw_device->dev_class == class)
152 ptr->hw_device->instance_id = i++;
153
154 if (i == class->instances)
155 break;
156 }
157 }
158 EXPORT_SYMBOL_GPL(adf_devmgr_update_class_index);
159
adf_find_free_id(void)160 static unsigned int adf_find_free_id(void)
161 {
162 unsigned int i;
163
164 for (i = 0; i < ADF_MAX_DEVICES; i++) {
165 if (!id_map[i]) {
166 id_map[i] = 1;
167 return i;
168 }
169 }
170 return ADF_MAX_DEVICES + 1;
171 }
172
173 /**
174 * adf_devmgr_add_dev() - Add accel_dev to the acceleration framework
175 * @accel_dev: Pointer to acceleration device.
176 * @pf: Corresponding PF if the accel_dev is a VF
177 *
178 * Function adds acceleration device to the acceleration framework.
179 * To be used by QAT device specific drivers.
180 *
181 * Return: 0 on success, error code otherwise.
182 */
adf_devmgr_add_dev(struct adf_accel_dev * accel_dev,struct adf_accel_dev * pf)183 int adf_devmgr_add_dev(struct adf_accel_dev *accel_dev,
184 struct adf_accel_dev *pf)
185 {
186 struct list_head *itr;
187 int ret = 0;
188
189 if (num_devices == ADF_MAX_DEVICES) {
190 dev_err(&GET_DEV(accel_dev), "Only support up to %d devices\n",
191 ADF_MAX_DEVICES);
192 return -EFAULT;
193 }
194
195 mutex_lock(&table_lock);
196 atomic_set(&accel_dev->ref_count, 0);
197
198 /* PF on host or VF on guest */
199 if (!accel_dev->is_vf || (accel_dev->is_vf && !pf)) {
200 struct vf_id_map *map;
201
202 list_for_each(itr, &accel_table) {
203 struct adf_accel_dev *ptr =
204 list_entry(itr, struct adf_accel_dev, list);
205
206 if (ptr == accel_dev) {
207 ret = -EEXIST;
208 goto unlock;
209 }
210 }
211
212 list_add_tail(&accel_dev->list, &accel_table);
213 accel_dev->accel_id = adf_find_free_id();
214 if (accel_dev->accel_id > ADF_MAX_DEVICES) {
215 ret = -EFAULT;
216 goto unlock;
217 }
218 num_devices++;
219 map = kzalloc(sizeof(*map), GFP_KERNEL);
220 if (!map) {
221 ret = -ENOMEM;
222 goto unlock;
223 }
224 map->bdf = ~0;
225 map->id = accel_dev->accel_id;
226 map->fake_id = map->id;
227 map->attached = true;
228 list_add_tail(&map->list, &vfs_table);
229 } else if (accel_dev->is_vf && pf) {
230 /* VF on host */
231 struct vf_id_map *map;
232
233 map = adf_find_vf(adf_get_vf_num(accel_dev));
234 if (map) {
235 struct vf_id_map *next;
236
237 accel_dev->accel_id = map->id;
238 list_add_tail(&accel_dev->list, &accel_table);
239 map->fake_id++;
240 map->attached = true;
241 next = list_next_entry(map, list);
242 while (next && &next->list != &vfs_table) {
243 next->fake_id++;
244 next = list_next_entry(next, list);
245 }
246
247 ret = 0;
248 goto unlock;
249 }
250
251 map = kzalloc(sizeof(*map), GFP_KERNEL);
252 if (!map) {
253 ret = -ENOMEM;
254 goto unlock;
255 }
256 accel_dev->accel_id = adf_find_free_id();
257 if (accel_dev->accel_id > ADF_MAX_DEVICES) {
258 kfree(map);
259 ret = -EFAULT;
260 goto unlock;
261 }
262 num_devices++;
263 list_add_tail(&accel_dev->list, &accel_table);
264 map->bdf = adf_get_vf_num(accel_dev);
265 map->id = accel_dev->accel_id;
266 map->fake_id = map->id;
267 map->attached = true;
268 list_add_tail(&map->list, &vfs_table);
269 }
270 unlock:
271 mutex_unlock(&table_lock);
272 return ret;
273 }
274 EXPORT_SYMBOL_GPL(adf_devmgr_add_dev);
275
adf_devmgr_get_head(void)276 struct list_head *adf_devmgr_get_head(void)
277 {
278 return &accel_table;
279 }
280
281 /**
282 * adf_devmgr_rm_dev() - Remove accel_dev from the acceleration framework.
283 * @accel_dev: Pointer to acceleration device.
284 * @pf: Corresponding PF if the accel_dev is a VF
285 *
286 * Function removes acceleration device from the acceleration framework.
287 * To be used by QAT device specific drivers.
288 *
289 * Return: void
290 */
adf_devmgr_rm_dev(struct adf_accel_dev * accel_dev,struct adf_accel_dev * pf)291 void adf_devmgr_rm_dev(struct adf_accel_dev *accel_dev,
292 struct adf_accel_dev *pf)
293 {
294 mutex_lock(&table_lock);
295 if (!accel_dev->is_vf || (accel_dev->is_vf && !pf)) {
296 id_map[accel_dev->accel_id] = 0;
297 num_devices--;
298 } else if (accel_dev->is_vf && pf) {
299 struct vf_id_map *map, *next;
300
301 map = adf_find_vf(adf_get_vf_num(accel_dev));
302 if (!map) {
303 dev_err(&GET_DEV(accel_dev), "Failed to find VF map\n");
304 goto unlock;
305 }
306 map->fake_id--;
307 map->attached = false;
308 next = list_next_entry(map, list);
309 while (next && &next->list != &vfs_table) {
310 next->fake_id--;
311 next = list_next_entry(next, list);
312 }
313 }
314 unlock:
315 list_del(&accel_dev->list);
316 mutex_unlock(&table_lock);
317 }
318 EXPORT_SYMBOL_GPL(adf_devmgr_rm_dev);
319
adf_devmgr_get_first(void)320 struct adf_accel_dev *adf_devmgr_get_first(void)
321 {
322 struct adf_accel_dev *dev = NULL;
323
324 if (!list_empty(&accel_table))
325 dev = list_first_entry(&accel_table, struct adf_accel_dev,
326 list);
327 return dev;
328 }
329
330 /**
331 * adf_devmgr_pci_to_accel_dev() - Get accel_dev associated with the pci_dev.
332 * @accel_dev: Pointer to pci device.
333 *
334 * Function returns acceleration device associated with the given pci device.
335 * To be used by QAT device specific drivers.
336 *
337 * Return: pointer to accel_dev or NULL if not found.
338 */
adf_devmgr_pci_to_accel_dev(struct pci_dev * pci_dev)339 struct adf_accel_dev *adf_devmgr_pci_to_accel_dev(struct pci_dev *pci_dev)
340 {
341 struct list_head *itr;
342
343 mutex_lock(&table_lock);
344 list_for_each(itr, &accel_table) {
345 struct adf_accel_dev *ptr =
346 list_entry(itr, struct adf_accel_dev, list);
347
348 if (ptr->accel_pci_dev.pci_dev == pci_dev) {
349 mutex_unlock(&table_lock);
350 return ptr;
351 }
352 }
353 mutex_unlock(&table_lock);
354 return NULL;
355 }
356 EXPORT_SYMBOL_GPL(adf_devmgr_pci_to_accel_dev);
357
adf_devmgr_get_dev_by_id(uint32_t id)358 struct adf_accel_dev *adf_devmgr_get_dev_by_id(uint32_t id)
359 {
360 struct list_head *itr;
361 int real_id;
362
363 mutex_lock(&table_lock);
364 real_id = adf_get_vf_real_id(id);
365 if (real_id < 0)
366 goto unlock;
367
368 id = real_id;
369
370 list_for_each(itr, &accel_table) {
371 struct adf_accel_dev *ptr =
372 list_entry(itr, struct adf_accel_dev, list);
373 if (ptr->accel_id == id) {
374 mutex_unlock(&table_lock);
375 return ptr;
376 }
377 }
378 unlock:
379 mutex_unlock(&table_lock);
380 return NULL;
381 }
382
adf_devmgr_verify_id(uint32_t id)383 int adf_devmgr_verify_id(uint32_t id)
384 {
385 if (id == ADF_CFG_ALL_DEVICES)
386 return 0;
387
388 if (adf_devmgr_get_dev_by_id(id))
389 return 0;
390
391 return -ENODEV;
392 }
393
adf_get_num_dettached_vfs(void)394 static int adf_get_num_dettached_vfs(void)
395 {
396 struct list_head *itr;
397 int vfs = 0;
398
399 mutex_lock(&table_lock);
400 list_for_each(itr, &vfs_table) {
401 struct vf_id_map *ptr =
402 list_entry(itr, struct vf_id_map, list);
403 if (ptr->bdf != ~0 && !ptr->attached)
404 vfs++;
405 }
406 mutex_unlock(&table_lock);
407 return vfs;
408 }
409
adf_devmgr_get_num_dev(uint32_t * num)410 void adf_devmgr_get_num_dev(uint32_t *num)
411 {
412 *num = num_devices - adf_get_num_dettached_vfs();
413 }
414
415 /**
416 * adf_dev_in_use() - Check whether accel_dev is currently in use
417 * @accel_dev: Pointer to acceleration device.
418 *
419 * To be used by QAT device specific drivers.
420 *
421 * Return: 1 when device is in use, 0 otherwise.
422 */
adf_dev_in_use(struct adf_accel_dev * accel_dev)423 int adf_dev_in_use(struct adf_accel_dev *accel_dev)
424 {
425 return atomic_read(&accel_dev->ref_count) != 0;
426 }
427 EXPORT_SYMBOL_GPL(adf_dev_in_use);
428
429 /**
430 * adf_dev_get() - Increment accel_dev reference count
431 * @accel_dev: Pointer to acceleration device.
432 *
433 * Increment the accel_dev refcount and if this is the first time
434 * incrementing it during this period the accel_dev is in use,
435 * increment the module refcount too.
436 * To be used by QAT device specific drivers.
437 *
438 * Return: 0 when successful, EFAULT when fail to bump module refcount
439 */
adf_dev_get(struct adf_accel_dev * accel_dev)440 int adf_dev_get(struct adf_accel_dev *accel_dev)
441 {
442 if (atomic_add_return(1, &accel_dev->ref_count) == 1)
443 if (!try_module_get(accel_dev->owner))
444 return -EFAULT;
445 return 0;
446 }
447 EXPORT_SYMBOL_GPL(adf_dev_get);
448
449 /**
450 * adf_dev_put() - Decrement accel_dev reference count
451 * @accel_dev: Pointer to acceleration device.
452 *
453 * Decrement the accel_dev refcount and if this is the last time
454 * decrementing it during this period the accel_dev is in use,
455 * decrement the module refcount too.
456 * To be used by QAT device specific drivers.
457 *
458 * Return: void
459 */
adf_dev_put(struct adf_accel_dev * accel_dev)460 void adf_dev_put(struct adf_accel_dev *accel_dev)
461 {
462 if (atomic_sub_return(1, &accel_dev->ref_count) == 0)
463 module_put(accel_dev->owner);
464 }
465 EXPORT_SYMBOL_GPL(adf_dev_put);
466
467 /**
468 * adf_devmgr_in_reset() - Check whether device is in reset
469 * @accel_dev: Pointer to acceleration device.
470 *
471 * To be used by QAT device specific drivers.
472 *
473 * Return: 1 when the device is being reset, 0 otherwise.
474 */
adf_devmgr_in_reset(struct adf_accel_dev * accel_dev)475 int adf_devmgr_in_reset(struct adf_accel_dev *accel_dev)
476 {
477 return test_bit(ADF_STATUS_RESTARTING, &accel_dev->status);
478 }
479 EXPORT_SYMBOL_GPL(adf_devmgr_in_reset);
480
481 /**
482 * adf_dev_started() - Check whether device has started
483 * @accel_dev: Pointer to acceleration device.
484 *
485 * To be used by QAT device specific drivers.
486 *
487 * Return: 1 when the device has started, 0 otherwise
488 */
adf_dev_started(struct adf_accel_dev * accel_dev)489 int adf_dev_started(struct adf_accel_dev *accel_dev)
490 {
491 return test_bit(ADF_STATUS_STARTED, &accel_dev->status);
492 }
493 EXPORT_SYMBOL_GPL(adf_dev_started);
494