netmap-tutorial/solutions/fe.c at master · netmap-unipi/netmap-tutorial · GitHub

History

390 lines (339 loc) · 10.7 KB

Raw

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

190

191

192

193

194

195

196

197

198

199

200

201

202

203

204

205

206

207

208

209

210

211

212

213

214

215

216

217

218

219

220

221

222

223

224

225

226

227

228

229

230

231

232

233

234

235

236

237

238

239

240

241

242

243

244

245

246

247

248

249

250

251

252

253

254

255

256

257

258

259

260

261

262

263

264

265

266

267

268

269

270

271

272

273

274

275

276

277

278

279

280

281

282

283

284

285

286

287

288

289

290

291

292

293

294

295

296

297

298

299

300

301

302

303

304

305

306

307

308

309

310

311

312

313

314

315

316

317

318

319

320

321

322

323

324

325

326

327

328

329

330

331

332

333

334

335

336

337

338

339

340

341

342

343

344

345

346

347

348

349

350

351

352

353

354

355

356

357

358

359

360

361

362

363

364

365

366

367

368

369

370

371

372

373

374

375

376

377

378

379

380

381

382

383

384

385

386

387

388

389

390

* This program reads UDP packets from the first netmap port and

* selectively forwards them to the second or third port, depending

* on the UDP destination port. The user can specify two UDP ports A and

* B by command line: packets with destination port A will be forwarded

* to the second netmap port; packets with destination port B will be

* forwarded to the third netmap port; all the other packets are

* dropped.

#include <stdio.h>

#include <stdlib.h>

#include <unistd.h>

#include <signal.h>

#include <errno.h>

#include <poll.h>

#include <net/if.h>

#include <stdint.h>

#include <net/netmap.h>

#define NETMAP_WITH_LIBS

#include <net/netmap_user.h>

#include <sys/socket.h>

#include <netinet/in.h>

#include <netinet/if_ether.h>

#include <netinet/ip.h>

#include <netinet/udp.h>

#include <netinet/tcp.h>

static int stop = 0;

static unsigned long long fwdback = 0;

static unsigned long long fwda = 0;

static unsigned long long fwdb = 0;

static unsigned long long tot = 0;

static void

sigint_handler(int signum)

{

stop = 1;

}

static int

rx_ready(struct nm_desc *nmd)

