AMD64 - Refactor uio_resid and size_t assumptions.
[dragonfly.git] / sys / boot / ofw / libofw / ofw_copy.c
CommitLineData
5ee58eed
MD
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
44ssize_t
45ofw_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
73ssize_t
74ofw_copyout(const vm_offset_t src, void *dest, const size_t len)
75{
76 bcopy((void *)src, dest, len);
77 return(len);
78}
79
80ssize_t
81ofw_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) {
e54488bb 98 get = szmin(chunk, resid);
5ee58eed
MD
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}