1223695Sdfr/*- 2223695Sdfr * Copyright (c) 1998 Michael Smith <msmith@freebsd.org> 3223695Sdfr * All rights reserved. 4223695Sdfr * 5223695Sdfr * Redistribution and use in source and binary forms, with or without 6223695Sdfr * modification, are permitted provided that the following conditions 7223695Sdfr * are met: 8223695Sdfr * 1. Redistributions of source code must retain the above copyright 9223695Sdfr * notice, this list of conditions and the following disclaimer. 10223695Sdfr * 2. Redistributions in binary form must reproduce the above copyright 11223695Sdfr * notice, this list of conditions and the following disclaimer in the 12223695Sdfr * documentation and/or other materials provided with the distribution. 13223695Sdfr * 14223695Sdfr * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15223695Sdfr * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16223695Sdfr * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17223695Sdfr * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18223695Sdfr * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19223695Sdfr * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20223695Sdfr * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21223695Sdfr * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22223695Sdfr * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23223695Sdfr * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24223695Sdfr * SUCH DAMAGE. 25223695Sdfr */ 26223695Sdfr 27223695Sdfr#include <sys/cdefs.h> 28223695Sdfr__FBSDID("$FreeBSD$"); 29223695Sdfr 30223695Sdfr#include <stand.h> 31223695Sdfr#include <sys/param.h> 32223695Sdfr#include <sys/reboot.h> 33223695Sdfr#include <sys/linker.h> 34223695Sdfr#include <i386/include/bootinfo.h> 35223695Sdfr#include <machine/cpufunc.h> 36223695Sdfr#include <machine/psl.h> 37223695Sdfr#include <machine/specialreg.h> 38223695Sdfr 39223695Sdfr#include "bootstrap.h" 40223695Sdfr#include "libuserboot.h" 41223695Sdfr 42223695Sdfr/* 43223695Sdfr * Copy module-related data into the load area, where it can be 44223695Sdfr * used as a directory for loaded modules. 45223695Sdfr * 46223695Sdfr * Module data is presented in a self-describing format. Each datum 47223695Sdfr * is preceded by a 32-bit identifier and a 32-bit size field. 48223695Sdfr * 49223695Sdfr * Currently, the following data are saved: 50223695Sdfr * 51223695Sdfr * MOD_NAME (variable) module name (string) 52223695Sdfr * MOD_TYPE (variable) module type (string) 53223695Sdfr * MOD_ARGS (variable) module parameters (string) 54223695Sdfr * MOD_ADDR sizeof(vm_offset_t) module load address 55223695Sdfr * MOD_SIZE sizeof(size_t) module size 56223695Sdfr * MOD_METADATA (variable) type-specific metadata 57223695Sdfr */ 58223695Sdfr#define COPY32(v, a, c) { \ 59223695Sdfr u_int32_t x = (v); \ 60223695Sdfr if (c) \ 61223695Sdfr CALLBACK(copyin, &x, a, sizeof(x)); \ 62223695Sdfr a += sizeof(x); \ 63223695Sdfr} 64223695Sdfr 65223695Sdfr#define MOD_STR(t, a, s, c) { \ 66223695Sdfr COPY32(t, a, c); \ 67223695Sdfr COPY32(strlen(s) + 1, a, c); \ 68223695Sdfr if (c) \ 69223695Sdfr CALLBACK(copyin, s, a, strlen(s) + 1); \ 70223695Sdfr a += roundup(strlen(s) + 1, sizeof(u_int64_t));\ 71223695Sdfr} 72223695Sdfr 73223695Sdfr#define MOD_NAME(a, s, c) MOD_STR(MODINFO_NAME, a, s, c) 74223695Sdfr#define MOD_TYPE(a, s, c) MOD_STR(MODINFO_TYPE, a, s, c) 75223695Sdfr#define MOD_ARGS(a, s, c) MOD_STR(MODINFO_ARGS, a, s, c) 76223695Sdfr 77223695Sdfr#define MOD_VAR(t, a, s, c) { \ 78223695Sdfr COPY32(t, a, c); \ 79223695Sdfr COPY32(sizeof(s), a, c); \ 80223695Sdfr if (c) \ 81223695Sdfr CALLBACK(copyin, &s, a, sizeof(s)); \ 82223695Sdfr a += roundup(sizeof(s), sizeof(u_int64_t)); \ 83223695Sdfr} 84223695Sdfr 85223695Sdfr#define MOD_ADDR(a, s, c) MOD_VAR(MODINFO_ADDR, a, s, c) 86223695Sdfr#define MOD_SIZE(a, s, c) MOD_VAR(MODINFO_SIZE, a, s, c) 87223695Sdfr 88223695Sdfr#define MOD_METADATA(a, mm, c) { \ 89223695Sdfr COPY32(MODINFO_METADATA | mm->md_type, a, c); \ 90223695Sdfr COPY32(mm->md_size, a, c); \ 91223695Sdfr if (c) \ 92223695Sdfr CALLBACK(copyin, mm->md_data, a, mm->md_size); \ 93223695Sdfr a += roundup(mm->md_size, sizeof(u_int64_t));\ 94223695Sdfr} 95223695Sdfr 96223695Sdfr#define MOD_END(a, c) { \ 97223695Sdfr COPY32(MODINFO_END, a, c); \ 98223695Sdfr COPY32(0, a, c); \ 99223695Sdfr} 100223695Sdfr 101223695Sdfrstatic vm_offset_t 102223695Sdfrbi_copymodules64(vm_offset_t addr) 103223695Sdfr{ 104223695Sdfr struct preloaded_file *fp; 105223695Sdfr struct file_metadata *md; 106223695Sdfr int c; 107223695Sdfr u_int64_t v; 108223695Sdfr 109223695Sdfr c = addr != 0; 110223695Sdfr /* start with the first module on the list, should be the kernel */ 111223695Sdfr for (fp = file_findfile(NULL, NULL); fp != NULL; fp = fp->f_next) { 112223695Sdfr 113223695Sdfr MOD_NAME(addr, fp->f_name, c); /* this field must come first */ 114223695Sdfr MOD_TYPE(addr, fp->f_type, c); 115223695Sdfr if (fp->f_args) 116223695Sdfr MOD_ARGS(addr, fp->f_args, c); 117223695Sdfr v = fp->f_addr; 118223695Sdfr MOD_ADDR(addr, v, c); 119223695Sdfr v = fp->f_size; 120223695Sdfr MOD_SIZE(addr, v, c); 121223695Sdfr for (md = fp->f_metadata; md != NULL; md = md->md_next) 122223695Sdfr if (!(md->md_type & MODINFOMD_NOCOPY)) 123223695Sdfr MOD_METADATA(addr, md, c); 124223695Sdfr } 125223695Sdfr MOD_END(addr, c); 126223695Sdfr return(addr); 127223695Sdfr} 128223695Sdfr 129223695Sdfr/* 130223695Sdfr * Check to see if this CPU supports long mode. 131223695Sdfr */ 132223695Sdfrstatic int 133223695Sdfrbi_checkcpu(void) 134223695Sdfr{ 135223695Sdfr#if 0 136223695Sdfr char *cpu_vendor; 137223695Sdfr int vendor[3]; 138223695Sdfr int eflags, regs[4]; 139223695Sdfr 140223695Sdfr /* Check for presence of "cpuid". */ 141223695Sdfr eflags = read_eflags(); 142223695Sdfr write_eflags(eflags ^ PSL_ID); 143223695Sdfr if (!((eflags ^ read_eflags()) & PSL_ID)) 144223695Sdfr return (0); 145223695Sdfr 146223695Sdfr /* Fetch the vendor string. */ 147223695Sdfr do_cpuid(0, regs); 148223695Sdfr vendor[0] = regs[1]; 149223695Sdfr vendor[1] = regs[3]; 150223695Sdfr vendor[2] = regs[2]; 151223695Sdfr cpu_vendor = (char *)vendor; 152223695Sdfr 153223695Sdfr /* Check for vendors that support AMD features. */ 154223695Sdfr if (strncmp(cpu_vendor, INTEL_VENDOR_ID, 12) != 0 && 155223695Sdfr strncmp(cpu_vendor, AMD_VENDOR_ID, 12) != 0 && 156223695Sdfr strncmp(cpu_vendor, CENTAUR_VENDOR_ID, 12) != 0) 157223695Sdfr return (0); 158223695Sdfr 159223695Sdfr /* Has to support AMD features. */ 160223695Sdfr do_cpuid(0x80000000, regs); 161223695Sdfr if (!(regs[0] >= 0x80000001)) 162223695Sdfr return (0); 163223695Sdfr 164223695Sdfr /* Check for long mode. */ 165223695Sdfr do_cpuid(0x80000001, regs); 166223695Sdfr return (regs[3] & AMDID_LM); 167223695Sdfr#else 168223695Sdfr return (1); 169223695Sdfr#endif 170223695Sdfr} 171223695Sdfr 172223695Sdfr/* 173223695Sdfr * Load the information expected by an amd64 kernel. 174223695Sdfr * 175223695Sdfr * - The 'boothowto' argument is constructed 176223695Sdfr * - The 'bootdev' argument is constructed 177223695Sdfr * - The 'bootinfo' struct is constructed, and copied into the kernel space. 178223695Sdfr * - The kernel environment is copied into kernel space. 179223695Sdfr * - Module metadata are formatted and placed in kernel space. 180223695Sdfr */ 181223695Sdfrint 182223695Sdfrbi_load64(char *args, vm_offset_t *modulep, vm_offset_t *kernendp) 183223695Sdfr{ 184223695Sdfr struct preloaded_file *xp, *kfp; 185223695Sdfr struct userboot_devdesc *rootdev; 186223695Sdfr struct file_metadata *md; 187223695Sdfr vm_offset_t addr; 188223695Sdfr u_int64_t kernend; 189223695Sdfr u_int64_t envp; 190223695Sdfr vm_offset_t size; 191223695Sdfr char *rootdevname; 192223695Sdfr int howto; 193223695Sdfr 194223695Sdfr if (!bi_checkcpu()) { 195223695Sdfr printf("CPU doesn't support long mode\n"); 196223695Sdfr return (EINVAL); 197223695Sdfr } 198223695Sdfr 199223695Sdfr howto = bi_getboothowto(args); 200223695Sdfr 201223695Sdfr /* 202223695Sdfr * Allow the environment variable 'rootdev' to override the supplied device 203223695Sdfr * This should perhaps go to MI code and/or have $rootdev tested/set by 204223695Sdfr * MI code before launching the kernel. 205223695Sdfr */ 206223695Sdfr rootdevname = getenv("rootdev"); 207223695Sdfr userboot_getdev((void **)(&rootdev), rootdevname, NULL); 208223695Sdfr if (rootdev == NULL) { /* bad $rootdev/$currdev */ 209223695Sdfr printf("can't determine root device\n"); 210223695Sdfr return(EINVAL); 211223695Sdfr } 212223695Sdfr 213223695Sdfr /* Try reading the /etc/fstab file to select the root device */ 214223695Sdfr getrootmount(userboot_fmtdev((void *)rootdev)); 215223695Sdfr 216223695Sdfr /* find the last module in the chain */ 217223695Sdfr addr = 0; 218223695Sdfr for (xp = file_findfile(NULL, NULL); xp != NULL; xp = xp->f_next) { 219223695Sdfr if (addr < (xp->f_addr + xp->f_size)) 220223695Sdfr addr = xp->f_addr + xp->f_size; 221223695Sdfr } 222223695Sdfr /* pad to a page boundary */ 223223695Sdfr addr = roundup(addr, PAGE_SIZE); 224223695Sdfr 225223695Sdfr /* copy our environment */ 226223695Sdfr envp = addr; 227223695Sdfr addr = bi_copyenv(addr); 228223695Sdfr 229223695Sdfr /* pad to a page boundary */ 230223695Sdfr addr = roundup(addr, PAGE_SIZE); 231223695Sdfr 232223695Sdfr kfp = file_findfile(NULL, "elf kernel"); 233223695Sdfr if (kfp == NULL) 234223695Sdfr kfp = file_findfile(NULL, "elf64 kernel"); 235223695Sdfr if (kfp == NULL) 236223695Sdfr panic("can't find kernel file"); 237223695Sdfr kernend = 0; /* fill it in later */ 238223695Sdfr file_addmetadata(kfp, MODINFOMD_HOWTO, sizeof howto, &howto); 239223695Sdfr file_addmetadata(kfp, MODINFOMD_ENVP, sizeof envp, &envp); 240223695Sdfr file_addmetadata(kfp, MODINFOMD_KERNEND, sizeof kernend, &kernend); 241223695Sdfr bios_addsmapdata(kfp); 242223695Sdfr 243223695Sdfr /* Figure out the size and location of the metadata */ 244223695Sdfr *modulep = addr; 245223695Sdfr size = bi_copymodules64(0); 246223695Sdfr kernend = roundup(addr + size, PAGE_SIZE); 247223695Sdfr *kernendp = kernend; 248223695Sdfr 249223695Sdfr /* patch MODINFOMD_KERNEND */ 250223695Sdfr md = file_findmetadata(kfp, MODINFOMD_KERNEND); 251223695Sdfr bcopy(&kernend, md->md_data, sizeof kernend); 252223695Sdfr 253223695Sdfr /* copy module list and metadata */ 254223695Sdfr (void)bi_copymodules64(addr); 255223695Sdfr 256223695Sdfr return(0); 257223695Sdfr} 258