ofw_copy.c revision 124140 
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
27#include <sys/cdefs.h>
28__FBSDID("$FreeBSD: head/sys/boot/ofw/libofw/ofw_copy.c 124140 2004-01-04 23:30:47Z obrien $");
29
30/*
31 * MD primitives supporting placement of module data
32 *
33 * XXX should check load address/size against memory top.
34 */
35#include <stand.h>
36
37#include "libofw.h"
38
39#define	READIN_BUF	(4 * 1024)
40#define	PAGE_SIZE	0x1000
41#define	PAGE_MASK	0x0fff
42
43#define	roundup(x, y)	((((x)+((y)-1))/(y))*(y))
44
45ssize_t
46ofw_copyin(const void *src, vm_offset_t dest, const size_t len)
47{
48	void	*destp, *addr;
49	size_t	dlen;
50
51	destp = (void *)(dest & ~PAGE_MASK);
52	dlen = roundup(len, PAGE_SIZE);
53
54	if (OF_call_method("claim", memory, 3, 1, destp, dlen, 0, &addr)
55	    == -1) {
56		printf("ofw_copyin: physical claim failed\n");
57		return (0);
58	}
59
60	if (OF_call_method("claim", mmu, 3, 1, destp, dlen, 0, &addr) == -1) {
61		printf("ofw_copyin: virtual claim failed\n");
62		return (0);
63	}
64
65	if (OF_call_method("map", mmu, 4, 0, destp, destp, dlen, 0) == -1) {
66		printf("ofw_copyin: map failed\n");
67		return (0);
68	}
69
70	bcopy(src, (void *)dest, len);
71	return(len);
72}
73
74ssize_t
75ofw_copyout(const vm_offset_t src, void *dest, const size_t len)
76{
77	bcopy((void *)src, dest, len);
78	return(len);
79}
80
81ssize_t
82ofw_readin(const int fd, vm_offset_t dest, const size_t len)
83{
84	void		*buf;
85	size_t		resid, chunk, get;
86	ssize_t		got;
87	vm_offset_t	p;
88
89	p = dest;
90
91	chunk = min(READIN_BUF, len);
92	buf = malloc(chunk);
93	if (buf == NULL) {
94		printf("ofw_readin: buf malloc failed\n");
95		return(0);
96	}
97
98	for (resid = len; resid > 0; resid -= got, p += got) {
99		get = min(chunk, resid);
100		got = read(fd, buf, get);
101
102		if (got <= 0) {
103			if (got < 0)
104				printf("ofw_readin: read failed\n");
105			break;
106		}
107
108		ofw_copyin(buf, p, got);
109	}
110
111	free(buf);
112	return(len - resid);
113}
114