125};
126
127/*
128 * this holds all the stuff that should be done at load time
129 */
130static int
131ng_device_mod_event(module_t mod, int event, void *data)
132{
133 int error = 0;
134
135#ifdef NGD_DEBUG
136 printf("%s()\n",__func__);
137#endif /* NGD_DEBUG */
138
139 switch (event) {
140 case MOD_LOAD:
141
142 ng_device_init();
143 break;
144
145 case MOD_UNLOAD:
146 /* XXX do we need to do something specific ? */
147 /* ng_device_breakdown */
148 break;
149
150 default:
151 error = EOPNOTSUPP;
152 break;
153 }
154
155 return(error);
156}
157
158
159static int
160ng_device_init()
161{
162 struct ngd_softc *sc = &ngd_softc;
163
164#ifdef NGD_DEBUG
165 printf("%s()\n",__func__);
166#endif /* NGD_DEBUG */
167
168 SLIST_INIT(&sc->head);
169
170 if (ng_make_node_common(&typestruct, &sc->node) != 0) {
171 printf("%s(): ng_make_node_common failed\n",__func__);
172 return(ENXIO);
173 }
174 sprintf(sc->nodename, "%s", NG_DEVICE_NODE_TYPE);
175 if (ng_name_node(sc->node, sc->nodename)) {
176 NG_NODE_UNREF(sc->node); /* make it go away again */
177 printf("%s(): ng_name_node failed\n",__func__);
178 return(ENXIO);
179 }
180 NG_NODE_SET_PRIVATE(sc->node, sc);
181
182 return(0);
183}
184
185/*
186 * don't allow to be created, only the device can do that
187 */
188static int
189ng_device_cons(node_p node)
190{
191
192#ifdef NGD_DEBUG
193 printf("%s()\n",__func__);
194#endif /* NGD_DEBUG */
195
196 return(EINVAL);
197}
198
199/*
200 * Receive control message. We just bounce it back as a reply.
201 */
202static int
203ng_device_rcvmsg(node_p node, item_p item, hook_p lasthook)
204{
205 struct ngd_softc *sc = &ngd_softc;
206 struct ng_mesg *msg;
207 int error = 0;
208 struct ngd_connection * connection = NULL;
209 struct ngd_connection *tmp = NULL;
210
211#ifdef NGD_DEBUG
212 printf("%s()\n",__func__);
213#endif /* NGD_DEBUG */
214
215 NGI_GET_MSG(item, msg);
216
217 SLIST_FOREACH(tmp,&sc->head,links) {
218 if(tmp->active_hook == lasthook) {
219 connection = tmp;
220 }
221 }
222 if(connection == NULL) {
223 printf("%s(): connection is still NULL, no hook found\n",__func__);
224 return(-1);
225 }
226
227 return(error);
228}
229
230static int
231get_free_unit()
232{
233 struct ngd_connection *tmp = NULL;
234 struct ngd_softc *sc = &ngd_softc;
235 int n = 0;
236 int unit = -1;
237
238#ifdef NGD_DEBUG
239 printf("%s()\n",__func__);
240#endif /* NGD_DEBUG */
241
242 /* When there is no list yet, the first device unit is always 0. */
243 if SLIST_EMPTY(&sc->head) {
244 unit = 0;
245 return(unit);
246 }
247
248 /* Just do a brute force loop to find the first free unit that is
249 * smaller than MAX_NGD.
250 * Set MAX_NGD to a large value, doesn't impact performance.
251 */
252 for(n = 0;n<MAX_NGD && unit == -1;n++) {
253 SLIST_FOREACH(tmp,&sc->head,links) {
254
255 if(tmp->unit == n) {
256 unit = -1;
257 break;
258 }
259 unit = n;
260 }
261 }
262
263 return(unit);
264}
265
266/*
267 * incoming hook
268 */
269static int
270ng_device_newhook(node_p node, hook_p hook, const char *name)
271{
272 struct ngd_softc *sc = &ngd_softc;
273 struct ngd_connection * new_connection = NULL;
274
275#ifdef NGD_DEBUG
276 printf("%s()\n",__func__);
277#endif /* NGD_DEBUG */
278
279 new_connection = malloc(sizeof(struct ngd_connection), M_DEVBUF, M_NOWAIT);
280 if(new_connection == NULL) {
281 printf("%s(): ERROR: new_connection == NULL\n",__func__);
282 return(-1);
283 }
284
285 new_connection->unit = get_free_unit();
286 if(new_connection->unit<0) {
287 printf("%s: No free unit found by get_free_unit(), "
288 "increas MAX_NGD\n",__func__);
289 return(-1);
290 }
291 new_connection->ngddev = make_dev(&ngd_cdevsw, new_connection->unit, 0, 0,0600,"ngd%d",new_connection->unit);
292 if(new_connection->ngddev == NULL) {
293 printf("%s(): make_dev failed\n",__func__);
294 return(-1);
295 }
296
297 new_connection->readq = malloc(sizeof(char)*NGD_QUEUE_SIZE, M_DEVBUF, M_NOWAIT | M_ZERO);
298 if(new_connection->readq == NULL) {
299 printf("%s(): readq malloc failed\n",__func__);
300 return(-1);
301 }
302
303 /* point to begin of buffer */
304 new_connection->loc = 0;
305 new_connection->active_hook = hook;
306
307 SLIST_INSERT_HEAD(&sc->head, new_connection, links);
308
309 return(0);
310}
311
312/*
313 * we gave ok to a new hook
314 * now connect
315 */
316static int
317ng_device_connect(hook_p hook)
318{
319
320#ifdef NGD_DEBUG
321 printf("%s()\n",__func__);
322#endif /* NGD_DEBUG */
323
324 return(0);
325}
326
327
328/*
329 * Receive data from hook
330 */
331static int
332ng_device_rcvdata(hook_p hook, item_p item)
333{
334 struct mbuf *m;
335 struct ngd_softc *sc = &ngd_softc;
336 struct ngd_connection * connection = NULL;
337 struct ngd_connection * tmp;
338 char *buffer;
339
340#ifdef NGD_DEBUG
341 printf("%s()\n",__func__);
342#endif /* NGD_DEBUG */
343
344 SLIST_FOREACH(tmp,&sc->head,links) {
345 if(tmp->active_hook == hook) {
346 connection = tmp;
347 }
348 }
349 if(connection == NULL) {
350 printf("%s(): connection is still NULL, no hook found\n",__func__);
351 return(-1);
352 }
353
354 NGI_GET_M(item, m);
355 NG_FREE_ITEM(item);
356
357 m = m_pullup(m,m->m_len);
358 if(m == NULL) {
359 printf("%s(): ERROR: m_pullup failed\n",__func__);
360 return(-1);
361 }
362
363 buffer = malloc(sizeof(char)*m->m_len, M_DEVBUF, M_NOWAIT | M_ZERO);
364 if(buffer == NULL) {
365 printf("%s(): ERROR: buffer malloc failed\n",__func__);
366 return(-1);
367 }
368
369 buffer = mtod(m,char *);
370
371 if( (connection->loc+m->m_len) < NGD_QUEUE_SIZE) {
372 memcpy(connection->readq+connection->loc, buffer, m->m_len);
373 connection->loc += m->m_len;
374 } else
375 printf("%s(): queue full, first read out a bit\n",__func__);
376
377 free(buffer,M_DEVBUF);
378
379 return(0);
380}
381
382/*
383 * Removal of the last link destroys the node
384 */
385static int
386ng_device_disconnect(hook_p hook)
387{
388 struct ngd_softc *sc = &ngd_softc;
389 struct ngd_connection * connection = NULL;
390 struct ngd_connection * tmp;
391
392#ifdef NGD_DEBUG
393 printf("%s()\n",__func__);
394#endif /* NGD_DEBUG */
395
396 SLIST_FOREACH(tmp,&sc->head,links) {
397 if(tmp->active_hook == hook) {
398 connection = tmp;
399 }
400 }
401 if(connection == NULL) {
402 printf("%s(): connection is still NULL, no hook found\n",__func__);
403 return(-1);
404 }
405
406 free(connection->readq,M_DEVBUF);
407
408 destroy_dev(connection->ngddev);
409
410 SLIST_REMOVE(&sc->head,connection,ngd_connection,links);
411
412 return(0);
413}
414/*
415 * the device is opened
416 */
417static int
418ngdopen(dev_t dev, int flag, int mode, struct thread *td)
419{
420
421#ifdef NGD_DEBUG
422 printf("%s()\n",__func__);
423#endif /* NGD_DEBUG */
424
425 return(0);
426}
427
428/*
429 * the device is closed
430 */
431static int
432ngdclose(dev_t dev, int flag, int mode, struct thread *td)
433{
434
435#ifdef NGD_DEBUG
436 printf("%s()\n",__func__);
437#endif
438
439 return(0);
440}
441
442
443/*
444 * process ioctl
445 *
446 * they are translated into netgraph messages and passed on
447 *
448 */
449static int
450ngdioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct thread *td)
451{
452 struct ngd_softc *sc = &ngd_softc;
453 struct ngd_connection * connection = NULL;
454 struct ngd_connection * tmp;
455 int error = 0;
456 struct ng_mesg *msg;
457 struct ngd_param_s * datap;
458
459#ifdef NGD_DEBUG
460 printf("%s()\n",__func__);
461#endif /* NGD_DEBUG */
462
463 SLIST_FOREACH(tmp,&sc->head,links) {
464 if(tmp->ngddev == dev) {
465 connection = tmp;
466 }
467 }
468 if(connection == NULL) {
469 printf("%s(): connection is still NULL, no dev found\n",__func__);
470 return(-1);
471 }
472
473 /* NG_MKMESSAGE(msg, cookie, cmdid, len, how) */
474 NG_MKMESSAGE(msg, NGM_DEVICE_COOKIE, cmd, sizeof(struct ngd_param_s),
475 M_NOWAIT);
476 if (msg == NULL) {
477 printf("%s(): msg == NULL\n",__func__);
478 goto nomsg;
479 }
480
481 /* pass the ioctl data into the ->data area */
482 datap = (struct ngd_param_s *)msg->data;
483 datap->p = addr;
484
485 /* NG_SEND_MSG_HOOK(error, here, msg, hook, retaddr) */
486 NG_SEND_MSG_HOOK(error, sc->node, msg, connection->active_hook, NULL);
487 if(error)
488 printf("%s(): NG_SEND_MSG_HOOK error: %d\n",__func__,error);
489
490nomsg:
491
492 return(0);
493}
494
495
496/*
497 * This function is called when a read(2) is done to our device.
498 * We pass the data available in kernelspace on into userland using
499 * uiomove.
500 */
501static int
502ngdread(dev_t dev, struct uio *uio, int flag)
503{
504 int ret = 0, amnt;
505 char buffer[uio->uio_resid+1];
506 struct ngd_softc *sc = &ngd_softc;
507 struct ngd_connection * connection = NULL;
508 struct ngd_connection * tmp;
509
510#ifdef NGD_DEBUG
511 printf("%s()\n",__func__);
512#endif /* NGD_DEBUG */
513
514 SLIST_FOREACH(tmp,&sc->head,links) {
515 if(tmp->ngddev == dev) {
516 connection = tmp;
517 }
518 }
519 if(connection == NULL) {
520 printf("%s(): connection is still NULL, no dev found\n",__func__);
521 return(-1);
522 }
523
524 while ( ( uio->uio_resid > 0 ) && ( connection->loc > 0 ) ) {
525 amnt = MIN(uio->uio_resid,connection->loc);
526
527 memcpy(buffer,connection->readq, amnt);
528 memcpy(connection->readq, connection->readq+amnt,
529 connection->loc-amnt);
530 connection->loc -= amnt;
531
532 ret = uiomove((caddr_t)buffer, amnt, uio);
533 if(ret != 0)
534 goto error;
535
536 }
537 return(0);
538
539error:
540 printf("%s(): uiomove returns error %d\n",__func__,ret);
541 /* do error cleanup here */
542 return(ret);
543}
544
545
546/*
547 * This function is called when our device is written to.
548 * We read the data from userland into our local buffer and pass it on
549 * into the remote hook.
550 *
551 */
552static int
553ngdwrite(dev_t dev, struct uio *uio, int flag)
554{
555 int ret;
556 int error = 0;
557 struct mbuf *m;
558 char buffer[uio->uio_resid];
559 int len = uio->uio_resid;
560 struct ngd_softc *sc =& ngd_softc;
561 struct ngd_connection * connection = NULL;
562 struct ngd_connection * tmp;
563
564#ifdef NGD_DEBUG
565 printf("%s()\n",__func__);
566#endif /* NGD_DEBUG */
567
568 SLIST_FOREACH(tmp,&sc->head,links) {
569 if(tmp->ngddev == dev) {
570 connection = tmp;
571 }
572 }
573
574 if(connection == NULL) {
575 printf("%s(): connection is still NULL, no dev found\n",__func__);
576 return(-1);
577 }
578
579 if (len > 0) {
580 if ((ret = uiomove((caddr_t)buffer, len, uio)) != 0)
581 goto error;
582 } else
583 printf("%s(): len <= 0 : is this supposed to happen?!\n",__func__);
584
585 m = m_devget(buffer,len,0,NULL,NULL);
586
587 NG_SEND_DATA_ONLY(error,connection->active_hook,m);
588
589 return(0);
590
591error:
592 /* do error cleanup here */
593 printf("%s(): uiomove returned err: %d\n",__func__,ret);
594
595 return(ret);
596}
597
598/*
599 * we are being polled/selected
600 * check if there is data available for read
601 */
602static int
603ngdpoll(dev_t dev, int events, struct thread *td)
604{
605 int revents = 0;
606 struct ngd_softc *sc = &ngd_softc;
607 struct ngd_connection * connection = NULL;
608 struct ngd_connection * tmp;
609
610
611 if (events & (POLLIN | POLLRDNORM)) {
612 /* get the connection we have to know the loc from */
613 SLIST_FOREACH(tmp,&sc->head,links) {
614 if(tmp->ngddev == dev) {
615 connection = tmp;
616 }
617 }
618 if(connection == NULL) {
619 printf("%s(): ERROR: connection is still NULL,"
620 "no dev found\n",__func__);
621 return(-1);
622 }
623
624 if (connection->loc > 0)
625 revents |= events & (POLLIN | POLLRDNORM);
626 }
627
628 return(revents);
629}
| 123};
124
125/*
126 * this holds all the stuff that should be done at load time
127 */
128static int
129ng_device_mod_event(module_t mod, int event, void *data)
130{
131 int error = 0;
132
133#ifdef NGD_DEBUG
134 printf("%s()\n",__func__);
135#endif /* NGD_DEBUG */
136
137 switch (event) {
138 case MOD_LOAD:
139
140 ng_device_init();
141 break;
142
143 case MOD_UNLOAD:
144 /* XXX do we need to do something specific ? */
145 /* ng_device_breakdown */
146 break;
147
148 default:
149 error = EOPNOTSUPP;
150 break;
151 }
152
153 return(error);
154}
155
156
157static int
158ng_device_init()
159{
160 struct ngd_softc *sc = &ngd_softc;
161
162#ifdef NGD_DEBUG
163 printf("%s()\n",__func__);
164#endif /* NGD_DEBUG */
165
166 SLIST_INIT(&sc->head);
167
168 if (ng_make_node_common(&typestruct, &sc->node) != 0) {
169 printf("%s(): ng_make_node_common failed\n",__func__);
170 return(ENXIO);
171 }
172 sprintf(sc->nodename, "%s", NG_DEVICE_NODE_TYPE);
173 if (ng_name_node(sc->node, sc->nodename)) {
174 NG_NODE_UNREF(sc->node); /* make it go away again */
175 printf("%s(): ng_name_node failed\n",__func__);
176 return(ENXIO);
177 }
178 NG_NODE_SET_PRIVATE(sc->node, sc);
179
180 return(0);
181}
182
183/*
184 * don't allow to be created, only the device can do that
185 */
186static int
187ng_device_cons(node_p node)
188{
189
190#ifdef NGD_DEBUG
191 printf("%s()\n",__func__);
192#endif /* NGD_DEBUG */
193
194 return(EINVAL);
195}
196
197/*
198 * Receive control message. We just bounce it back as a reply.
199 */
200static int
201ng_device_rcvmsg(node_p node, item_p item, hook_p lasthook)
202{
203 struct ngd_softc *sc = &ngd_softc;
204 struct ng_mesg *msg;
205 int error = 0;
206 struct ngd_connection * connection = NULL;
207 struct ngd_connection *tmp = NULL;
208
209#ifdef NGD_DEBUG
210 printf("%s()\n",__func__);
211#endif /* NGD_DEBUG */
212
213 NGI_GET_MSG(item, msg);
214
215 SLIST_FOREACH(tmp,&sc->head,links) {
216 if(tmp->active_hook == lasthook) {
217 connection = tmp;
218 }
219 }
220 if(connection == NULL) {
221 printf("%s(): connection is still NULL, no hook found\n",__func__);
222 return(-1);
223 }
224
225 return(error);
226}
227
228static int
229get_free_unit()
230{
231 struct ngd_connection *tmp = NULL;
232 struct ngd_softc *sc = &ngd_softc;
233 int n = 0;
234 int unit = -1;
235
236#ifdef NGD_DEBUG
237 printf("%s()\n",__func__);
238#endif /* NGD_DEBUG */
239
240 /* When there is no list yet, the first device unit is always 0. */
241 if SLIST_EMPTY(&sc->head) {
242 unit = 0;
243 return(unit);
244 }
245
246 /* Just do a brute force loop to find the first free unit that is
247 * smaller than MAX_NGD.
248 * Set MAX_NGD to a large value, doesn't impact performance.
249 */
250 for(n = 0;n<MAX_NGD && unit == -1;n++) {
251 SLIST_FOREACH(tmp,&sc->head,links) {
252
253 if(tmp->unit == n) {
254 unit = -1;
255 break;
256 }
257 unit = n;
258 }
259 }
260
261 return(unit);
262}
263
264/*
265 * incoming hook
266 */
267static int
268ng_device_newhook(node_p node, hook_p hook, const char *name)
269{
270 struct ngd_softc *sc = &ngd_softc;
271 struct ngd_connection * new_connection = NULL;
272
273#ifdef NGD_DEBUG
274 printf("%s()\n",__func__);
275#endif /* NGD_DEBUG */
276
277 new_connection = malloc(sizeof(struct ngd_connection), M_DEVBUF, M_NOWAIT);
278 if(new_connection == NULL) {
279 printf("%s(): ERROR: new_connection == NULL\n",__func__);
280 return(-1);
281 }
282
283 new_connection->unit = get_free_unit();
284 if(new_connection->unit<0) {
285 printf("%s: No free unit found by get_free_unit(), "
286 "increas MAX_NGD\n",__func__);
287 return(-1);
288 }
289 new_connection->ngddev = make_dev(&ngd_cdevsw, new_connection->unit, 0, 0,0600,"ngd%d",new_connection->unit);
290 if(new_connection->ngddev == NULL) {
291 printf("%s(): make_dev failed\n",__func__);
292 return(-1);
293 }
294
295 new_connection->readq = malloc(sizeof(char)*NGD_QUEUE_SIZE, M_DEVBUF, M_NOWAIT | M_ZERO);
296 if(new_connection->readq == NULL) {
297 printf("%s(): readq malloc failed\n",__func__);
298 return(-1);
299 }
300
301 /* point to begin of buffer */
302 new_connection->loc = 0;
303 new_connection->active_hook = hook;
304
305 SLIST_INSERT_HEAD(&sc->head, new_connection, links);
306
307 return(0);
308}
309
310/*
311 * we gave ok to a new hook
312 * now connect
313 */
314static int
315ng_device_connect(hook_p hook)
316{
317
318#ifdef NGD_DEBUG
319 printf("%s()\n",__func__);
320#endif /* NGD_DEBUG */
321
322 return(0);
323}
324
325
326/*
327 * Receive data from hook
328 */
329static int
330ng_device_rcvdata(hook_p hook, item_p item)
331{
332 struct mbuf *m;
333 struct ngd_softc *sc = &ngd_softc;
334 struct ngd_connection * connection = NULL;
335 struct ngd_connection * tmp;
336 char *buffer;
337
338#ifdef NGD_DEBUG
339 printf("%s()\n",__func__);
340#endif /* NGD_DEBUG */
341
342 SLIST_FOREACH(tmp,&sc->head,links) {
343 if(tmp->active_hook == hook) {
344 connection = tmp;
345 }
346 }
347 if(connection == NULL) {
348 printf("%s(): connection is still NULL, no hook found\n",__func__);
349 return(-1);
350 }
351
352 NGI_GET_M(item, m);
353 NG_FREE_ITEM(item);
354
355 m = m_pullup(m,m->m_len);
356 if(m == NULL) {
357 printf("%s(): ERROR: m_pullup failed\n",__func__);
358 return(-1);
359 }
360
361 buffer = malloc(sizeof(char)*m->m_len, M_DEVBUF, M_NOWAIT | M_ZERO);
362 if(buffer == NULL) {
363 printf("%s(): ERROR: buffer malloc failed\n",__func__);
364 return(-1);
365 }
366
367 buffer = mtod(m,char *);
368
369 if( (connection->loc+m->m_len) < NGD_QUEUE_SIZE) {
370 memcpy(connection->readq+connection->loc, buffer, m->m_len);
371 connection->loc += m->m_len;
372 } else
373 printf("%s(): queue full, first read out a bit\n",__func__);
374
375 free(buffer,M_DEVBUF);
376
377 return(0);
378}
379
380/*
381 * Removal of the last link destroys the node
382 */
383static int
384ng_device_disconnect(hook_p hook)
385{
386 struct ngd_softc *sc = &ngd_softc;
387 struct ngd_connection * connection = NULL;
388 struct ngd_connection * tmp;
389
390#ifdef NGD_DEBUG
391 printf("%s()\n",__func__);
392#endif /* NGD_DEBUG */
393
394 SLIST_FOREACH(tmp,&sc->head,links) {
395 if(tmp->active_hook == hook) {
396 connection = tmp;
397 }
398 }
399 if(connection == NULL) {
400 printf("%s(): connection is still NULL, no hook found\n",__func__);
401 return(-1);
402 }
403
404 free(connection->readq,M_DEVBUF);
405
406 destroy_dev(connection->ngddev);
407
408 SLIST_REMOVE(&sc->head,connection,ngd_connection,links);
409
410 return(0);
411}
412/*
413 * the device is opened
414 */
415static int
416ngdopen(dev_t dev, int flag, int mode, struct thread *td)
417{
418
419#ifdef NGD_DEBUG
420 printf("%s()\n",__func__);
421#endif /* NGD_DEBUG */
422
423 return(0);
424}
425
426/*
427 * the device is closed
428 */
429static int
430ngdclose(dev_t dev, int flag, int mode, struct thread *td)
431{
432
433#ifdef NGD_DEBUG
434 printf("%s()\n",__func__);
435#endif
436
437 return(0);
438}
439
440
441/*
442 * process ioctl
443 *
444 * they are translated into netgraph messages and passed on
445 *
446 */
447static int
448ngdioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct thread *td)
449{
450 struct ngd_softc *sc = &ngd_softc;
451 struct ngd_connection * connection = NULL;
452 struct ngd_connection * tmp;
453 int error = 0;
454 struct ng_mesg *msg;
455 struct ngd_param_s * datap;
456
457#ifdef NGD_DEBUG
458 printf("%s()\n",__func__);
459#endif /* NGD_DEBUG */
460
461 SLIST_FOREACH(tmp,&sc->head,links) {
462 if(tmp->ngddev == dev) {
463 connection = tmp;
464 }
465 }
466 if(connection == NULL) {
467 printf("%s(): connection is still NULL, no dev found\n",__func__);
468 return(-1);
469 }
470
471 /* NG_MKMESSAGE(msg, cookie, cmdid, len, how) */
472 NG_MKMESSAGE(msg, NGM_DEVICE_COOKIE, cmd, sizeof(struct ngd_param_s),
473 M_NOWAIT);
474 if (msg == NULL) {
475 printf("%s(): msg == NULL\n",__func__);
476 goto nomsg;
477 }
478
479 /* pass the ioctl data into the ->data area */
480 datap = (struct ngd_param_s *)msg->data;
481 datap->p = addr;
482
483 /* NG_SEND_MSG_HOOK(error, here, msg, hook, retaddr) */
484 NG_SEND_MSG_HOOK(error, sc->node, msg, connection->active_hook, NULL);
485 if(error)
486 printf("%s(): NG_SEND_MSG_HOOK error: %d\n",__func__,error);
487
488nomsg:
489
490 return(0);
491}
492
493
494/*
495 * This function is called when a read(2) is done to our device.
496 * We pass the data available in kernelspace on into userland using
497 * uiomove.
498 */
499static int
500ngdread(dev_t dev, struct uio *uio, int flag)
501{
502 int ret = 0, amnt;
503 char buffer[uio->uio_resid+1];
504 struct ngd_softc *sc = &ngd_softc;
505 struct ngd_connection * connection = NULL;
506 struct ngd_connection * tmp;
507
508#ifdef NGD_DEBUG
509 printf("%s()\n",__func__);
510#endif /* NGD_DEBUG */
511
512 SLIST_FOREACH(tmp,&sc->head,links) {
513 if(tmp->ngddev == dev) {
514 connection = tmp;
515 }
516 }
517 if(connection == NULL) {
518 printf("%s(): connection is still NULL, no dev found\n",__func__);
519 return(-1);
520 }
521
522 while ( ( uio->uio_resid > 0 ) && ( connection->loc > 0 ) ) {
523 amnt = MIN(uio->uio_resid,connection->loc);
524
525 memcpy(buffer,connection->readq, amnt);
526 memcpy(connection->readq, connection->readq+amnt,
527 connection->loc-amnt);
528 connection->loc -= amnt;
529
530 ret = uiomove((caddr_t)buffer, amnt, uio);
531 if(ret != 0)
532 goto error;
533
534 }
535 return(0);
536
537error:
538 printf("%s(): uiomove returns error %d\n",__func__,ret);
539 /* do error cleanup here */
540 return(ret);
541}
542
543
544/*
545 * This function is called when our device is written to.
546 * We read the data from userland into our local buffer and pass it on
547 * into the remote hook.
548 *
549 */
550static int
551ngdwrite(dev_t dev, struct uio *uio, int flag)
552{
553 int ret;
554 int error = 0;
555 struct mbuf *m;
556 char buffer[uio->uio_resid];
557 int len = uio->uio_resid;
558 struct ngd_softc *sc =& ngd_softc;
559 struct ngd_connection * connection = NULL;
560 struct ngd_connection * tmp;
561
562#ifdef NGD_DEBUG
563 printf("%s()\n",__func__);
564#endif /* NGD_DEBUG */
565
566 SLIST_FOREACH(tmp,&sc->head,links) {
567 if(tmp->ngddev == dev) {
568 connection = tmp;
569 }
570 }
571
572 if(connection == NULL) {
573 printf("%s(): connection is still NULL, no dev found\n",__func__);
574 return(-1);
575 }
576
577 if (len > 0) {
578 if ((ret = uiomove((caddr_t)buffer, len, uio)) != 0)
579 goto error;
580 } else
581 printf("%s(): len <= 0 : is this supposed to happen?!\n",__func__);
582
583 m = m_devget(buffer,len,0,NULL,NULL);
584
585 NG_SEND_DATA_ONLY(error,connection->active_hook,m);
586
587 return(0);
588
589error:
590 /* do error cleanup here */
591 printf("%s(): uiomove returned err: %d\n",__func__,ret);
592
593 return(ret);
594}
595
596/*
597 * we are being polled/selected
598 * check if there is data available for read
599 */
600static int
601ngdpoll(dev_t dev, int events, struct thread *td)
602{
603 int revents = 0;
604 struct ngd_softc *sc = &ngd_softc;
605 struct ngd_connection * connection = NULL;
606 struct ngd_connection * tmp;
607
608
609 if (events & (POLLIN | POLLRDNORM)) {
610 /* get the connection we have to know the loc from */
611 SLIST_FOREACH(tmp,&sc->head,links) {
612 if(tmp->ngddev == dev) {
613 connection = tmp;
614 }
615 }
616 if(connection == NULL) {
617 printf("%s(): ERROR: connection is still NULL,"
618 "no dev found\n",__func__);
619 return(-1);
620 }
621
622 if (connection->loc > 0)
623 revents |= events & (POLLIN | POLLRDNORM);
624 }
625
626 return(revents);
627}
|