sys/boot/ofw/libofw/ofw_copy.c

   1 /*-
   2  * Copyright (c) 1998 Michael Smith <msmith@freebsd.org>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  *
  26  * $FreeBSD: src/sys/boot/ofw/libofw/ofw_copy.c,v 1.11 2002/07/18 12:39:02 benno Exp $
  27  * $DragonFly: src/sys/boot/ofw/libofw/ofw_copy.c,v 1.1 2003/11/10 06:08:37 dillon Exp $
  28  */
  29 /*
  30  * MD primitives supporting placement of module data
  31  *
  32  * XXX should check load address/size against memory top.
  33  */
  34 #include <stand.h>
  35
  36 #include "libofw.h"
  37
  38 #define READIN_BUF      (4 * 1024)
  39 #define PAGE_SIZE       0x1000
  40 #define PAGE_MASK       0x0fff
  41
  42 #define roundup(x, y)   ((((x)+((y)-1))/(y))*(y))
  43
  44 ssize_t
  45 ofw_copyin(const void *src, vm_offset_t dest, const size_t len)
  46 {
  47         void    *destp, *addr;
  48         size_t  dlen;
  49
  50         destp = (void *)(dest & ~PAGE_MASK);
  51         dlen = roundup(len, PAGE_SIZE);
  52
  53         if (OF_call_method("claim", memory, 3, 1, destp, dlen, 0, &addr)
  54             == -1) {
  55                 printf("ofw_copyin: physical claim failed\n");
  56                 return (0);
  57         }
  58
  59         if (OF_call_method("claim", mmu, 3, 1, destp, dlen, 0, &addr) == -1) {
  60                 printf("ofw_copyin: virtual claim failed\n");
  61                 return (0);
  62         }
  63
  64         if (OF_call_method("map", mmu, 4, 0, destp, destp, dlen, 0) == -1) {
  65                 printf("ofw_copyin: map failed\n");
  66                 return (0);
  67         }
  68
  69         bcopy(src, (void *)dest, len);
  70         return(len);
  71 }
  72
  73 ssize_t
  74 ofw_copyout(const vm_offset_t src, void *dest, const size_t len)
  75 {
  76         bcopy((void *)src, dest, len);
  77         return(len);
  78 }
  79
  80 ssize_t
  81 ofw_readin(const int fd, vm_offset_t dest, const size_t len)
  82 {
  83         void            *buf;
  84         size_t          resid, chunk, get;
  85         ssize_t         got;
  86         vm_offset_t     p;
  87
  88         p = dest;
  89
  90         chunk = min(READIN_BUF, len);
  91         buf = malloc(chunk);
  92         if (buf == NULL) {
  93                 printf("ofw_readin: buf malloc failed\n");
  94                 return(0);
  95         }
  96
  97         for (resid = len; resid > 0; resid -= got, p += got) {
  98                 get = min(chunk, resid);
  99                 got = read(fd, buf, get);
 100
 101                 if (got <= 0) {
 102                         printf("ofw_readin: read failed\n");
 103                         break;
 104                 }
 105
 106                 ofw_copyin(buf, p, got);
 107         }
 108
 109         free(buf);
 110         return(len - resid);
 111 }