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
|
#define _PCILIB_DMA_NWL_C
#define _BSD_SOURCE
#define _DEFAULT_SOURCE
#define _GNU_SOURCE
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/time.h>
#include "pci.h"
#include "pcilib.h"
#include "error.h"
#include "tools.h"
#include "bar.h"
#include "nwl_private.h"
#include "nwl_defines.h"
int dma_nwl_start(pcilib_dma_context_t *vctx, pcilib_dma_engine_t dma, pcilib_dma_flags_t flags) {
int err;
nwl_dma_t *ctx = (nwl_dma_t*)vctx;
if (!ctx->started) {
// global initialization, should we do anything?
ctx->started = 1;
}
if (dma == PCILIB_DMA_ENGINE_INVALID) return 0;
else if (dma > ctx->dmactx.pcilib->num_engines) return PCILIB_ERROR_INVALID_BANK;
if (flags&PCILIB_DMA_FLAG_PERSISTENT) ctx->engines[dma].preserve = 1;
err = dma_nwl_start_engine(ctx, dma);
return err;
}
int dma_nwl_stop(pcilib_dma_context_t *vctx, pcilib_dma_engine_t dma, pcilib_dma_flags_t flags) {
int err;
int preserving = 0;
nwl_dma_t *ctx = (nwl_dma_t*)vctx;
if (!ctx->started) return 0;
// stop everything
if (dma == PCILIB_DMA_ENGINE_INVALID) {
for (dma = 0; dma < ctx->dmactx.pcilib->num_engines; dma++) {
if (flags&PCILIB_DMA_FLAG_PERSISTENT) {
ctx->engines[dma].preserve = 0;
}
if (ctx->engines[dma].preserve) preserving = 1;
err = dma_nwl_stop_engine(ctx, dma);
if (err) return err;
}
// global cleanup, should we do anything?
if (!preserving) {
ctx->started = 0;
}
return 0;
}
if (dma > ctx->dmactx.pcilib->num_engines) return PCILIB_ERROR_INVALID_BANK;
// ignorign previous setting if flag specified
if (flags&PCILIB_DMA_FLAG_PERSISTENT) {
ctx->engines[dma].preserve = 0;
}
return dma_nwl_stop_engine(ctx, dma);
}
pcilib_dma_context_t *dma_nwl_init(pcilib_t *pcilib, const char *model, const void *arg) {
int i, j;
int err;
pcilib_dma_engine_t dma;
pcilib_register_description_t eregs[NWL_MAX_DMA_ENGINE_REGISTERS];
const pcilib_model_description_t *model_info = pcilib_get_model_description(pcilib);
nwl_dma_t *ctx = malloc(sizeof(nwl_dma_t));
if (!ctx) return NULL;
memset(ctx, 0, sizeof(nwl_dma_t));
pcilib_register_bank_t dma_bank = pcilib_find_register_bank_by_addr(pcilib, PCILIB_REGISTER_BANK_DMA);
if (dma_bank == PCILIB_REGISTER_BANK_INVALID) {
free(ctx);
pcilib_error("DMA Register Bank could not be found");
return NULL;
}
ctx->dma_bank = model_info->banks + dma_bank;
ctx->base_addr = pcilib_resolve_bar_address(pcilib, ctx->dma_bank->bar, ctx->dma_bank->read_addr);
if ((model)&&(strcasestr(model, "ipecamera"))) {
ctx->type = NWL_MODIFICATION_IPECAMERA;
ctx->ignore_eop = 1;
} else {
ctx->type = NWL_MODIFICATION_DEFAULT;
err = pcilib_add_registers(pcilib, PCILIB_MODEL_MODIFICATON_FLAGS_DEFAULT, 0, nwl_xrawdata_registers, NULL);
if (err) {
free(ctx);
pcilib_error("Error (%i) adding NWL XRAWDATA registers", err);
return NULL;
}
}
for (j = 0; nwl_dma_engine_registers[j].bits; j++);
if (j > NWL_MAX_DMA_ENGINE_REGISTERS) {
free(ctx);
pcilib_error("Too many (%i) engine registers defined, only %i supported", j, NWL_MAX_DMA_ENGINE_REGISTERS);
return NULL;
}
memcpy(eregs, nwl_dma_engine_registers, j * sizeof(pcilib_register_description_t));
for (i = 0; i < 2 * PCILIB_MAX_DMA_ENGINES; i++) {
pcilib_dma_engine_description_t edesc;
char *addr = ctx->base_addr + DMA_OFFSET + i * DMA_ENGINE_PER_SIZE;
memset(&edesc, 0, sizeof(pcilib_dma_engine_description_t));
err = dma_nwl_read_engine_config(ctx, &edesc, addr);
if (err) continue;
for (j = 0; nwl_dma_engine_registers[j].bits; j++) {
int dma_addr_len = (PCILIB_MAX_DMA_ENGINES > 9)?2:1;
const char *dma_direction;
eregs[j].name = nwl_dma_engine_register_names[i * NWL_MAX_DMA_ENGINE_REGISTERS + j];
eregs[j].addr = nwl_dma_engine_registers[j].addr + (addr - ctx->base_addr);
switch (edesc.direction) {
case PCILIB_DMA_FROM_DEVICE:
dma_direction = "r";
break;
case PCILIB_DMA_TO_DEVICE:
dma_direction = "w";
break;
default:
dma_direction = "";
}
sprintf((char*)eregs[j].name, nwl_dma_engine_registers[j].name, dma_addr_len, edesc.addr, dma_direction);
}
err = pcilib_add_registers(pcilib, PCILIB_MODEL_MODIFICATON_FLAGS_DEFAULT, j, eregs, NULL);
if (err) {
free(ctx);
pcilib_error("Error (%i) adding NWL DMA registers for engine %i", err, edesc.addr);
return NULL;
}
dma = pcilib_add_dma_engine(pcilib, &edesc);
if (dma == PCILIB_DMA_ENGINE_INVALID) {
free(ctx);
pcilib_error("Problem while registering DMA engine");
return NULL;
}
ctx->engines[dma].desc = &pcilib->engines[dma];
ctx->engines[dma].base_addr = addr;
}
return (pcilib_dma_context_t*)ctx;
}
void dma_nwl_free(pcilib_dma_context_t *vctx) {
nwl_dma_t *ctx = (nwl_dma_t*)vctx;
if (ctx) {
if (ctx->type == NWL_MODIFICATION_DEFAULT) dma_nwl_stop_loopback(ctx);
dma_nwl_free_irq(ctx);
dma_nwl_stop(vctx, PCILIB_DMA_ENGINE_ALL, PCILIB_DMA_FLAGS_DEFAULT);
free(ctx);
}
}
|