93f8713401323da9e1186c00bf8a18a9485ae45b
[dragonfly.git] / 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 }