1/* $NetBSD: pmax.c,v 1.13 2008/04/28 20:24:16 martin Exp $ */ 2 3/*- 4 * Copyright (c) 1999, 2002 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Simon Burge. 9 * 10 * This code is derived from software contributed to The NetBSD Foundation 11 * by Luke Mewburn of Wasabi Systems. 12 * 13 * Redistribution and use in source and binary forms, with or without 14 * modification, are permitted provided that the following conditions 15 * are met: 16 * 1. Redistributions of source code must retain the above copyright 17 * notice, this list of conditions and the following disclaimer. 18 * 2. Redistributions in binary form must reproduce the above copyright 19 * notice, this list of conditions and the following disclaimer in the 20 * documentation and/or other materials provided with the distribution. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 23 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 24 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 25 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 26 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 32 * POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35/* 36 * Copyright (c) 1999 Ross Harvey. All rights reserved. 37 * 38 * Redistribution and use in source and binary forms, with or without 39 * modification, are permitted provided that the following conditions 40 * are met: 41 * 1. Redistributions of source code must retain the above copyright 42 * notice, this list of conditions and the following disclaimer. 43 * 2. Redistributions in binary form must reproduce the above copyright 44 * notice, this list of conditions and the following disclaimer in the 45 * documentation and/or other materials provided with the distribution. 46 * 3. All advertising materials mentioning features or use of this software 47 * must display the following acknowledgement: 48 * This product includes software developed by Ross Harvey 49 * for the NetBSD Project. 50 * 4. The name of the author may not be used to endorse or promote products 51 * derived from this software without specific prior written permission 52 * 53 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 54 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 55 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 56 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 57 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 58 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 59 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 60 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 61 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 62 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 63 */ 64 65/* 66 * Copyright (c) 1999 Christopher G. Demetriou. All rights reserved. 67 * 68 * Redistribution and use in source and binary forms, with or without 69 * modification, are permitted provided that the following conditions 70 * are met: 71 * 1. Redistributions of source code must retain the above copyright 72 * notice, this list of conditions and the following disclaimer. 73 * 2. Redistributions in binary form must reproduce the above copyright 74 * notice, this list of conditions and the following disclaimer in the 75 * documentation and/or other materials provided with the distribution. 76 * 3. All advertising materials mentioning features or use of this software 77 * must display the following acknowledgement: 78 * This product includes software developed by Christopher G. Demetriou 79 * for the NetBSD Project. 80 * 4. The name of the author may not be used to endorse or promote products 81 * derived from this software without specific prior written permission 82 * 83 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 84 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 85 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 86 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 87 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 88 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 89 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 90 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 91 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 92 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 93 */ 94 95#if HAVE_NBTOOL_CONFIG_H 96#include "nbtool_config.h" 97#endif 98 99#include <sys/cdefs.h> 100#if !defined(__lint) 101__RCSID("$NetBSD: pmax.c,v 1.13 2008/04/28 20:24:16 martin Exp $"); 102#endif /* !__lint */ 103 104#include <sys/param.h> 105 106#include <assert.h> 107#include <err.h> 108#include <stddef.h> 109#include <stdio.h> 110#include <stdlib.h> 111#include <string.h> 112#include <unistd.h> 113 114#include <sys/exec_elf.h> 115 116#include "installboot.h" 117 118static int load_bootstrap(ib_params *, char **, 119 uint32_t *, uint32_t *, size_t *); 120 121static int pmax_clearboot(ib_params *); 122static int pmax_setboot(ib_params *); 123 124struct ib_mach ib_mach_pmax = 125 { "pmax", pmax_setboot, pmax_clearboot, no_editboot, 126 IB_STAGE1START | IB_APPEND | IB_SUNSUM }; 127 128 129static int 130pmax_clearboot(ib_params *params) 131{ 132 struct pmax_boot_block bb; 133 ssize_t rv; 134 135 assert(params != NULL); 136 assert(params->fsfd != -1); 137 assert(params->filesystem != NULL); 138 assert(sizeof(struct pmax_boot_block) == PMAX_BOOT_BLOCK_BLOCKSIZE); 139 140 rv = pread(params->fsfd, &bb, sizeof(bb), PMAX_BOOT_BLOCK_OFFSET); 141 if (rv == -1) { 142 warn("Reading `%s'", params->filesystem); 143 return (0); 144 } else if (rv != sizeof(bb)) { 145 warnx("Reading `%s': short read", params->filesystem); 146 return (0); 147 } 148 149 if (le32toh(bb.magic) != PMAX_BOOT_MAGIC) { 150 warnx( 151 "Old boot block magic number invalid; boot block invalid"); 152 return (0); 153 } 154 155 bb.map[0].num_blocks = bb.map[0].start_block = bb.mode = 0; 156 bb.magic = htole32(PMAX_BOOT_MAGIC); 157 158 if (params->flags & IB_SUNSUM) { 159 uint16_t sum; 160 161 sum = compute_sunsum((uint16_t *)&bb); 162 if (! set_sunsum(params, (uint16_t *)&bb, sum)) 163 return (0); 164 } 165 166 if (params->flags & IB_VERBOSE) 167 printf("%slearing boot block\n", 168 (params->flags & IB_NOWRITE) ? "Not c" : "C"); 169 if (params->flags & IB_NOWRITE) 170 return (1); 171 172 rv = pwrite(params->fsfd, &bb, sizeof(bb), PMAX_BOOT_BLOCK_OFFSET); 173 if (rv == -1) { 174 warn("Writing `%s'", params->filesystem); 175 return (0); 176 } else if (rv != sizeof(bb)) { 177 warnx("Writing `%s': short write", params->filesystem); 178 return (0); 179 } 180 181 return (1); 182} 183 184static int 185pmax_setboot(ib_params *params) 186{ 187 struct pmax_boot_block bb; 188 uint32_t startblock; 189 int retval; 190 char *bootstrapbuf; 191 size_t bootstrapsize; 192 uint32_t bootstrapload, bootstrapexec; 193 ssize_t rv; 194 195 assert(params != NULL); 196 assert(params->fsfd != -1); 197 assert(params->filesystem != NULL); 198 assert(params->s1fd != -1); 199 assert(params->stage1 != NULL); 200 assert(sizeof(struct pmax_boot_block) == PMAX_BOOT_BLOCK_BLOCKSIZE); 201 202 retval = 0; 203 bootstrapbuf = NULL; 204 205 if (! load_bootstrap(params, &bootstrapbuf, &bootstrapload, 206 &bootstrapexec, &bootstrapsize)) 207 goto done; 208 209 rv = pread(params->fsfd, &bb, sizeof(bb), PMAX_BOOT_BLOCK_OFFSET); 210 if (rv == -1) { 211 warn("Reading `%s'", params->filesystem); 212 goto done; 213 } else if (rv != sizeof(bb)) { 214 warnx("Reading `%s': short read", params->filesystem); 215 goto done; 216 } 217 218 /* fill in the updated boot block fields */ 219 if (params->flags & IB_APPEND) { 220 if (! S_ISREG(params->fsstat.st_mode)) { 221 warnx( 222 "`%s' must be a regular file to append a bootstrap", 223 params->filesystem); 224 goto done; 225 } 226 startblock = howmany(params->fsstat.st_size, 227 PMAX_BOOT_BLOCK_BLOCKSIZE); 228 } else if (params->flags & IB_STAGE1START) { 229 startblock = params->s1start; 230 } else { 231 startblock = PMAX_BOOT_BLOCK_OFFSET / PMAX_BOOT_BLOCK_BLOCKSIZE 232 + 1; 233 } 234 235 bb.map[0].start_block = htole32(startblock); 236 bb.map[0].num_blocks = 237 htole32(howmany(bootstrapsize, PMAX_BOOT_BLOCK_BLOCKSIZE)); 238 bb.magic = htole32(PMAX_BOOT_MAGIC); 239 bb.load_addr = htole32(bootstrapload); 240 bb.exec_addr = htole32(bootstrapexec); 241 bb.mode = htole32(PMAX_BOOTMODE_CONTIGUOUS); 242 243 if (params->flags & IB_SUNSUM) { 244 uint16_t sum; 245 246 sum = compute_sunsum((uint16_t *)&bb); 247 if (! set_sunsum(params, (uint16_t *)&bb, sum)) 248 goto done; 249 } 250 251 if (params->flags & IB_VERBOSE) { 252 printf("Bootstrap start sector: %u\n", 253 le32toh(bb.map[0].start_block)); 254 printf("Bootstrap sector count: %u\n", 255 le32toh(bb.map[0].num_blocks)); 256 printf("Bootstrap load address: %#x\n", 257 le32toh(bb.load_addr)); 258 printf("Bootstrap exec address: %#x\n", 259 le32toh(bb.exec_addr)); 260 printf("%sriting bootstrap\n", 261 (params->flags & IB_NOWRITE) ? "Not w" : "W"); 262 } 263 if (params->flags & IB_NOWRITE) { 264 retval = 1; 265 goto done; 266 } 267 rv = pwrite(params->fsfd, bootstrapbuf, bootstrapsize, 268 startblock * PMAX_BOOT_BLOCK_BLOCKSIZE); 269 if (rv == -1) { 270 warn("Writing `%s'", params->filesystem); 271 goto done; 272 } else if ((size_t)rv != bootstrapsize) { 273 warnx("Writing `%s': short write", params->filesystem); 274 goto done; 275 } 276 277 if (params->flags & IB_VERBOSE) 278 printf("Writing boot block\n"); 279 rv = pwrite(params->fsfd, &bb, sizeof(bb), PMAX_BOOT_BLOCK_OFFSET); 280 if (rv == -1) { 281 warn("Writing `%s'", params->filesystem); 282 goto done; 283 } else if (rv != sizeof(bb)) { 284 warnx("Writing `%s': short write", params->filesystem); 285 goto done; 286 } else { 287 retval = 1; 288 } 289 290 done: 291 if (bootstrapbuf) 292 free(bootstrapbuf); 293 return (retval); 294} 295 296 297#define MAX_SEGMENTS 10 /* We can load up to 10 segments */ 298 299struct seglist { 300 Elf32_Addr addr; 301 Elf32_Off f_offset; 302 Elf32_Word f_size; 303}; 304 305static int 306load_bootstrap(ib_params *params, char **data, 307 uint32_t *loadaddr, uint32_t *execaddr, size_t *len) 308{ 309 int i, nsegs; 310 Elf32_Addr lowaddr, highaddr; 311 Elf32_Ehdr ehdr; 312 Elf32_Phdr phdr; 313 struct seglist seglist[MAX_SEGMENTS]; 314 315 if ((pread(params->s1fd, &ehdr, sizeof(ehdr), 0)) != sizeof(ehdr)) { 316 warn("Reading `%s'", params->stage1); 317 return (0); 318 } 319 if ((memcmp(ehdr.e_ident, ELFMAG, SELFMAG) != 0) || 320 (ehdr.e_ident[EI_CLASS] != ELFCLASS32)) { 321 warnx("No ELF header in `%s'", params->stage1); 322 return (0); 323 } 324 325 nsegs = highaddr = 0; 326 lowaddr = (uint32_t) ULONG_MAX; 327 328 for (i = 0; i < le16toh(ehdr.e_phnum); i++) { 329 if (pread(params->s1fd, &phdr, sizeof(phdr), 330 (off_t) le32toh(ehdr.e_phoff) + i * sizeof(phdr)) 331 != sizeof(phdr)) { 332 warn("Reading `%s'", params->stage1); 333 return (0); 334 } 335 if (le32toh(phdr.p_type) != PT_LOAD) 336 continue; 337 338 seglist[nsegs].addr = le32toh(phdr.p_paddr); 339 seglist[nsegs].f_offset = le32toh(phdr.p_offset); 340 seglist[nsegs].f_size = le32toh(phdr.p_filesz); 341 nsegs++; 342 343 if (le32toh(phdr.p_paddr) < lowaddr) 344 lowaddr = le32toh(phdr.p_paddr); 345 if (le32toh(phdr.p_paddr) + le32toh(phdr.p_filesz) > highaddr) 346 highaddr = le32toh(phdr.p_paddr) + 347 le32toh(phdr.p_filesz); 348 } 349 350 *loadaddr = lowaddr; 351 *execaddr = le32toh(ehdr.e_entry); 352 *len = roundup(highaddr - lowaddr, PMAX_BOOT_BLOCK_BLOCKSIZE); 353 if ((*data = malloc(*len)) == NULL) { 354 warn("Allocating %lu bytes", (unsigned long) *len); 355 return (0); 356 } 357 358 /* Now load the bootstrap into memory */ 359 for (i = 0; i < nsegs; i++) { 360 if ((Elf32_Word)pread(params->s1fd, 361 *data + seglist[i].addr - lowaddr, 362 seglist[i].f_size, (off_t)seglist[i].f_offset) 363 != seglist[i].f_size) { 364 warn("Reading `%s'", params->stage1); 365 return (0); 366 } 367 } 368 return (1); 369} 370