summaryrefslogtreecommitdiffstats
path: root/tools/rmq/rmq.c
blob: 189d647d7a9df03f54c1588ffbbb06d3173e5e19 (plain)
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
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
/* rmq - query host NVIDIA RM via /dev/nvidia0 ioctls (oracle for TU104 static data) */
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <stdint.h>

typedef uint32_t NvU32;
typedef uint16_t NvU16;
typedef uint8_t  NvU8;
typedef uint64_t NvU64;
typedef uint32_t NvHandle;
typedef uint32_t NvV32;
typedef uint64_t NvP64;

/* NVIDIA ioctl encoding: _IOWR('F', nr, type) */
#define NV_IOCTL_MAGIC      'F'
#define NV_IOCTL_BASE       200
#define NV_ESC_RM_ALLOC     0x2B
#define NV_ESC_RM_CONTROL   0x2A

#define NV01_ROOT           0x0
#define NV01_DEVICE_0       0x80
#define NV20_SUBDEVICE_0    0x2080

typedef struct {
    NvHandle hRoot;
    NvHandle hObjectParent;
    NvHandle hObjectNew;
    NvV32    hClass;
    NvP64    pAllocParms __attribute__((aligned(8)));
    NvU32    paramsSize;
    NvV32    status;
} NVOS21_PARAMETERS;

typedef struct {
    NvHandle hClient;
    NvHandle hObject;
    NvV32    cmd;
    NvU32    flags;
    NvP64    params __attribute__((aligned(8)));
    NvU32    paramsSize;
    NvV32    status;
} NVOS54_PARAMETERS;

#define NV_IOCTL_RM_ALLOC   _IOWR(NV_IOCTL_MAGIC, NV_ESC_RM_ALLOC, NVOS21_PARAMETERS)
#define NV_IOCTL_RM_CONTROL _IOWR(NV_IOCTL_MAGIC, NV_ESC_RM_CONTROL, NVOS54_PARAMETERS)

static int fd;

/* NVOS64: 48 bytes (0x30), used for device/subdevice allocs (with rights) */
typedef struct {
    NvHandle hRoot;
    NvHandle hObjectParent;
    NvHandle hObjectNew;
    NvV32    hClass;
    NvP64    pAllocParms __attribute__((aligned(8)));
    NvP64    pRightsRequested __attribute__((aligned(8)));
    NvU32    paramsSize;
    NvU32    flags;
    NvV32    status;
} NVOS64_PARAMETERS;

#define NV_IOCTL_RM_ALLOC64 _IOWR(NV_IOCTL_MAGIC, NV_ESC_RM_ALLOC, NVOS64_PARAMETERS)

static NvU32 rm_alloc(NvHandle hRoot, NvHandle hParent, NvU32 hClass, NvHandle *pOut)
{
    NVOS21_PARAMETERS p = {0};
    p.hRoot = hRoot; p.hObjectParent = hParent; p.hClass = hClass;
    if (ioctl(fd, NV_IOCTL_RM_ALLOC, &p) < 0) { perror("alloc ioctl"); return 1; }
    if (p.status) { fprintf(stderr, "alloc class 0x%x failed: 0x%x\n", hClass, p.status); return p.status; }
    *pOut = p.hObjectNew;
    return 0;
}

/* Device/subdevice allocs use NVOS64 (48 bytes) with rights */
static NvU32 rm_alloc64(NvHandle hRoot, NvHandle hParent, NvU32 hClass, NvHandle *pOut)
{
    NVOS64_PARAMETERS p = {0};
    p.hRoot = hRoot; p.hObjectParent = hParent; p.hClass = hClass;
    p.flags = 1; /* FINN_SERIALIZED */
    if (ioctl(fd, NV_IOCTL_RM_ALLOC64, &p) < 0) { perror("alloc64 ioctl"); return 1; }
    if (p.status) { fprintf(stderr, "alloc64 class 0x%x failed: 0x%x\n", hClass, p.status); return p.status; }
    *pOut = p.hObjectNew;
    return 0;
}

static NvU32 rm_control(NvHandle hClient, NvHandle hObject, NvU32 cmd, void *params, NvU32 size)
{
    NVOS54_PARAMETERS p = {0};
    p.hClient = hClient; p.hObject = hObject; p.cmd = cmd;
    p.params = (NvP64)params; p.paramsSize = size;
    if (ioctl(fd, NV_IOCTL_RM_CONTROL, &p) < 0) { perror("control ioctl"); return 1; }
    return p.status;
}

