forked from jannau/thunderbolt-utils
-
Notifications
You must be signed in to change notification settings - Fork 0
/
example.c
97 lines (78 loc) · 2.33 KB
/
example.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
// SPDX-License-Identifier: LGPL-2.0
/*
* Example to demonstrate the transmission of DMA packets to a router.
* This sample code transmits a read control packet to read 1 dword from the host
* router of domain 0.
*
* To build and run:
* gcc -g -Wall -W example.c tbtutils.c passthrough.c pciutils.c utils.c -o test
* sudo ./test
*
* Copyright (C) 2023 Rajat Khandelwal <[email protected]>
*/
#include <stdlib.h>
#include <stdio.h>
#include "tbtutils.h"
int main(void)
{
/* Fetch the PCI ID for the host thunderbolt controller for domain 0 */
char *pci_id = trim_host_pci_id(0);
struct vfio_hlvl_params *params;
struct pci_vdid *dev_list;
u64 num = 0;
int ret;
if (!pci_id) {
ret = 1;
goto pci_out;
}
/*
* Fetch the count of the no. of modules in the same IOMMU group as the
* PCI device.
*/
num = total_grp_modules(pci_id);
/* Check the presence of VFIO module in the system */
if (!check_vfio_module()) {
fprintf(stderr, "VFIO not found\n");
ret = 1;
goto check_vfio_out;
}
/* Bind all the modules present in the same IOMMU group as the PCI device */
dev_list = bind_grp_modules(pci_id);
/* Initialize the VFIO for the PCI device */
params = vfio_dev_init(pci_id);
if (!params) {
ret = 1;
goto vfio_init_out;
}
/* Fetch the BAR and PCI config. space regions for the PCI device */
get_dev_bar_regions(params);
get_dev_pci_cfg_region(params);
/* Reset the host interface registers for the thunderbolt host controller */
reset_host_interface(params);
/* Initialize the thunderbolt hardware before executing anything */
ret = tbt_hw_init(pci_id);
if (ret)
goto tbt_init_out;
/* Allocate the TX and RX descriptors for the host thunderbolt controller */
allocate_tx_desc(params);
allocate_rx_desc(params);
/* Initialize the TX and RX host interface registers for the thunderbolt controller */
init_host_tx(params);
init_host_rx(params);
/* Request 1 dword from router config. space at offset 0x0 */
ret = request_router_cfg(pci_id, params, 0, 0, 1);
free_tx_rx_desc(params);
tbt_init_out:
free(params->dev_info);
free_list(params->bar_regions);
free(params->pci_cfg_region);
close(params->container);
close(params->group);
free(params);
vfio_init_out:
unbind_grp_modules(dev_list, num);
check_vfio_out:
free(pci_id);
pci_out:
exit(ret); /* Terminate all the threads, if exist */
}