2 * Copyright (c) 2015 Marcel Moolenaar
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/ioctl.h>
43 #include "../../sys/dev/proto/proto_dev.h"
48 #define OBJ_TYPE_NONE 0
49 #define OBJ_TYPE_TAG 1
51 #define OBJ_TYPE_SEG 3
60 unsigned long maxaddr;
62 unsigned long maxsegsz;
64 unsigned long datarate;
69 #define BUSDMA_MD_BUS 0
70 #define BUSDMA_MD_PHYS 1
71 #define BUSDMA_MD_VIRT 2
75 unsigned long address;
81 static struct obj **oidtbl = NULL;
87 struct obj **newtbl, *obj;
90 obj = calloc(1, sizeof(struct obj));
93 for (oid = 0; oid < noids; oid++) {
98 newtbl = realloc(oidtbl, sizeof(struct obj *) * (noids + 1));
112 obj_free(struct obj *obj)
115 oidtbl[obj->oid] = NULL;
121 obj_lookup(int oid, u_int type)
125 if (oid < 0 || oid >= noids) {
130 if (obj->refcnt == 0) {
134 if (type != OBJ_TYPE_NONE && obj->type != type) {
142 bd_tag_new(struct obj *ptag, int fd, u_long align, u_long bndry,
143 u_long maxaddr, u_long maxsz, u_int nsegs, u_long maxsegsz,
144 u_int datarate, u_int flags)
146 struct proto_ioc_busdma ioc;
149 tag = obj_alloc(OBJ_TYPE_TAG);
153 memset(&ioc, 0, sizeof(ioc));
154 ioc.request = (ptag != NULL) ? PROTO_IOC_BUSDMA_TAG_DERIVE :
155 PROTO_IOC_BUSDMA_TAG_CREATE;
156 ioc.key = (ptag != NULL) ? ptag->key : 0;
157 ioc.u.tag.align = align;
158 ioc.u.tag.bndry = bndry;
159 ioc.u.tag.maxaddr = maxaddr;
160 ioc.u.tag.maxsz = maxsz;
161 ioc.u.tag.nsegs = nsegs;
162 ioc.u.tag.maxsegsz = maxsegsz;
163 ioc.u.tag.datarate = datarate;
164 ioc.u.tag.flags = flags;
165 if (ioctl(fd, PROTO_IOC_BUSDMA, &ioc) == -1) {
172 tag->key = ioc.result;
173 tag->u.tag.align = ioc.u.tag.align;
174 tag->u.tag.bndry = ioc.u.tag.bndry;
175 tag->u.tag.maxaddr = ioc.u.tag.maxaddr;
176 tag->u.tag.maxsz = ioc.u.tag.maxsz;
177 tag->u.tag.maxsegsz = ioc.u.tag.maxsegsz;
178 tag->u.tag.nsegs = ioc.u.tag.nsegs;
179 tag->u.tag.datarate = ioc.u.tag.datarate;
184 bd_tag_create(const char *dev, u_long align, u_long bndry, u_long maxaddr,
185 u_long maxsz, u_int nsegs, u_long maxsegsz, u_int datarate, u_int flags)
191 len = snprintf(path, PATH_MAX, "/dev/proto/%s/busdma", dev);
192 if (len >= PATH_MAX) {
196 fd = open(path, O_RDWR);
200 tag = bd_tag_new(NULL, fd, align, bndry, maxaddr, maxsz, nsegs,
201 maxsegsz, datarate, flags);
210 bd_tag_derive(int ptid, u_long align, u_long bndry, u_long maxaddr,
211 u_long maxsz, u_int nsegs, u_long maxsegsz, u_int datarate, u_int flags)
213 struct obj *ptag, *tag;
215 ptag = obj_lookup(ptid, OBJ_TYPE_TAG);
219 tag = bd_tag_new(ptag, ptag->fd, align, bndry, maxaddr, maxsz, nsegs,
220 maxsegsz, datarate, flags);
228 bd_tag_destroy(int tid)
230 struct proto_ioc_busdma ioc;
231 struct obj *ptag, *tag;
233 tag = obj_lookup(tid, OBJ_TYPE_TAG);
239 memset(&ioc, 0, sizeof(ioc));
240 ioc.request = PROTO_IOC_BUSDMA_TAG_DESTROY;
242 if (ioctl(tag->fd, PROTO_IOC_BUSDMA, &ioc) == -1)
245 if (tag->parent != NULL)
246 tag->parent->refcnt--;
254 bd_md_add_seg(struct obj *md, int type, u_long addr, u_long size)
258 seg = obj_alloc(OBJ_TYPE_SEG);
263 seg->u.seg.address = addr;
264 seg->u.seg.size = size;
266 md->u.md.seg[type] = seg;
267 md->u.md.nsegs[type] = 1;
272 bd_md_del_segs(struct obj *md, int type, int unmap)
274 struct obj *seg, *seg0;
276 for (seg = md->u.md.seg[type]; seg != NULL; seg = seg0) {
278 munmap((void *)seg->u.seg.address, seg->u.seg.size);
279 seg0 = seg->u.seg.next;
286 bd_md_create(int tid, u_int flags)
288 struct proto_ioc_busdma ioc;
289 struct obj *md, *tag;
291 tag = obj_lookup(tid, OBJ_TYPE_TAG);
295 md = obj_alloc(OBJ_TYPE_MD);
299 memset(&ioc, 0, sizeof(ioc));
300 ioc.request = PROTO_IOC_BUSDMA_MD_CREATE;
301 ioc.u.md.tag = tag->key;
302 ioc.u.md.flags = flags;
303 if (ioctl(tag->fd, PROTO_IOC_BUSDMA, &ioc) == -1) {
312 md->key = ioc.result;
317 bd_md_destroy(int mdid)
319 struct proto_ioc_busdma ioc;
322 md = obj_lookup(mdid, OBJ_TYPE_MD);
326 memset(&ioc, 0, sizeof(ioc));
327 ioc.request = PROTO_IOC_BUSDMA_MD_DESTROY;
329 if (ioctl(md->fd, PROTO_IOC_BUSDMA, &ioc) == -1)
332 md->parent->refcnt--;
338 bd_md_load(int mdid, void *buf, u_long len, u_int flags)
340 struct proto_ioc_busdma ioc;
344 md = obj_lookup(mdid, OBJ_TYPE_MD);
348 memset(&ioc, 0, sizeof(ioc));
349 ioc.request = PROTO_IOC_BUSDMA_MD_LOAD;
351 ioc.u.md.flags = flags;
352 ioc.u.md.virt_addr = (uintptr_t)buf;
353 ioc.u.md.virt_size = len;
354 if (ioctl(md->fd, PROTO_IOC_BUSDMA, &ioc) == -1)
357 error = bd_md_add_seg(md, BUSDMA_MD_VIRT, ioc.u.md.virt_addr, len);
358 error = bd_md_add_seg(md, BUSDMA_MD_PHYS, ioc.u.md.phys_addr, len);
359 error = bd_md_add_seg(md, BUSDMA_MD_BUS, ioc.u.md.bus_addr, len);
364 bd_md_unload(int mdid)
366 struct proto_ioc_busdma ioc;
370 md = obj_lookup(mdid, OBJ_TYPE_MD);
374 memset(&ioc, 0, sizeof(ioc));
375 ioc.request = PROTO_IOC_BUSDMA_MD_UNLOAD;
377 if (ioctl(md->fd, PROTO_IOC_BUSDMA, &ioc) == -1)
380 bd_md_del_segs(md, BUSDMA_MD_VIRT, 0);
381 bd_md_del_segs(md, BUSDMA_MD_PHYS, 0);
382 bd_md_del_segs(md, BUSDMA_MD_BUS, 0);
387 bd_mem_alloc(int tid, u_int flags)
389 struct proto_ioc_busdma ioc;
390 struct obj *md, *tag;
394 tag = obj_lookup(tid, OBJ_TYPE_TAG);
398 md = obj_alloc(OBJ_TYPE_MD);
402 memset(&ioc, 0, sizeof(ioc));
403 ioc.request = PROTO_IOC_BUSDMA_MEM_ALLOC;
404 ioc.u.md.tag = tag->key;
405 ioc.u.md.flags = flags;
406 if (ioctl(tag->fd, PROTO_IOC_BUSDMA, &ioc) == -1) {
415 md->key = ioc.result;
417 /* XXX we need to support multiple segments */
418 assert(ioc.u.md.phys_nsegs == 1);
419 assert(ioc.u.md.bus_nsegs == 1);
420 error = bd_md_add_seg(md, BUSDMA_MD_PHYS, ioc.u.md.phys_addr,
422 error = bd_md_add_seg(md, BUSDMA_MD_BUS, ioc.u.md.bus_addr,
425 addr = (uintptr_t)mmap(NULL, tag->u.tag.maxsz, PROT_READ | PROT_WRITE,
426 MAP_NOCORE | MAP_SHARED, md->fd, ioc.u.md.phys_addr);
427 if (addr == (uintptr_t)MAP_FAILED)
429 error = bd_md_add_seg(md, BUSDMA_MD_VIRT, addr, tag->u.tag.maxsz);
434 memset(&ioc, 0, sizeof(ioc));
435 ioc.request = PROTO_IOC_BUSDMA_MEM_FREE;
437 ioctl(md->fd, PROTO_IOC_BUSDMA, &ioc);
438 md->parent->refcnt--;
444 bd_mem_free(int mdid)
446 struct proto_ioc_busdma ioc;
449 md = obj_lookup(mdid, OBJ_TYPE_MD);
453 memset(&ioc, 0, sizeof(ioc));
454 ioc.request = PROTO_IOC_BUSDMA_MEM_FREE;
456 if (ioctl(md->fd, PROTO_IOC_BUSDMA, &ioc) == -1)
459 bd_md_del_segs(md, BUSDMA_MD_VIRT, 1);
460 bd_md_del_segs(md, BUSDMA_MD_PHYS, 0);
461 bd_md_del_segs(md, BUSDMA_MD_BUS, 0);
462 md->parent->refcnt--;
468 bd_md_first_seg(int mdid, int space)
470 struct obj *md, *seg;
472 md = obj_lookup(mdid, OBJ_TYPE_MD);
476 if (space != BUSDMA_MD_BUS && space != BUSDMA_MD_PHYS &&
477 space != BUSDMA_MD_VIRT) {
481 seg = md->u.md.seg[space];
490 bd_md_next_seg(int mdid, int sid)
494 seg = obj_lookup(sid, OBJ_TYPE_SEG);
498 seg = seg->u.seg.next;
507 bd_seg_get_addr(int sid, u_long *addr_p)
514 seg = obj_lookup(sid, OBJ_TYPE_SEG);
518 *addr_p = seg->u.seg.address;
523 bd_seg_get_size(int sid, u_long *size_p)
530 seg = obj_lookup(sid, OBJ_TYPE_SEG);
534 *size_p = seg->u.seg.size;
539 bd_sync(int mdid, u_int op, u_long ofs, u_long len)
541 struct proto_ioc_busdma ioc;
544 md = obj_lookup(mdid, OBJ_TYPE_MD);
548 memset(&ioc, 0, sizeof(ioc));
549 ioc.request = PROTO_IOC_BUSDMA_SYNC;
552 ioc.u.sync.base = ofs;
553 ioc.u.sync.size = len;
554 if (ioctl(md->fd, PROTO_IOC_BUSDMA, &ioc) == -1)