sys/arch/sparc/stand/ofwboot/bootinfo.c

   1 /*      $NetBSD: bootinfo.c,v 1.2 2006/07/13 20:03:34 uwe Exp $ */
   2
   3 /*-
   4  * Copyright (c) 1999 The NetBSD Foundation, Inc.
   5  * All rights reserved.
   6  *
   7  * This code is derived from software contributed to The NetBSD Foundation
   8  * by Jonathan Stone, Michael Hitch and Simon Burge.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  * 1. Redistributions of source code must retain the above copyright
  14  *    notice, this list of conditions and the following disclaimer.
  15  * 2. Redistributions in binary form must reproduce the above copyright
  16  *    notice, this list of conditions and the following disclaimer in the
  17  *    documentation and/or other materials provided with the distribution.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
  20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
  23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  29  * POSSIBILITY OF SUCH DAMAGE.
  30  */
  31
  32 #include <sys/param.h>
  33 #include <machine/types.h>
  34 #include <machine/bootinfo.h>
  35 #include <lib/libsa/stand.h>
  36 #include <lib/libkern/libkern.h>
  37
  38 #include "boot.h"
  39
  40 static char *bootinfo = NULL;
  41 static char *bi_next;
  42 static int bi_size;
  43
  44 u_long
  45 bi_init(u_long addr)
  46 {
  47         struct btinfo_common *bi;
  48         struct btinfo_magic bi_magic;
  49         uint64_t *endp;
  50
  51         endp = (uint64_t *)ALIGN(addr);
  52
  53         /*
  54          * Allocate and zero-fill bootinfo structure.
  55          */
  56         sparc64_memset(endp, 0, BOOTINFO_SIZE);
  57
  58         /*
  59          * For the first word we load our end address,
  60          * giving enough space for the bootinfo structure.
  61          */
  62         endp[0] = (uint64_t)(u_long)((char *)endp + BOOTINFO_SIZE);
  63         bootinfo = (char *)ALIGN(&endp[2]);
  64         endp[1] = (uint64_t)(u_long)bootinfo;
  65         bi = (struct btinfo_common *)bootinfo;
  66         bi->next = bi->type = 0;
  67         bi_next = bootinfo;
  68         bi_size = 0;
  69
  70         bi_magic.magic = BOOTINFO_MAGIC;
  71         bi_add(&bi_magic, BTINFO_MAGIC, sizeof(bi_magic));
  72         return (u_long) endp;
  73 }
  74
  75 void
  76 bi_add(void *new, int type, size_t size)
  77 {
  78         struct btinfo_common *bi;
  79
  80         if (bi_size + size > BOOTINFO_SIZE)
  81                 return;                         /* XXX error? */
  82
  83         bi = new;
  84         bi->next = ALIGN(size);
  85         bi->type = type;
  86         sparc64_memcpy(bi_next, new, size);
  87         bi_next += ALIGN(size);
  88
  89         bi = (struct btinfo_common *)bi_next;
  90         bi->next = bi->type = 0;
  91 }