1 /* $OpenBSD: bootarg.c,v 1.12 2015/09/02 01:52:26 yasuoka Exp $ */
2
3 /*
4 * Copyright (c) 1997,1998 Michael Shalayeff
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 *
28 */
29
30 #include <lib/libsa/stand.h>
31 #include <stand/boot/bootarg.h>
32
33 static bootarg_t *bootarg_list;
34
35 void
addbootarg(int t,size_t l,void * p)36 addbootarg(int t, size_t l, void *p)
37 {
38 bootarg_t *q = alloc(sizeof(*q) + l - sizeof(q->ba_arg));
39
40 q->ba_type = t;
41 q->ba_size = sizeof(*q) + l - sizeof(q->ba_arg);
42 bcopy(p, q->ba_arg, l);
43 q->ba_next = bootarg_list;
44 bootarg_list = q;
45 }
46
47 void
makebootargs(caddr_t v,size_t * lenp)48 makebootargs(caddr_t v, size_t *lenp)
49 {
50 bootarg_t *p;
51 u_char *q;
52 size_t l;
53
54 /* get total size */
55 l = sizeof(*p);
56 for (p = bootarg_list; p != NULL; p = p->ba_next) {
57 l += p->ba_size;
58 if (*lenp < l) {
59 #ifdef DEBUG
60 printf("makebootargs: too many args\n");
61 #endif
62 l -= p->ba_size;
63 break;
64 }
65 }
66 *lenp = l;
67 /* copy them out */
68 for (p = bootarg_list, q = v;
69 p != NULL && ((q + p->ba_size) - (u_char *)v) <= l - sizeof(*p);
70 q += p->ba_size, p = p->ba_next) {
71 #ifdef DEBUG
72 printf("%d,%d ", p->ba_type, p->ba_size);
73 #endif
74 bcopy(p, q, p->ba_size);
75 }
76 p = (bootarg_t *)q;
77 p->ba_type = BOOTARG_END;
78 }
79
80 void
makebootargs32(caddr_t v,size_t * lenp)81 makebootargs32(caddr_t v, size_t *lenp)
82 {
83 bootarg_t *p;
84 u_char *q;
85 size_t l;
86 size_t adj;
87 struct bootarg32 {
88 int ba_type;
89 int ba_size;
90 int ba_nextX;
91 char ba_arg[1];
92 } *p32;
93
94 adj = (ssize_t)sizeof(struct bootarg32) - sizeof(bootarg_t);
95 /* get total size */
96 l = sizeof(*p32);
97 for (p = bootarg_list; p != NULL; p = p->ba_next) {
98 l += p->ba_size + adj;
99 if (*lenp < l) {
100 #ifdef DEBUG
101 printf("makebootargs: too many args\n");
102 #endif
103 l -= p->ba_size + adj;
104 break;
105 }
106 }
107 *lenp = l;
108 /* copy them out */
109 for (p = bootarg_list, q = v; p != NULL; p = p->ba_next) {
110 if (q + p->ba_size + adj > (u_char *)v + l - sizeof(*p32))
111 break;
112 p32 = (struct bootarg32 *)q;
113 p32->ba_type = p->ba_type;
114 p32->ba_size = p->ba_size + adj;
115 bcopy(p->ba_arg, p32->ba_arg,
116 p->ba_size - (sizeof(*p) - sizeof(p->ba_arg)));
117 #ifdef DEBUG
118 printf("%d,%d ", p->ba_type, p->ba_size);
119 #endif
120 q += p32->ba_size;
121 }
122 p32 = (struct bootarg32 *)q;
123 p32->ba_type = BOOTARG_END;
124 }
125