{

unsigned int ri;

for (ri = nmd->first_rx_ring; ri <= nmd->last_rx_ring; ri++) {

struct netmap_ring *ring;

ring = NETMAP_RXRING(nmd->nifp, ri);

if (nm_ring_space(ring)) {

return 1; /* there is something to read */

}

return 0;

}

static inline int

pkt_get_udp_port(const char *buf)

{

struct ether_header *ethh;

struct ip *iph;

struct udphdr *udph;

ethh = (struct ether_header *)buf;

if (ethh->ether_type != htons(ETHERTYPE_IP)) {

/* Filter out non-IP traffic. */

return 0;

}

iph = (struct ip *)(ethh + 1);

if (iph->ip_p != IPPROTO_UDP) {

/* Filter out non-UDP traffic. */

return 0;

}

udph = (struct udphdr *)(iph + 1);

/* Return destination port. */

return ntohs(udph->uh_dport);

}

#ifdef SOLUTION

static int

pkt_copy_or_drop(struct nm_desc *dst, const char *buf, unsigned len)

{

unsigned int di;

for (di = dst->first_tx_ring; di <= dst->last_tx_ring; di++) {

struct netmap_ring *txring = NETMAP_TXRING(dst->nifp, di);

if (nm_ring_space(txring)) {

struct netmap_slot *ts = &txring->slot[txring->head];

char *txbuf = NETMAP_BUF(txring, ts->buf_idx);

ts->len = len;

memcpy(txbuf, buf, len);

txring->cur = txring->head = nm_ring_next(txring, txring->head);

return 1;

}

return 0;

}

static void

route_forward(struct nm_desc *one, struct nm_desc *two, struct nm_desc *three,

unsigned int udp_port_a, unsigned int udp_port_b)

{

unsigned int si = one->first_rx_ring;

while (si <= one->last_rx_ring) {

struct netmap_ring *rxring;

unsigned int rxhead;

int nrx;

rxring = NETMAP_RXRING(one->nifp, si);

nrx = nm_ring_space(rxring);

if (nrx == 0) {

si++;

continue;

}

rxhead = rxring->head;

for (; nrx > 0; nrx--, rxhead = nm_ring_next(rxring, rxhead)) {

struct netmap_slot *rs = &rxring->slot[rxhead];

char *rxbuf = NETMAP_BUF(rxring, rs->buf_idx);

int udp_port = pkt_get_udp_port(rxbuf);

if (udp_port == udp_port_a) {

fwda += pkt_copy_or_drop(two, rxbuf, rs->len);

} else if (udp_port == udp_port_b) {

fwdb += pkt_copy_or_drop(three, rxbuf, rs->len);

}

tot++;

}

rxring->head = rxring->cur = rxhead;

}

#endif /* SOLUTION */

static void

forward_pkts(struct nm_desc *src, struct nm_desc *dst)

{

unsigned int si = src->first_rx_ring;

unsigned int di = dst->first_tx_ring;

while (si <= src->last_rx_ring && di <= dst->last_tx_ring) {

struct netmap_ring *txring;

struct netmap_ring *rxring;

unsigned int rxhead, txhead;

int nrx, ntx;

rxring = NETMAP_RXRING(src->nifp, si);

txring = NETMAP_TXRING(dst->nifp, di);

nrx = nm_ring_space(rxring);

ntx = nm_ring_space(txring);

if (nrx == 0) {

si++;

continue;

}

if (ntx == 0) {

di++;

continue;

}

rxhead = rxring->head;

txhead = txring->head;

for (; nrx > 0 && ntx > 0;

nrx--, rxhead = nm_ring_next(rxring, rxhead), tot++) {

struct netmap_slot *rs = &rxring->slot[rxhead];

struct netmap_slot *ts = &txring->slot[txhead];

char *rxbuf = NETMAP_BUF(rxring, rs->buf_idx);

char *txbuf = NETMAP_BUF(txring, ts->buf_idx);

ts->len = rs->len;

memcpy(txbuf, rxbuf, ts->len);

txhead = nm_ring_next(txring, txhead);

ntx--;

fwdback++;

tot++;

}

/* Update state of netmap ring. */

rxring->head = rxring->cur = rxhead;

txring->head = txring->cur = txhead;

}

static int

main_loop(const char *netmap_port_one, const char *netmap_port_two,

const char *netmap_port_three, int udp_port_a, int udp_port_b)

{

struct nm_desc *nmd_one;

struct nm_desc *nmd_two;

struct nm_desc *nmd_three;

nmd_one = nm_open(netmap_port_one, NULL, 0, NULL);

if (nmd_one == NULL) {

if (!errno) {

printf("Failed to nm_open(%s): not a netmap port\n",

netmap_port_one);

} else {

printf("Failed to nm_open(%s): %s\n", netmap_port_one,

strerror(errno));

}

return -1;

}

nmd_two = nm_open(netmap_port_two, NULL, 0, NULL);

if (nmd_two == NULL) {

if (!errno) {

printf("Failed to nm_open(%s): not a netmap port\n",

netmap_port_two);

} else {

printf("Failed to nm_open(%s): %s\n", netmap_port_two,

strerror(errno));

}

return -1;

}

nmd_three = nm_open(netmap_port_three, NULL, 0, NULL);

if (nmd_three == NULL) {

if (!errno) {

printf("Failed to nm_open(%s): not a netmap port\n",

netmap_port_three);

} else {

printf("Failed to nm_open(%s): %s\n", netmap_port_three,

strerror(errno));

}

return -1;

}

while (!stop) {

#ifdef SOLUTION

struct pollfd pfd[3];

int ret;

int two_ready, three_ready;

pfd[0].fd = nmd_one->fd;

pfd[1].fd = nmd_two->fd;

pfd[2].fd = nmd_three->fd;

pfd[0].events = POLLIN;

pfd[1].events = 0;

pfd[2].events = 0;

/* We don't wait for TX space on ports two and three to avoid head of

* line blocking (we don't know in advance which packets are going to

* be forwarded where). As a result, unfortunately, we may end dropping

* packets. */

two_ready = rx_ready(nmd_two);

three_ready = rx_ready(nmd_three);

if (!two_ready) {

pfd[1].events |= POLLIN;

}

if (!three_ready) {

pfd[2].events |= POLLIN;

}

/* We can wait for TX space on port one, because we know all traffic

* coming from ports two and three unconditionally goes to port one. */

if (two_ready || three_ready) {

pfd[0].events |= POLLOUT;

}

/* We poll with a timeout to have a chance to break the main loop if

* no packets are coming. */

ret = poll(pfd, 3, 1000);

if (ret < 0) {

perror("poll()");

} else if (ret == 0) {

/* Timeout */

continue;

}

/* Route and forward from port one to ports two and three. */

route_forward(nmd_one, nmd_two, nmd_three, udp_port_a, udp_port_b);

#endif /* SOLUTION */

/* Forward traffic from ports two and three back to port one. */

forward_pkts(nmd_two, nmd_one);

forward_pkts(nmd_three, nmd_one);

}

nm_close(nmd_one);

nm_close(nmd_two);

nm_close(nmd_three);

printf("Total processed packets: %llu\n", tot);

printf("Forwarded to port one : %llu\n", fwdback);

printf("Forwarded to port two : %llu\n", fwda);

printf("Forwarded to port three: %llu\n", fwdb);

return 0;

}

static void

usage(char **argv)

{

printf("usage: %s [-h] [-i NETMAP_PORT_ONE] "

"[-i NETMAP_PORT_TWO] [-i NETMAP_PORT_THREE] "

"[-p UDP_PORT_A] [-p UDP_PORT_B]\n",

argv[0]);

exit(EXIT_SUCCESS);

}

int

main(int argc, char **argv)

{

const char *netmap_port_one = NULL;

const char *netmap_port_two = NULL;

const char *netmap_port_three = NULL;

int udp_port;

int udp_port_a = 8000;

int udp_port_b = 8001;

int udp_port_args = 0;

struct sigaction sa;

int opt;

int ret;

while ((opt = getopt(argc, argv, "hi:p:")) != -1) {

switch (opt) {

case 'h':

usage(argv);

return 0;

case 'i':

if (netmap_port_one == NULL) {

netmap_port_one = optarg;

} else if (netmap_port_two == NULL) {

netmap_port_two = optarg;

} else if (netmap_port_three == NULL) {

netmap_port_three = optarg;

}

break;

case 'p':

udp_port = atoi(optarg);

if (udp_port <= 0 || udp_port >= 65535) {

printf(" invalid UDP port %s\n", optarg);

usage(argv);

}

switch (udp_port_args) {

case 0:

udp_port_a = udp_port;

break;

case 1:

udp_port_b = udp_port;

break;

}

udp_port_args++;

break;

default:

printf(" unrecognized option '-%c'\n", opt);

usage(argv);

return -1;

}

if (netmap_port_one == NULL) {

printf(" missing netmap port #1\n");

usage(argv);

}

if (netmap_port_two == NULL) {

printf(" missing netmap port #2\n");

usage(argv);

}

/* Register Ctrl-C handler. */

sa.sa_handler = sigint_handler;

sigemptyset(&sa.sa_mask);

sa.sa_flags = SA_RESTART;

ret = sigaction(SIGINT, &sa, NULL);

if (ret) {

perror("sigaction(SIGINT)");

exit(EXIT_FAILURE);

}

(void)rx_ready;

printf("Port one : %s\n", netmap_port_one);

printf("Port two : %s\n", netmap_port_two);

printf("Port three: %s\n", netmap_port_three);

printf("UDP port A: %d\n", udp_port_a);

printf("UDP port B: %d\n", udp_port_b);

main_loop(netmap_port_one, netmap_port_two, netmap_port_three, udp_port_a,

udp_port_b);

(void)pkt_get_udp_port;

return 0;

}

netmap-tutorial/solutions/fe.c at master · netmap-unipi/netmap-tutorial · GitHub

Expand file tree

Breadcrumbs

fe.c

Latest commit

History

Breadcrumbs

fe.c

File metadata and controls