sys/dev/xdma/xdma_mbuf.c

   1 /*-
   2  * Copyright (c) 2017-2019 Ruslan Bukin <br@bsdpad.com>
   3  * All rights reserved.
   4  *
   5  * This software was developed by SRI International and the University of
   6  * Cambridge Computer Laboratory under DARPA/AFRL contract FA8750-10-C-0237
   7  * ("CTSRD"), as part of the DARPA CRASH research programme.
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  28  * SUCH DAMAGE.
  29  */
  30
  31 #include <sys/cdefs.h>
  32 __FBSDID("$FreeBSD$");
  33
  34 #include "opt_platform.h"
  35 #include <sys/param.h>
  36 #include <sys/conf.h>
  37 #include <sys/bus.h>
  38 #include <sys/kernel.h>
  39 #include <sys/lock.h>
  40 #include <sys/mbuf.h>
  41 #include <sys/mutex.h>
  42
  43 #include <machine/bus.h>
  44
  45 #ifdef FDT
  46 #include <dev/fdt/fdt_common.h>
  47 #include <dev/ofw/ofw_bus.h>
  48 #include <dev/ofw/ofw_bus_subr.h>
  49 #endif
  50
  51 #include <dev/xdma/xdma.h>
  52
  53 int
  54 xdma_dequeue_mbuf(xdma_channel_t *xchan, struct mbuf **mp,
  55     xdma_transfer_status_t *status)
  56 {
  57         struct xdma_request *xr;
  58         struct xdma_request *xr_tmp;
  59
  60         QUEUE_OUT_LOCK(xchan);
  61         TAILQ_FOREACH_SAFE(xr, &xchan->queue_out, xr_next, xr_tmp) {
  62                 TAILQ_REMOVE(&xchan->queue_out, xr, xr_next);
  63                 break;
  64         }
  65         QUEUE_OUT_UNLOCK(xchan);
  66
  67         if (xr == NULL)
  68                 return (-1);
  69
  70         *mp = xr->m;
  71         status->error = xr->status.error;
  72         status->transferred = xr->status.transferred;
  73
  74         xchan_bank_put(xchan, xr);
  75
  76         return (0);
  77 }
  78
  79 int
  80 xdma_enqueue_mbuf(xdma_channel_t *xchan, struct mbuf **mp,
  81     uintptr_t addr, uint8_t src_width, uint8_t dst_width,
  82     enum xdma_direction dir)
  83 {
  84         struct xdma_request *xr;
  85         xdma_controller_t *xdma;
  86
  87         xdma = xchan->xdma;
  88
  89         xr = xchan_bank_get(xchan);
  90         if (xr == NULL)
  91                 return (-1); /* No space is available yet. */
  92
  93         xr->direction = dir;
  94         xr->m = *mp;
  95         xr->req_type = XR_TYPE_MBUF;
  96         if (dir == XDMA_MEM_TO_DEV) {
  97                 xr->dst_addr = addr;
  98                 xr->src_addr = 0;
  99         } else {
 100                 xr->src_addr = addr;
 101                 xr->dst_addr = 0;
 102         }
 103         xr->src_width = src_width;
 104         xr->dst_width = dst_width;
 105
 106         QUEUE_IN_LOCK(xchan);
 107         TAILQ_INSERT_TAIL(&xchan->queue_in, xr, xr_next);
 108         QUEUE_IN_UNLOCK(xchan);
 109
 110         return (0);
 111 }
 112
 113 uint32_t
 114 xdma_mbuf_chain_count(struct mbuf *m0)
 115 {
 116         struct mbuf *m;
 117         uint32_t c;
 118
 119         c = 0;
 120
 121         for (m = m0; m != NULL; m = m->m_next)
 122                 c++;
 123
 124         return (c);
 125 }
 126
 127 uint32_t
 128 xdma_mbuf_defrag(xdma_channel_t *xchan, struct xdma_request *xr)
 129 {
 130         xdma_controller_t *xdma;
 131         struct mbuf *m;
 132         uint32_t c;
 133
 134         xdma = xchan->xdma;
 135
 136         c = xdma_mbuf_chain_count(xr->m);
 137         if (c == 1)
 138                 return (c); /* Nothing to do. */
 139
 140         if ((m = m_defrag(xr->m, M_NOWAIT)) == NULL) {
 141                 device_printf(xdma->dma_dev,
 142                     "%s: Can't defrag mbuf\n",
 143                     __func__);
 144                 return (c);
 145         }
 146
 147         xr->m = m;
 148         c = 1;
 149
 150         return (c);
 151 }