/* NV2080_CTRL_FIFO_DEVICE_ENTRY (16 u32 engineData + 2 pbdmaIds + 2 pbdmaFaultIds + numPbdmas + name[16]) */
typedef struct {
    NvU32 engineData[16];
    NvU32 pbdmaIds[2];
    NvU32 pbdmaFaultIds[2];
    NvU32 numPbdmas;
    char  engineName[16];
} FIFO_DEVICE_ENTRY;

typedef struct {
    NvU32 baseIndex;
    NvU32 numEntries;
    NvU32 bMore;
    FIFO_DEVICE_ENTRY entries[32];
} FIFO_GET_DEVICE_INFO_TABLE_PARAMS;

typedef struct {
    NvU32 faultId, instanceId, typeEnum, resetId, devicePriBase, isEngine;
    NvU32 rlEngId, runlistPriBase, groupId, ginTargetId, deviceBroadcastPriBase, groupLocalInstanceId;
} INTERNAL_DEVICE_INFO;

typedef struct {
    NvU32 numEntries;
    INTERNAL_DEVICE_INFO deviceInfoTable[512];
} INTERNAL_GET_DEVICE_INFO_TABLE_PARAMS;

int main(int argc, char **argv)
{
    NvHandle hClient = 0, hDevice = 0, hSubdevice = 0;
    NvU32 st;

    /* RM_ALLOC creates clients on /dev/nvidiactl, not /dev/nvidia0 */
    fd = open("/dev/nvidiactl", O_RDWR);
    if (fd < 0) { perror("open /dev/nvidiactl"); return 1; }

    if ((st = rm_alloc(0, 0, NV01_ROOT, &hClient))) return 1;
    if ((st = rm_alloc64(hClient, hClient, NV01_DEVICE_0, &hDevice))) return 1;
    if ((st = rm_alloc64(hClient, hDevice, NV20_SUBDEVICE_0, &hSubdevice))) return 1;
    printf("hClient=0x%x hDevice=0x%x hSubdevice=0x%x\n", hClient, hDevice, hSubdevice);

    /* FIFO_GET_DEVICE_INFO_TABLE (0x20801112) */
    {
        FIFO_GET_DEVICE_INFO_TABLE_PARAMS *t = calloc(1, sizeof(*t));
        NvU32 base = 0;
        printf("\n=== FIFO_GET_DEVICE_INFO_TABLE (0x20801112) ===\n");
        do {
            memset(t, 0, sizeof(*t));
            t->baseIndex = base;
            st = rm_control(hClient, hSubdevice, 0x20801112, t, sizeof(*t));
            if (st) { printf("control failed: 0x%x\n", st); break; }
            NvU32 i;
            for (i = 0; i < t->numEntries; i++) {
                FIFO_DEVICE_ENTRY *e = &t->entries[i];
                printf("[%3u] name=%-16s numPbdmas=%u pbdmaIds=[%u,%u] faultIds=[%u,%u] engineData=[",
                       base + i, e->engineName, e->numPbdmas,
                       e->pbdmaIds[0], e->pbdmaIds[1],
                       e->pbdmaFaultIds[0], e->pbdmaFaultIds[1]);
                int j;
                for (j = 0; j < 16; j++) printf("%s%u", j ? "," : "", e->engineData[j]);
                printf("]\n");
            }
            base += t->numEntries;
            if (!t->bMore) break;
        } while (1);
        free(t);
    }

    /* INTERNAL_GET_DEVICE_INFO_TABLE (0x20800a40) */
    {
        INTERNAL_GET_DEVICE_INFO_TABLE_PARAMS *t = calloc(1, sizeof(*t));
        printf("\n=== INTERNAL_GET_DEVICE_INFO_TABLE (0x20800a40) ===\n");
        st = rm_control(hClient, hSubdevice, 0x20800a40, t, sizeof(*t));
        if (st) {
            printf("control failed: 0x%x (expected from userspace if internal-only)\n", st);
        } else {
            NvU32 i;
            printf("numEntries=%u\n", t->numEntries);
            for (i = 0; i < t->numEntries; i++) {
                INTERNAL_DEVICE_INFO *e = &t->deviceInfoTable[i];
                printf("[%3u] faultId=%u instanceId=%u typeEnum=%u resetId=%u devicePriBase=0x%x isEngine=%u rlEngId=%u runlistPriBase=0x%x groupId=%u ginTargetId=%u deviceBroadcastPriBase=0x%x groupLocalInstanceId=%u\n",
                       i, e->faultId, e->instanceId, e->typeEnum, e->resetId,
                       e->devicePriBase, e->isEngine, e->rlEngId, e->runlistPriBase,
                       e->groupId, e->ginTargetId, e->deviceBroadcastPriBase,
                       e->groupLocalInstanceId);
            }
        }
        free(t);
    }

    return 0;
}