xref: /onnv-gate/usr/src/uts/i86pc/os/fastboot.c (revision 9219:131a03b0a6ed)
17656SSherry.Moore@Sun.COM /*
27656SSherry.Moore@Sun.COM  * CDDL HEADER START
37656SSherry.Moore@Sun.COM  *
47656SSherry.Moore@Sun.COM  * The contents of this file are subject to the terms of the
57656SSherry.Moore@Sun.COM  * Common Development and Distribution License (the "License").
67656SSherry.Moore@Sun.COM  * You may not use this file except in compliance with the License.
77656SSherry.Moore@Sun.COM  *
87656SSherry.Moore@Sun.COM  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
97656SSherry.Moore@Sun.COM  * or http://www.opensolaris.org/os/licensing.
107656SSherry.Moore@Sun.COM  * See the License for the specific language governing permissions
117656SSherry.Moore@Sun.COM  * and limitations under the License.
127656SSherry.Moore@Sun.COM  *
137656SSherry.Moore@Sun.COM  * When distributing Covered Code, include this CDDL HEADER in each
147656SSherry.Moore@Sun.COM  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
157656SSherry.Moore@Sun.COM  * If applicable, add the following below this CDDL HEADER, with the
167656SSherry.Moore@Sun.COM  * fields enclosed by brackets "[]" replaced with your own identifying
177656SSherry.Moore@Sun.COM  * information: Portions Copyright [yyyy] [name of copyright owner]
187656SSherry.Moore@Sun.COM  *
197656SSherry.Moore@Sun.COM  * CDDL HEADER END
207656SSherry.Moore@Sun.COM  */
217656SSherry.Moore@Sun.COM 
227656SSherry.Moore@Sun.COM /*
239160SSherry.Moore@Sun.COM  * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
247656SSherry.Moore@Sun.COM  * Use is subject to license terms.
257656SSherry.Moore@Sun.COM  */
267656SSherry.Moore@Sun.COM 
277750SSherry.Moore@Sun.COM /*
287750SSherry.Moore@Sun.COM  * This file contains the functions for performing Fast Reboot -- a
297750SSherry.Moore@Sun.COM  * reboot which bypasses the firmware and bootloader, considerably
307750SSherry.Moore@Sun.COM  * reducing downtime.
317750SSherry.Moore@Sun.COM  *
329160SSherry.Moore@Sun.COM  * fastboot_load_kernel(): This function is invoked by mdpreboot() in the
339160SSherry.Moore@Sun.COM  * reboot path.  It loads the new kernel and boot archive into memory, builds
347750SSherry.Moore@Sun.COM  * the data structure containing sufficient information about the new
357750SSherry.Moore@Sun.COM  * kernel and boot archive to be passed to the fast reboot switcher
367750SSherry.Moore@Sun.COM  * (see fb_swtch_src.s for details).  When invoked the switcher relocates
377750SSherry.Moore@Sun.COM  * the new kernel and boot archive to physically contiguous low memory,
387750SSherry.Moore@Sun.COM  * similar to where the boot loader would have loaded them, and jumps to
397750SSherry.Moore@Sun.COM  * the new kernel.
407750SSherry.Moore@Sun.COM  *
419160SSherry.Moore@Sun.COM  * If fastreboot_onpanic is enabled, fastboot_load_kernel() is called
429160SSherry.Moore@Sun.COM  * by fastreboot_post_startup() to load the back up kernel in case of
439160SSherry.Moore@Sun.COM  * panic.
449160SSherry.Moore@Sun.COM  *
457750SSherry.Moore@Sun.COM  * The physical addresses of the memory allocated for the new kernel, boot
467750SSherry.Moore@Sun.COM  * archive and their page tables must be above where the boot archive ends
477750SSherry.Moore@Sun.COM  * after it has been relocated by the switcher, otherwise the new files
487750SSherry.Moore@Sun.COM  * and their page tables could be overridden during relocation.
497750SSherry.Moore@Sun.COM  *
507750SSherry.Moore@Sun.COM  * fast_reboot(): This function is invoked by mdboot() once it's determined
517750SSherry.Moore@Sun.COM  * that the system is capable of fast reboot.  It jumps to the fast reboot
529160SSherry.Moore@Sun.COM  * switcher with the data structure built by fastboot_load_kernel() as the
539160SSherry.Moore@Sun.COM  * argument.
547750SSherry.Moore@Sun.COM  */
557656SSherry.Moore@Sun.COM 
567656SSherry.Moore@Sun.COM #include <sys/types.h>
577656SSherry.Moore@Sun.COM #include <sys/param.h>
587656SSherry.Moore@Sun.COM #include <sys/segments.h>
597656SSherry.Moore@Sun.COM #include <sys/sysmacros.h>
607656SSherry.Moore@Sun.COM #include <sys/vm.h>
617656SSherry.Moore@Sun.COM 
627656SSherry.Moore@Sun.COM #include <sys/proc.h>
637656SSherry.Moore@Sun.COM #include <sys/buf.h>
647656SSherry.Moore@Sun.COM #include <sys/kmem.h>
657656SSherry.Moore@Sun.COM 
667656SSherry.Moore@Sun.COM #include <sys/reboot.h>
677656SSherry.Moore@Sun.COM #include <sys/uadmin.h>
687656SSherry.Moore@Sun.COM 
697656SSherry.Moore@Sun.COM #include <sys/cred.h>
707656SSherry.Moore@Sun.COM #include <sys/vnode.h>
717656SSherry.Moore@Sun.COM #include <sys/file.h>
727656SSherry.Moore@Sun.COM 
737656SSherry.Moore@Sun.COM #include <sys/cmn_err.h>
747656SSherry.Moore@Sun.COM #include <sys/dumphdr.h>
757656SSherry.Moore@Sun.COM #include <sys/bootconf.h>
767656SSherry.Moore@Sun.COM #include <sys/ddidmareq.h>
777656SSherry.Moore@Sun.COM #include <sys/varargs.h>
787656SSherry.Moore@Sun.COM #include <sys/promif.h>
797656SSherry.Moore@Sun.COM #include <sys/modctl.h>
807656SSherry.Moore@Sun.COM 
817656SSherry.Moore@Sun.COM #include <vm/hat.h>
827656SSherry.Moore@Sun.COM #include <vm/as.h>
837656SSherry.Moore@Sun.COM #include <vm/page.h>
847656SSherry.Moore@Sun.COM #include <vm/seg.h>
857656SSherry.Moore@Sun.COM #include <vm/hat_i86.h>
867656SSherry.Moore@Sun.COM #include <sys/vm_machparam.h>
877656SSherry.Moore@Sun.COM #include <sys/archsystm.h>
887656SSherry.Moore@Sun.COM #include <sys/machsystm.h>
897656SSherry.Moore@Sun.COM #include <sys/mman.h>
907656SSherry.Moore@Sun.COM #include <sys/x86_archext.h>
919160SSherry.Moore@Sun.COM #include <sys/smp_impldefs.h>
929160SSherry.Moore@Sun.COM #include <sys/spl.h>
937656SSherry.Moore@Sun.COM 
947656SSherry.Moore@Sun.COM #include <sys/fastboot.h>
957656SSherry.Moore@Sun.COM #include <sys/machelf.h>
967656SSherry.Moore@Sun.COM #include <sys/kobj.h>
977656SSherry.Moore@Sun.COM #include <sys/multiboot.h>
989160SSherry.Moore@Sun.COM #include <sys/kobj_lex.h>
999160SSherry.Moore@Sun.COM 
1009160SSherry.Moore@Sun.COM /*
1019160SSherry.Moore@Sun.COM  * Macro to determine how many pages are needed for PTEs to map a particular
1029160SSherry.Moore@Sun.COM  * file.  Allocate one extra page table entry for terminating the list.
1039160SSherry.Moore@Sun.COM  */
1049160SSherry.Moore@Sun.COM #define	FASTBOOT_PTE_LIST_SIZE(fsize)	\
1059160SSherry.Moore@Sun.COM 	P2ROUNDUP((((fsize) >> PAGESHIFT) + 1) * sizeof (x86pte_t), PAGESIZE)
1067656SSherry.Moore@Sun.COM 
1077750SSherry.Moore@Sun.COM /*
1087750SSherry.Moore@Sun.COM  * Data structure containing necessary information for the fast reboot
1097750SSherry.Moore@Sun.COM  * switcher to jump to the new kernel.
1107750SSherry.Moore@Sun.COM  */
1117656SSherry.Moore@Sun.COM fastboot_info_t newkernel = { 0 };
1129160SSherry.Moore@Sun.COM char		fastboot_args[OBP_MAXPATHLEN];
1137750SSherry.Moore@Sun.COM 
1147656SSherry.Moore@Sun.COM static char fastboot_filename[2][OBP_MAXPATHLEN] = { { 0 }, { 0 }};
1157656SSherry.Moore@Sun.COM static x86pte_t ptp_bits = PT_VALID | PT_REF | PT_USER | PT_WRITABLE;
1167656SSherry.Moore@Sun.COM static x86pte_t pte_bits =
1177656SSherry.Moore@Sun.COM     PT_VALID | PT_REF | PT_MOD | PT_NOCONSIST | PT_WRITABLE;
1187656SSherry.Moore@Sun.COM static uint_t fastboot_shift_amt_pae[] = {12, 21, 30, 39};
1197656SSherry.Moore@Sun.COM 
1207656SSherry.Moore@Sun.COM int fastboot_debug = 0;
1217656SSherry.Moore@Sun.COM int fastboot_contig = 0;
1227656SSherry.Moore@Sun.COM 
1237656SSherry.Moore@Sun.COM /*
1247656SSherry.Moore@Sun.COM  * Fake starting va for new kernel and boot archive.
1257656SSherry.Moore@Sun.COM  */
1267656SSherry.Moore@Sun.COM static uintptr_t fake_va = FASTBOOT_FAKE_VA;
1277656SSherry.Moore@Sun.COM 
1287656SSherry.Moore@Sun.COM /*
1299160SSherry.Moore@Sun.COM  * Reserve memory below PA 1G in preparation of fast reboot.
1309160SSherry.Moore@Sun.COM  *
1319160SSherry.Moore@Sun.COM  * This variable is only checked when fastreboot_capable is set, but
1329160SSherry.Moore@Sun.COM  * fastreboot_onpanic is not set.  The amount of memory reserved
1339160SSherry.Moore@Sun.COM  * is negligible, but just in case we are really short of low memory,
1349160SSherry.Moore@Sun.COM  * this variable will give us a backdoor to not consume memory at all.
1359160SSherry.Moore@Sun.COM  */
1369160SSherry.Moore@Sun.COM int reserve_mem_enabled = 1;
1379160SSherry.Moore@Sun.COM 
1389160SSherry.Moore@Sun.COM /*
1399160SSherry.Moore@Sun.COM  * Amount of memory below PA 1G to reserve for constructing the multiboot
1409160SSherry.Moore@Sun.COM  * data structure and the page tables as we tend to run out of those
1419160SSherry.Moore@Sun.COM  * when more drivers are loaded.
1429160SSherry.Moore@Sun.COM  */
1439160SSherry.Moore@Sun.COM static size_t fastboot_mbi_size = 0x2000;	/* 8K */
1449160SSherry.Moore@Sun.COM static size_t fastboot_pagetable_size = 0x5000;	/* 20K */
1459160SSherry.Moore@Sun.COM 
1469160SSherry.Moore@Sun.COM /*
1479160SSherry.Moore@Sun.COM  * Use below 1G for page tables as
1489160SSherry.Moore@Sun.COM  *	1. we are only doing 1:1 mapping of the bottom 1G of physical memory.
1499160SSherry.Moore@Sun.COM  *	2. we are using 2G as the fake virtual address for the new kernel and
1509160SSherry.Moore@Sun.COM  *	boot archive.
1517656SSherry.Moore@Sun.COM  */
1527656SSherry.Moore@Sun.COM static ddi_dma_attr_t fastboot_below_1G_dma_attr = {
1537656SSherry.Moore@Sun.COM 	DMA_ATTR_V0,
1547656SSherry.Moore@Sun.COM 	0x0000000008000000ULL,	/* dma_attr_addr_lo: 128MB */
1557656SSherry.Moore@Sun.COM 	0x000000003FFFFFFFULL,	/* dma_attr_addr_hi: 1G */
1567656SSherry.Moore@Sun.COM 	0x00000000FFFFFFFFULL,	/* dma_attr_count_max */
1577656SSherry.Moore@Sun.COM 	0x0000000000001000ULL,	/* dma_attr_align: 4KB */
1587656SSherry.Moore@Sun.COM 	1,			/* dma_attr_burstsize */
1597656SSherry.Moore@Sun.COM 	1,			/* dma_attr_minxfer */
1607656SSherry.Moore@Sun.COM 	0x00000000FFFFFFFFULL,	/* dma_attr_maxxfer */
1617656SSherry.Moore@Sun.COM 	0x00000000FFFFFFFFULL,	/* dma_attr_seg */
1627656SSherry.Moore@Sun.COM 	1,			/* dma_attr_sgllen */
1637656SSherry.Moore@Sun.COM 	0x1000ULL,		/* dma_attr_granular */
1647656SSherry.Moore@Sun.COM 	0,			/* dma_attr_flags */
1657656SSherry.Moore@Sun.COM };
1667656SSherry.Moore@Sun.COM 
1677656SSherry.Moore@Sun.COM static ddi_dma_attr_t fastboot_dma_attr = {
1687656SSherry.Moore@Sun.COM 	DMA_ATTR_V0,
1697656SSherry.Moore@Sun.COM 	0x0000000008000000ULL,	/* dma_attr_addr_lo: 128MB */
1708151SKonstantin.Ananyev@Sun.COM #ifdef	__amd64
1718151SKonstantin.Ananyev@Sun.COM 	0xFFFFFFFFFFFFFFFFULL,	/* dma_attr_addr_hi: 2^64B */
1728151SKonstantin.Ananyev@Sun.COM #else
1737656SSherry.Moore@Sun.COM 	0x0000000FFFFFFFFFULL,	/* dma_attr_addr_hi: 64GB */
1748151SKonstantin.Ananyev@Sun.COM #endif	/* __amd64 */
1757656SSherry.Moore@Sun.COM 	0x00000000FFFFFFFFULL,	/* dma_attr_count_max */
1767656SSherry.Moore@Sun.COM 	0x0000000000001000ULL,	/* dma_attr_align: 4KB */
1777656SSherry.Moore@Sun.COM 	1,			/* dma_attr_burstsize */
1787656SSherry.Moore@Sun.COM 	1,			/* dma_attr_minxfer */
1797656SSherry.Moore@Sun.COM 	0x00000000FFFFFFFFULL,	/* dma_attr_maxxfer */
1807656SSherry.Moore@Sun.COM 	0x00000000FFFFFFFFULL,	/* dma_attr_seg */
1817656SSherry.Moore@Sun.COM 	1,			/* dma_attr_sgllen */
1827656SSherry.Moore@Sun.COM 	0x1000ULL,		/* dma_attr_granular */
1837656SSherry.Moore@Sun.COM 	0,			/* dma_attr_flags */
1847656SSherry.Moore@Sun.COM };
1857656SSherry.Moore@Sun.COM 
1867656SSherry.Moore@Sun.COM /*
1877656SSherry.Moore@Sun.COM  * Various information saved from the previous boot to reconstruct
1887656SSherry.Moore@Sun.COM  * multiboot_info.
1897656SSherry.Moore@Sun.COM  */
1907656SSherry.Moore@Sun.COM extern multiboot_info_t saved_mbi;
1917656SSherry.Moore@Sun.COM extern mb_memory_map_t saved_mmap[FASTBOOT_SAVED_MMAP_COUNT];
1927656SSherry.Moore@Sun.COM extern struct sol_netinfo saved_drives[FASTBOOT_SAVED_DRIVES_COUNT];
1937656SSherry.Moore@Sun.COM extern char saved_cmdline[FASTBOOT_SAVED_CMDLINE_LEN];
1947656SSherry.Moore@Sun.COM extern int saved_cmdline_len;
1959160SSherry.Moore@Sun.COM extern size_t saved_file_size[];
1967656SSherry.Moore@Sun.COM 
1977656SSherry.Moore@Sun.COM extern void* contig_alloc(size_t size, ddi_dma_attr_t *attr,
1987656SSherry.Moore@Sun.COM     uintptr_t align, int cansleep);
1997750SSherry.Moore@Sun.COM extern void contig_free(void *addr, size_t size);
2007750SSherry.Moore@Sun.COM 
2017656SSherry.Moore@Sun.COM 
2027656SSherry.Moore@Sun.COM /* PRINTLIKE */
2037656SSherry.Moore@Sun.COM extern void vprintf(const char *, va_list);
2047656SSherry.Moore@Sun.COM 
2057656SSherry.Moore@Sun.COM 
2067656SSherry.Moore@Sun.COM /*
2077656SSherry.Moore@Sun.COM  * Need to be able to get boot_archives from other places
2087656SSherry.Moore@Sun.COM  */
2097656SSherry.Moore@Sun.COM #define	BOOTARCHIVE64	"/platform/i86pc/amd64/boot_archive"
2107656SSherry.Moore@Sun.COM #define	BOOTARCHIVE32	"/platform/i86pc/boot_archive"
2119160SSherry.Moore@Sun.COM #define	BOOTARCHIVE32_FAILSAFE	"/boot/x86.miniroot-safe"
2129160SSherry.Moore@Sun.COM #define	BOOTARCHIVE64_FAILSAFE	"/boot/amd64/x86.miniroot-safe"
2139160SSherry.Moore@Sun.COM #define	FAILSAFE_BOOTFILE32	"/boot/platform/i86pc/kernel/unix"
2149160SSherry.Moore@Sun.COM #define	FAILSAFE_BOOTFILE64	"/boot/platform/i86pc/kernel/amd64/unix"
2157656SSherry.Moore@Sun.COM 
2167656SSherry.Moore@Sun.COM static uint_t fastboot_vatoindex(fastboot_info_t *, uintptr_t, int);
2177656SSherry.Moore@Sun.COM static void fastboot_map_with_size(fastboot_info_t *, uintptr_t,
2187656SSherry.Moore@Sun.COM     paddr_t, size_t, int);
2197656SSherry.Moore@Sun.COM static void fastboot_build_pagetables(fastboot_info_t *);
2207656SSherry.Moore@Sun.COM static int fastboot_build_mbi(char *, fastboot_info_t *);
2219160SSherry.Moore@Sun.COM static void fastboot_free_file(fastboot_file_t *);
2227656SSherry.Moore@Sun.COM 
2237656SSherry.Moore@Sun.COM static const char fastboot_enomem_msg[] = "Fastboot: Couldn't allocate 0x%"
2247656SSherry.Moore@Sun.COM 	PRIx64" bytes below %s to do fast reboot";
2257656SSherry.Moore@Sun.COM 
2267656SSherry.Moore@Sun.COM static void
2277656SSherry.Moore@Sun.COM dprintf(char *fmt, ...)
2287656SSherry.Moore@Sun.COM {
2297656SSherry.Moore@Sun.COM 	va_list adx;
2307656SSherry.Moore@Sun.COM 
2317656SSherry.Moore@Sun.COM 	if (!fastboot_debug)
2327656SSherry.Moore@Sun.COM 		return;
2337656SSherry.Moore@Sun.COM 
2347656SSherry.Moore@Sun.COM 	va_start(adx, fmt);
2357656SSherry.Moore@Sun.COM 	vprintf(fmt, adx);
2367656SSherry.Moore@Sun.COM 	va_end(adx);
2377656SSherry.Moore@Sun.COM }
2387656SSherry.Moore@Sun.COM 
2397656SSherry.Moore@Sun.COM 
2407656SSherry.Moore@Sun.COM /*
2417656SSherry.Moore@Sun.COM  * Return the index corresponding to a virt address at a given page table level.
2427656SSherry.Moore@Sun.COM  */
2437656SSherry.Moore@Sun.COM static uint_t
2447656SSherry.Moore@Sun.COM fastboot_vatoindex(fastboot_info_t *nk, uintptr_t va, int level)
2457656SSherry.Moore@Sun.COM {
2467656SSherry.Moore@Sun.COM 	return ((va >> nk->fi_shift_amt[level]) & (nk->fi_ptes_per_table - 1));
2477656SSherry.Moore@Sun.COM }
2487656SSherry.Moore@Sun.COM 
2497656SSherry.Moore@Sun.COM 
2507656SSherry.Moore@Sun.COM /*
2517656SSherry.Moore@Sun.COM  * Add mapping from vstart to pstart for the specified size.
2528151SKonstantin.Ananyev@Sun.COM  * vstart, pstart and size should all have been aligned at 2M boundaries.
2537656SSherry.Moore@Sun.COM  */
2547656SSherry.Moore@Sun.COM static void
2557656SSherry.Moore@Sun.COM fastboot_map_with_size(fastboot_info_t *nk, uintptr_t vstart, paddr_t pstart,
2567656SSherry.Moore@Sun.COM     size_t size, int level)
2577656SSherry.Moore@Sun.COM {
2587656SSherry.Moore@Sun.COM 	x86pte_t	pteval, *table;
2597656SSherry.Moore@Sun.COM 	uintptr_t	vaddr;
2607656SSherry.Moore@Sun.COM 	paddr_t		paddr;
2617656SSherry.Moore@Sun.COM 	int		index, l;
2627656SSherry.Moore@Sun.COM 
2637656SSherry.Moore@Sun.COM 	table = (x86pte_t *)(nk->fi_pagetable_va);
2647656SSherry.Moore@Sun.COM 
2657656SSherry.Moore@Sun.COM 	for (l = nk->fi_top_level; l >= level; l--) {
2667656SSherry.Moore@Sun.COM 
2677656SSherry.Moore@Sun.COM 		index = fastboot_vatoindex(nk, vstart, l);
2687656SSherry.Moore@Sun.COM 
2697656SSherry.Moore@Sun.COM 		if (l == level) {
2707656SSherry.Moore@Sun.COM 			/*
2717656SSherry.Moore@Sun.COM 			 * Last level.  Program the page table entries.
2727656SSherry.Moore@Sun.COM 			 */
2737656SSherry.Moore@Sun.COM 			for (vaddr = vstart, paddr = pstart;
2747656SSherry.Moore@Sun.COM 			    vaddr < vstart + size;
2757656SSherry.Moore@Sun.COM 			    vaddr += (1ULL << nk->fi_shift_amt[l]),
2767656SSherry.Moore@Sun.COM 			    paddr += (1ULL << nk->fi_shift_amt[l])) {
2777656SSherry.Moore@Sun.COM 
2787656SSherry.Moore@Sun.COM 				uint_t index = fastboot_vatoindex(nk, vaddr, l);
2797656SSherry.Moore@Sun.COM 
2807656SSherry.Moore@Sun.COM 				if (l > 0)
2817656SSherry.Moore@Sun.COM 					pteval = paddr | pte_bits | PT_PAGESIZE;
2827656SSherry.Moore@Sun.COM 				else
2837656SSherry.Moore@Sun.COM 					pteval = paddr | pte_bits;
2847656SSherry.Moore@Sun.COM 
2857656SSherry.Moore@Sun.COM 				table[index] = pteval;
2867656SSherry.Moore@Sun.COM 			}
2877656SSherry.Moore@Sun.COM 		} else if (table[index] & PT_VALID) {
2887656SSherry.Moore@Sun.COM 
2897656SSherry.Moore@Sun.COM 			table = (x86pte_t *)
2907656SSherry.Moore@Sun.COM 			    ((uintptr_t)(((paddr_t)table[index] & MMU_PAGEMASK)
2917656SSherry.Moore@Sun.COM 			    - nk->fi_pagetable_pa) + nk->fi_pagetable_va);
2927656SSherry.Moore@Sun.COM 		} else {
2937656SSherry.Moore@Sun.COM 			/*
2948151SKonstantin.Ananyev@Sun.COM 			 * Intermediate levels.
2958151SKonstantin.Ananyev@Sun.COM 			 * Program with either valid bit or PTP bits.
2967656SSherry.Moore@Sun.COM 			 */
2977656SSherry.Moore@Sun.COM 			if (l == nk->fi_top_level) {
2988151SKonstantin.Ananyev@Sun.COM #ifdef	__amd64
2998151SKonstantin.Ananyev@Sun.COM 				ASSERT(nk->fi_top_level == 3);
3008151SKonstantin.Ananyev@Sun.COM 				table[index] = nk->fi_next_table_pa | ptp_bits;
3018151SKonstantin.Ananyev@Sun.COM #else
3027656SSherry.Moore@Sun.COM 				table[index] = nk->fi_next_table_pa | PT_VALID;
3038151SKonstantin.Ananyev@Sun.COM #endif	/* __amd64 */
3047656SSherry.Moore@Sun.COM 			} else {
3057656SSherry.Moore@Sun.COM 				table[index] = nk->fi_next_table_pa | ptp_bits;
3067656SSherry.Moore@Sun.COM 			}
3077656SSherry.Moore@Sun.COM 			table = (x86pte_t *)(nk->fi_next_table_va);
3087656SSherry.Moore@Sun.COM 			nk->fi_next_table_va += MMU_PAGESIZE;
3097656SSherry.Moore@Sun.COM 			nk->fi_next_table_pa += MMU_PAGESIZE;
3107656SSherry.Moore@Sun.COM 		}
3117656SSherry.Moore@Sun.COM 	}
3127656SSherry.Moore@Sun.COM }
3137656SSherry.Moore@Sun.COM 
3147656SSherry.Moore@Sun.COM /*
3157656SSherry.Moore@Sun.COM  * Build page tables for the lower 1G of physical memory using 2M
3167656SSherry.Moore@Sun.COM  * pages, and prepare page tables for mapping new kernel and boot
3177656SSherry.Moore@Sun.COM  * archive pages using 4K pages.
3187656SSherry.Moore@Sun.COM  */
3197656SSherry.Moore@Sun.COM static void
3207656SSherry.Moore@Sun.COM fastboot_build_pagetables(fastboot_info_t *nk)
3217656SSherry.Moore@Sun.COM {
3227656SSherry.Moore@Sun.COM 	/*
3237656SSherry.Moore@Sun.COM 	 * Map lower 1G physical memory.  Use large pages.
3247656SSherry.Moore@Sun.COM 	 */
3257656SSherry.Moore@Sun.COM 	fastboot_map_with_size(nk, 0, 0, ONE_GIG, 1);
3267656SSherry.Moore@Sun.COM 
3277656SSherry.Moore@Sun.COM 	/*
3287656SSherry.Moore@Sun.COM 	 * Map one 4K page to get the middle page tables set up.
3297656SSherry.Moore@Sun.COM 	 */
3307656SSherry.Moore@Sun.COM 	fake_va = P2ALIGN_TYPED(fake_va, nk->fi_lpagesize, uintptr_t);
3317656SSherry.Moore@Sun.COM 	fastboot_map_with_size(nk, fake_va,
3327656SSherry.Moore@Sun.COM 	    nk->fi_files[0].fb_pte_list_va[0] & MMU_PAGEMASK, PAGESIZE, 0);
3337656SSherry.Moore@Sun.COM }
3347656SSherry.Moore@Sun.COM 
3357656SSherry.Moore@Sun.COM 
3367656SSherry.Moore@Sun.COM /*
3377656SSherry.Moore@Sun.COM  * Sanity check.  Look for dboot offset.
3387656SSherry.Moore@Sun.COM  */
3397656SSherry.Moore@Sun.COM static int
3407656SSherry.Moore@Sun.COM fastboot_elf64_find_dboot_load_offset(void *img, off_t imgsz, uint32_t *offp)
3417656SSherry.Moore@Sun.COM {
3427656SSherry.Moore@Sun.COM 	Elf64_Ehdr	*ehdr = (Elf64_Ehdr *)img;
3437656SSherry.Moore@Sun.COM 	Elf64_Phdr	*phdr;
3447656SSherry.Moore@Sun.COM 	uint8_t		*phdrbase;
3457656SSherry.Moore@Sun.COM 	int		i;
3467656SSherry.Moore@Sun.COM 
3477656SSherry.Moore@Sun.COM 	if ((ehdr->e_phoff + ehdr->e_phnum * ehdr->e_phentsize) >= imgsz)
3487656SSherry.Moore@Sun.COM 		return (-1);
3497656SSherry.Moore@Sun.COM 
3507656SSherry.Moore@Sun.COM 	phdrbase = (uint8_t *)img + ehdr->e_phoff;
3517656SSherry.Moore@Sun.COM 
3527656SSherry.Moore@Sun.COM 	for (i = 0; i < ehdr->e_phnum; i++) {
3537656SSherry.Moore@Sun.COM 		phdr = (Elf64_Phdr *)(phdrbase + ehdr->e_phentsize * i);
3547656SSherry.Moore@Sun.COM 
3557656SSherry.Moore@Sun.COM 		if (phdr->p_type == PT_LOAD) {
3567656SSherry.Moore@Sun.COM 			if (phdr->p_vaddr == phdr->p_paddr &&
3577656SSherry.Moore@Sun.COM 			    phdr->p_vaddr == DBOOT_ENTRY_ADDRESS) {
3587656SSherry.Moore@Sun.COM 				ASSERT(phdr->p_offset <= UINT32_MAX);
3597656SSherry.Moore@Sun.COM 				*offp = (uint32_t)phdr->p_offset;
3607656SSherry.Moore@Sun.COM 				return (0);
3617656SSherry.Moore@Sun.COM 			}
3627656SSherry.Moore@Sun.COM 		}
3637656SSherry.Moore@Sun.COM 	}
3647656SSherry.Moore@Sun.COM 
3657656SSherry.Moore@Sun.COM 	return (-1);
3667656SSherry.Moore@Sun.COM }
3677656SSherry.Moore@Sun.COM 
3687656SSherry.Moore@Sun.COM 
3697656SSherry.Moore@Sun.COM /*
3707656SSherry.Moore@Sun.COM  * Initialize text and data section information for 32-bit kernel.
3718151SKonstantin.Ananyev@Sun.COM  * sectcntp - is both input/output parameter.
3728151SKonstantin.Ananyev@Sun.COM  * On entry, *sectcntp contains maximum allowable number of sections;
3738151SKonstantin.Ananyev@Sun.COM  * on return, it contains the actual number of sections filled.
3747656SSherry.Moore@Sun.COM  */
3757656SSherry.Moore@Sun.COM static int
3767656SSherry.Moore@Sun.COM fastboot_elf32_find_loadables(void *img, off_t imgsz, fastboot_section_t *sectp,
3777656SSherry.Moore@Sun.COM     int *sectcntp, uint32_t *offp)
3787656SSherry.Moore@Sun.COM {
3797656SSherry.Moore@Sun.COM 	Elf32_Ehdr	*ehdr = (Elf32_Ehdr *)img;
3807656SSherry.Moore@Sun.COM 	Elf32_Phdr	*phdr;
3817656SSherry.Moore@Sun.COM 	uint8_t		*phdrbase;
3827656SSherry.Moore@Sun.COM 	int		i;
3837656SSherry.Moore@Sun.COM 	int		used_sections = 0;
3848151SKonstantin.Ananyev@Sun.COM 	const int	max_sectcnt = *sectcntp;
3857656SSherry.Moore@Sun.COM 
3867656SSherry.Moore@Sun.COM 	if ((ehdr->e_phoff + ehdr->e_phnum * ehdr->e_phentsize) >= imgsz)
3877656SSherry.Moore@Sun.COM 		return (-1);
3887656SSherry.Moore@Sun.COM 
3897656SSherry.Moore@Sun.COM 	phdrbase = (uint8_t *)img + ehdr->e_phoff;
3907656SSherry.Moore@Sun.COM 
3917656SSherry.Moore@Sun.COM 	for (i = 0; i < ehdr->e_phnum; i++) {
3927656SSherry.Moore@Sun.COM 		phdr = (Elf32_Phdr *)(phdrbase + ehdr->e_phentsize * i);
3937656SSherry.Moore@Sun.COM 
3947656SSherry.Moore@Sun.COM 		if (phdr->p_type == PT_INTERP)
3957656SSherry.Moore@Sun.COM 			return (-1);
3967656SSherry.Moore@Sun.COM 
3977656SSherry.Moore@Sun.COM 		if (phdr->p_type != PT_LOAD)
3987656SSherry.Moore@Sun.COM 			continue;
3997656SSherry.Moore@Sun.COM 
4007656SSherry.Moore@Sun.COM 		if (phdr->p_vaddr == phdr->p_paddr &&
4017656SSherry.Moore@Sun.COM 		    phdr->p_paddr == DBOOT_ENTRY_ADDRESS) {
4027656SSherry.Moore@Sun.COM 			*offp = (uint32_t)phdr->p_offset;
4037656SSherry.Moore@Sun.COM 		} else {
4048151SKonstantin.Ananyev@Sun.COM 			if (max_sectcnt <= used_sections)
4058151SKonstantin.Ananyev@Sun.COM 				return (-1);
4068151SKonstantin.Ananyev@Sun.COM 
4077656SSherry.Moore@Sun.COM 			sectp[used_sections].fb_sec_offset = phdr->p_offset;
4087656SSherry.Moore@Sun.COM 			sectp[used_sections].fb_sec_paddr = phdr->p_paddr;
4097656SSherry.Moore@Sun.COM 			sectp[used_sections].fb_sec_size = phdr->p_filesz;
4107656SSherry.Moore@Sun.COM 			sectp[used_sections].fb_sec_bss_size =
4117656SSherry.Moore@Sun.COM 			    (phdr->p_filesz < phdr->p_memsz) ?
4127656SSherry.Moore@Sun.COM 			    (phdr->p_memsz - phdr->p_filesz) : 0;
4137656SSherry.Moore@Sun.COM 
4148151SKonstantin.Ananyev@Sun.COM 			/* Extra sanity check for the input object file */
4158151SKonstantin.Ananyev@Sun.COM 			if (sectp[used_sections].fb_sec_paddr +
4168151SKonstantin.Ananyev@Sun.COM 			    sectp[used_sections].fb_sec_size +
4178151SKonstantin.Ananyev@Sun.COM 			    sectp[used_sections].fb_sec_bss_size >=
4188151SKonstantin.Ananyev@Sun.COM 			    DBOOT_ENTRY_ADDRESS)
4198151SKonstantin.Ananyev@Sun.COM 				return (-1);
4208151SKonstantin.Ananyev@Sun.COM 
4217656SSherry.Moore@Sun.COM 			used_sections++;
4227656SSherry.Moore@Sun.COM 		}
4237656SSherry.Moore@Sun.COM 	}
4247656SSherry.Moore@Sun.COM 
4257656SSherry.Moore@Sun.COM 	*sectcntp = used_sections;
4267656SSherry.Moore@Sun.COM 	return (0);
4277656SSherry.Moore@Sun.COM }
4287656SSherry.Moore@Sun.COM 
4297656SSherry.Moore@Sun.COM /*
430*9219SKonstantin.Ananyev@Sun.COM  * Create multiboot info structure (mbi) base on the saved mbi.
431*9219SKonstantin.Ananyev@Sun.COM  * Recalculate values of the pointer type fields in the data
432*9219SKonstantin.Ananyev@Sun.COM  * structure based on the new starting physical address of the
433*9219SKonstantin.Ananyev@Sun.COM  * data structure.
4347656SSherry.Moore@Sun.COM  */
4357656SSherry.Moore@Sun.COM static int
4367656SSherry.Moore@Sun.COM fastboot_build_mbi(char *mdep, fastboot_info_t *nk)
4377656SSherry.Moore@Sun.COM {
4387656SSherry.Moore@Sun.COM 	mb_module_t	*mbp;
439*9219SKonstantin.Ananyev@Sun.COM 	multiboot_info_t	*mbi;	/* pointer to multiboot structure */
440*9219SKonstantin.Ananyev@Sun.COM 	uintptr_t	start_addr_va;	/* starting VA of mbi */
441*9219SKonstantin.Ananyev@Sun.COM 	uintptr_t	start_addr_pa;	/* starting PA of mbi */
442*9219SKonstantin.Ananyev@Sun.COM 	size_t		offs = 0;	/* offset from the starting address */
443*9219SKonstantin.Ananyev@Sun.COM 	size_t		arglen;		/* length of the command line arg */
444*9219SKonstantin.Ananyev@Sun.COM 	size_t		size;	/* size of the memory reserved for mbi */
445*9219SKonstantin.Ananyev@Sun.COM 	size_t		mdnsz;	/* length of the boot archive name */
4467656SSherry.Moore@Sun.COM 
447*9219SKonstantin.Ananyev@Sun.COM 	/*
448*9219SKonstantin.Ananyev@Sun.COM 	 * If mdep is not NULL or empty, use the length of mdep + 1
449*9219SKonstantin.Ananyev@Sun.COM 	 * (for NULL terminating) as the length of the new command
450*9219SKonstantin.Ananyev@Sun.COM 	 * line; else use the saved command line length as the
451*9219SKonstantin.Ananyev@Sun.COM 	 * length for the new command line.
452*9219SKonstantin.Ananyev@Sun.COM 	 */
4537750SSherry.Moore@Sun.COM 	if (mdep != NULL && strlen(mdep) != 0) {
4547656SSherry.Moore@Sun.COM 		arglen = strlen(mdep) + 1;
4557656SSherry.Moore@Sun.COM 	} else {
4567656SSherry.Moore@Sun.COM 		arglen = saved_cmdline_len;
4577656SSherry.Moore@Sun.COM 	}
4587656SSherry.Moore@Sun.COM 
459*9219SKonstantin.Ananyev@Sun.COM 	/*
460*9219SKonstantin.Ananyev@Sun.COM 	 * Allocate memory for the new multiboot info structure (mbi).
461*9219SKonstantin.Ananyev@Sun.COM 	 * If we have reserved memory for mbi but it's not enough,
462*9219SKonstantin.Ananyev@Sun.COM 	 * free it and reallocate.
463*9219SKonstantin.Ananyev@Sun.COM 	 */
4647656SSherry.Moore@Sun.COM 	size = PAGESIZE + P2ROUNDUP(arglen, PAGESIZE);
4659160SSherry.Moore@Sun.COM 	if (nk->fi_mbi_size && nk->fi_mbi_size < size) {
4669160SSherry.Moore@Sun.COM 		contig_free((void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
4679160SSherry.Moore@Sun.COM 		nk->fi_mbi_size = 0;
4689160SSherry.Moore@Sun.COM 	}
4699160SSherry.Moore@Sun.COM 
4709160SSherry.Moore@Sun.COM 	if (nk->fi_mbi_size == 0) {
4719160SSherry.Moore@Sun.COM 		if ((nk->fi_new_mbi_va =
4729160SSherry.Moore@Sun.COM 		    (uintptr_t)contig_alloc(size, &fastboot_below_1G_dma_attr,
4739160SSherry.Moore@Sun.COM 		    PAGESIZE, 0)) == NULL) {
4749160SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, fastboot_enomem_msg,
4759160SSherry.Moore@Sun.COM 			    (uint64_t)size, "1G");
4769160SSherry.Moore@Sun.COM 			return (-1);
4779160SSherry.Moore@Sun.COM 		}
4789160SSherry.Moore@Sun.COM 		/*
4799160SSherry.Moore@Sun.COM 		 * fi_mbi_size must be set after the allocation succeeds
4809160SSherry.Moore@Sun.COM 		 * as it's used to determine how much memory to free.
4819160SSherry.Moore@Sun.COM 		 */
4829160SSherry.Moore@Sun.COM 		nk->fi_mbi_size = size;
4837656SSherry.Moore@Sun.COM 	}
4847656SSherry.Moore@Sun.COM 
485*9219SKonstantin.Ananyev@Sun.COM 	/*
486*9219SKonstantin.Ananyev@Sun.COM 	 * Initalize memory
487*9219SKonstantin.Ananyev@Sun.COM 	 */
4889160SSherry.Moore@Sun.COM 	bzero((void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
4899160SSherry.Moore@Sun.COM 
490*9219SKonstantin.Ananyev@Sun.COM 	/*
491*9219SKonstantin.Ananyev@Sun.COM 	 * Get PA for the new mbi
492*9219SKonstantin.Ananyev@Sun.COM 	 */
493*9219SKonstantin.Ananyev@Sun.COM 	start_addr_va = nk->fi_new_mbi_va;
494*9219SKonstantin.Ananyev@Sun.COM 	start_addr_pa = mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
495*9219SKonstantin.Ananyev@Sun.COM 	    (caddr_t)start_addr_va));
496*9219SKonstantin.Ananyev@Sun.COM 	nk->fi_new_mbi_pa = (paddr_t)start_addr_pa;
4977656SSherry.Moore@Sun.COM 
4989160SSherry.Moore@Sun.COM 	/*
499*9219SKonstantin.Ananyev@Sun.COM 	 * Populate the rest of the fields in the data structure
5009160SSherry.Moore@Sun.COM 	 */
501*9219SKonstantin.Ananyev@Sun.COM 
502*9219SKonstantin.Ananyev@Sun.COM 	/*
503*9219SKonstantin.Ananyev@Sun.COM 	 * Copy from the saved mbi to preserve all non-pointer type fields.
504*9219SKonstantin.Ananyev@Sun.COM 	 */
505*9219SKonstantin.Ananyev@Sun.COM 	mbi = (multiboot_info_t *)start_addr_va;
506*9219SKonstantin.Ananyev@Sun.COM 	bcopy(&saved_mbi, mbi, sizeof (*mbi));
5077656SSherry.Moore@Sun.COM 
508*9219SKonstantin.Ananyev@Sun.COM 	/*
509*9219SKonstantin.Ananyev@Sun.COM 	 * Recalculate mods_addr.  Set mod_start and mod_end based on
510*9219SKonstantin.Ananyev@Sun.COM 	 * the physical address of the new boot archive.  Set mod_name
511*9219SKonstantin.Ananyev@Sun.COM 	 * to the name of the new boto archive.
512*9219SKonstantin.Ananyev@Sun.COM 	 */
513*9219SKonstantin.Ananyev@Sun.COM 	offs += sizeof (multiboot_info_t);
514*9219SKonstantin.Ananyev@Sun.COM 	mbi->mods_addr = start_addr_pa + offs;
515*9219SKonstantin.Ananyev@Sun.COM 	mbp = (mb_module_t *)(start_addr_va + offs);
5169160SSherry.Moore@Sun.COM 	mbp->mod_start = nk->fi_files[FASTBOOT_BOOTARCHIVE].fb_dest_pa;
5179160SSherry.Moore@Sun.COM 	mbp->mod_end = nk->fi_files[FASTBOOT_BOOTARCHIVE].fb_next_pa;
5187656SSherry.Moore@Sun.COM 
519*9219SKonstantin.Ananyev@Sun.COM 	offs += sizeof (mb_module_t);
520*9219SKonstantin.Ananyev@Sun.COM 	mdnsz = strlen(fastboot_filename[FASTBOOT_NAME_BOOTARCHIVE]) + 1;
521*9219SKonstantin.Ananyev@Sun.COM 	bcopy(fastboot_filename[FASTBOOT_NAME_BOOTARCHIVE],
522*9219SKonstantin.Ananyev@Sun.COM 	    (void *)(start_addr_va + offs), mdnsz);
523*9219SKonstantin.Ananyev@Sun.COM 	mbp->mod_name = start_addr_pa + offs;
524*9219SKonstantin.Ananyev@Sun.COM 	mbp->reserved = 0;
5257656SSherry.Moore@Sun.COM 
526*9219SKonstantin.Ananyev@Sun.COM 	/*
527*9219SKonstantin.Ananyev@Sun.COM 	 * Make sure the offset is 16-byte aligned to avoid unaligned access.
528*9219SKonstantin.Ananyev@Sun.COM 	 */
529*9219SKonstantin.Ananyev@Sun.COM 	offs += mdnsz;
530*9219SKonstantin.Ananyev@Sun.COM 	offs = P2ROUNDUP_TYPED(offs, 16, size_t);
5317656SSherry.Moore@Sun.COM 
532*9219SKonstantin.Ananyev@Sun.COM 	/*
533*9219SKonstantin.Ananyev@Sun.COM 	 * Recalculate mmap_addr
534*9219SKonstantin.Ananyev@Sun.COM 	 */
535*9219SKonstantin.Ananyev@Sun.COM 	mbi->mmap_addr = start_addr_pa + offs;
536*9219SKonstantin.Ananyev@Sun.COM 	bcopy((void *)(uintptr_t)saved_mmap, (void *)(start_addr_va + offs),
5377656SSherry.Moore@Sun.COM 	    saved_mbi.mmap_length);
538*9219SKonstantin.Ananyev@Sun.COM 	offs += saved_mbi.mmap_length;
5397656SSherry.Moore@Sun.COM 
540*9219SKonstantin.Ananyev@Sun.COM 	/*
541*9219SKonstantin.Ananyev@Sun.COM 	 * Recalculate drives_addr
542*9219SKonstantin.Ananyev@Sun.COM 	 */
543*9219SKonstantin.Ananyev@Sun.COM 	mbi->drives_addr = start_addr_pa + offs;
544*9219SKonstantin.Ananyev@Sun.COM 	bcopy((void *)(uintptr_t)saved_drives, (void *)(start_addr_va + offs),
5457656SSherry.Moore@Sun.COM 	    saved_mbi.drives_length);
546*9219SKonstantin.Ananyev@Sun.COM 	offs += saved_mbi.drives_length;
5477656SSherry.Moore@Sun.COM 
548*9219SKonstantin.Ananyev@Sun.COM 	/*
549*9219SKonstantin.Ananyev@Sun.COM 	 * Recalculate the address of cmdline.  Set cmdline to contain the
550*9219SKonstantin.Ananyev@Sun.COM 	 * new boot argument.
551*9219SKonstantin.Ananyev@Sun.COM 	 */
552*9219SKonstantin.Ananyev@Sun.COM 	mbi->cmdline = start_addr_pa + offs;
5537656SSherry.Moore@Sun.COM 
5547750SSherry.Moore@Sun.COM 	if (mdep != NULL && strlen(mdep) != 0) {
555*9219SKonstantin.Ananyev@Sun.COM 		bcopy(mdep, (void *)(start_addr_va + offs), arglen);
5567656SSherry.Moore@Sun.COM 	} else {
557*9219SKonstantin.Ananyev@Sun.COM 		bcopy((void *)saved_cmdline, (void *)(start_addr_va + offs),
558*9219SKonstantin.Ananyev@Sun.COM 		    arglen);
5597656SSherry.Moore@Sun.COM 	}
5607656SSherry.Moore@Sun.COM 
5617656SSherry.Moore@Sun.COM 	return (0);
5627656SSherry.Moore@Sun.COM }
5637656SSherry.Moore@Sun.COM 
5647750SSherry.Moore@Sun.COM /*
5657750SSherry.Moore@Sun.COM  * Initialize HAT related fields
5667750SSherry.Moore@Sun.COM  */
5677750SSherry.Moore@Sun.COM static void
5687750SSherry.Moore@Sun.COM fastboot_init_fields(fastboot_info_t *nk)
5697656SSherry.Moore@Sun.COM {
5707750SSherry.Moore@Sun.COM 	if (x86_feature & X86_PAE) {
5717750SSherry.Moore@Sun.COM 		nk->fi_has_pae = 1;
5727750SSherry.Moore@Sun.COM 		nk->fi_shift_amt = fastboot_shift_amt_pae;
5737750SSherry.Moore@Sun.COM 		nk->fi_ptes_per_table = 512;
5747750SSherry.Moore@Sun.COM 		nk->fi_lpagesize = (2 << 20);	/* 2M */
5758151SKonstantin.Ananyev@Sun.COM #ifdef	__amd64
5768151SKonstantin.Ananyev@Sun.COM 		nk->fi_top_level = 3;
5778151SKonstantin.Ananyev@Sun.COM #else
5787750SSherry.Moore@Sun.COM 		nk->fi_top_level = 2;
5798151SKonstantin.Ananyev@Sun.COM #endif	/* __amd64 */
5807750SSherry.Moore@Sun.COM 	}
5817750SSherry.Moore@Sun.COM }
5827656SSherry.Moore@Sun.COM 
5837750SSherry.Moore@Sun.COM /*
5847750SSherry.Moore@Sun.COM  * Process boot argument
5857750SSherry.Moore@Sun.COM  */
5867750SSherry.Moore@Sun.COM static void
5877750SSherry.Moore@Sun.COM fastboot_parse_mdep(char *mdep, char *kern_bootpath, int *bootpath_len,
5887750SSherry.Moore@Sun.COM     char *bootargs)
5897750SSherry.Moore@Sun.COM {
5907750SSherry.Moore@Sun.COM 	int	i;
5917656SSherry.Moore@Sun.COM 
5927656SSherry.Moore@Sun.COM 	/*
5937656SSherry.Moore@Sun.COM 	 * If mdep is not NULL, it comes in the format of
5947656SSherry.Moore@Sun.COM 	 *	mountpoint unix args
5957656SSherry.Moore@Sun.COM 	 */
5967750SSherry.Moore@Sun.COM 	if (mdep != NULL && strlen(mdep) != 0) {
5977656SSherry.Moore@Sun.COM 		if (mdep[0] != '-') {
5987656SSherry.Moore@Sun.COM 			/* First get the root argument */
5997656SSherry.Moore@Sun.COM 			i = 0;
6007656SSherry.Moore@Sun.COM 			while (mdep[i] != '\0' && mdep[i] != ' ') {
6017656SSherry.Moore@Sun.COM 				i++;
6027656SSherry.Moore@Sun.COM 			}
6037656SSherry.Moore@Sun.COM 
6047656SSherry.Moore@Sun.COM 			if (i < 4 || strncmp(&mdep[i-4], "unix", 4) != 0) {
6057656SSherry.Moore@Sun.COM 				/* mount point */
6067656SSherry.Moore@Sun.COM 				bcopy(mdep, kern_bootpath, i);
6077656SSherry.Moore@Sun.COM 				kern_bootpath[i] = '\0';
6087750SSherry.Moore@Sun.COM 				*bootpath_len = i;
6097656SSherry.Moore@Sun.COM 
6107656SSherry.Moore@Sun.COM 				/*
6117656SSherry.Moore@Sun.COM 				 * Get the next argument. It should be unix as
6127656SSherry.Moore@Sun.COM 				 * we have validated in in halt.c.
6137656SSherry.Moore@Sun.COM 				 */
6147656SSherry.Moore@Sun.COM 				if (strlen(mdep) > i) {
6157656SSherry.Moore@Sun.COM 					mdep += (i + 1);
6167656SSherry.Moore@Sun.COM 					i = 0;
6177656SSherry.Moore@Sun.COM 					while (mdep[i] != '\0' &&
6187656SSherry.Moore@Sun.COM 					    mdep[i] != ' ') {
6197656SSherry.Moore@Sun.COM 						i++;
6207656SSherry.Moore@Sun.COM 					}
6217656SSherry.Moore@Sun.COM 				}
6227656SSherry.Moore@Sun.COM 
6237656SSherry.Moore@Sun.COM 			}
6247656SSherry.Moore@Sun.COM 			bcopy(mdep, kern_bootfile, i);
6257656SSherry.Moore@Sun.COM 			kern_bootfile[i] = '\0';
6267750SSherry.Moore@Sun.COM 			bcopy(mdep, bootargs, strlen(mdep));
6277656SSherry.Moore@Sun.COM 		} else {
6287656SSherry.Moore@Sun.COM 			int off = strlen(kern_bootfile);
6297656SSherry.Moore@Sun.COM 			bcopy(kern_bootfile, bootargs, off);
6307656SSherry.Moore@Sun.COM 			bcopy(" ", &bootargs[off++], 1);
6317656SSherry.Moore@Sun.COM 			bcopy(mdep, &bootargs[off], strlen(mdep));
6327656SSherry.Moore@Sun.COM 			off += strlen(mdep);
6337656SSherry.Moore@Sun.COM 			bootargs[off] = '\0';
6347656SSherry.Moore@Sun.COM 		}
6357656SSherry.Moore@Sun.COM 	}
6367750SSherry.Moore@Sun.COM }
6377750SSherry.Moore@Sun.COM 
6387750SSherry.Moore@Sun.COM /*
6399160SSherry.Moore@Sun.COM  * Reserve memory under PA 1G for mapping the new kernel and boot archive.
6409160SSherry.Moore@Sun.COM  * This function is only called if fastreboot_onpanic is *not* set.
6419160SSherry.Moore@Sun.COM  */
6429160SSherry.Moore@Sun.COM static void
6439160SSherry.Moore@Sun.COM fastboot_reserve_mem(fastboot_info_t *nk)
6449160SSherry.Moore@Sun.COM {
6459160SSherry.Moore@Sun.COM 	int i;
6469160SSherry.Moore@Sun.COM 
6479160SSherry.Moore@Sun.COM 	/*
6489160SSherry.Moore@Sun.COM 	 * A valid kernel is in place.  No need to reserve any memory.
6499160SSherry.Moore@Sun.COM 	 */
6509160SSherry.Moore@Sun.COM 	if (nk->fi_valid)
6519160SSherry.Moore@Sun.COM 		return;
6529160SSherry.Moore@Sun.COM 
6539160SSherry.Moore@Sun.COM 	/*
6549160SSherry.Moore@Sun.COM 	 * Reserve memory under PA 1G for PTE lists.
6559160SSherry.Moore@Sun.COM 	 */
6569160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
6579160SSherry.Moore@Sun.COM 		fastboot_file_t *fb = &nk->fi_files[i];
6589160SSherry.Moore@Sun.COM 		size_t fsize_roundup, size;
6599160SSherry.Moore@Sun.COM 
6609160SSherry.Moore@Sun.COM 		fsize_roundup = P2ROUNDUP_TYPED(saved_file_size[i],
6619160SSherry.Moore@Sun.COM 		    PAGESIZE, size_t);
6629160SSherry.Moore@Sun.COM 		size = FASTBOOT_PTE_LIST_SIZE(fsize_roundup);
6639160SSherry.Moore@Sun.COM 		if ((fb->fb_pte_list_va = contig_alloc(size,
6649160SSherry.Moore@Sun.COM 		    &fastboot_below_1G_dma_attr, PAGESIZE, 0)) == NULL) {
6659160SSherry.Moore@Sun.COM 			return;
6669160SSherry.Moore@Sun.COM 		}
6679160SSherry.Moore@Sun.COM 		fb->fb_pte_list_size = size;
6689160SSherry.Moore@Sun.COM 	}
6699160SSherry.Moore@Sun.COM 
6709160SSherry.Moore@Sun.COM 	/*
6719160SSherry.Moore@Sun.COM 	 * Reserve memory under PA 1G for page tables.
6729160SSherry.Moore@Sun.COM 	 */
6739160SSherry.Moore@Sun.COM 	if ((nk->fi_pagetable_va =
6749160SSherry.Moore@Sun.COM 	    (uintptr_t)contig_alloc(fastboot_pagetable_size,
6759160SSherry.Moore@Sun.COM 	    &fastboot_below_1G_dma_attr, PAGESIZE, 0)) == NULL) {
6769160SSherry.Moore@Sun.COM 		return;
6779160SSherry.Moore@Sun.COM 	}
6789160SSherry.Moore@Sun.COM 	nk->fi_pagetable_size = fastboot_pagetable_size;
6799160SSherry.Moore@Sun.COM 
6809160SSherry.Moore@Sun.COM 	/*
6819160SSherry.Moore@Sun.COM 	 * Reserve memory under PA 1G for multiboot structure.
6829160SSherry.Moore@Sun.COM 	 */
6839160SSherry.Moore@Sun.COM 	if ((nk->fi_new_mbi_va = (uintptr_t)contig_alloc(fastboot_mbi_size,
6849160SSherry.Moore@Sun.COM 	    &fastboot_below_1G_dma_attr, PAGESIZE, 0)) == NULL) {
6859160SSherry.Moore@Sun.COM 		return;
6869160SSherry.Moore@Sun.COM 	}
6879160SSherry.Moore@Sun.COM 	nk->fi_mbi_size = fastboot_mbi_size;
6889160SSherry.Moore@Sun.COM }
6899160SSherry.Moore@Sun.COM 
6909160SSherry.Moore@Sun.COM /*
6919160SSherry.Moore@Sun.COM  * Calculate MD5 digest for the given fastboot_file.
6929160SSherry.Moore@Sun.COM  * Assumes that the file is allready loaded properly.
6939160SSherry.Moore@Sun.COM  */
6949160SSherry.Moore@Sun.COM static void
6959160SSherry.Moore@Sun.COM fastboot_cksum_file(fastboot_file_t *fb, uchar_t *md5_hash)
6969160SSherry.Moore@Sun.COM {
6979160SSherry.Moore@Sun.COM 	MD5_CTX md5_ctx;
6989160SSherry.Moore@Sun.COM 
6999160SSherry.Moore@Sun.COM 	MD5Init(&md5_ctx);
7009160SSherry.Moore@Sun.COM 	MD5Update(&md5_ctx, (void *)fb->fb_va, fb->fb_size);
7019160SSherry.Moore@Sun.COM 	MD5Final(md5_hash, &md5_ctx);
7029160SSherry.Moore@Sun.COM }
7039160SSherry.Moore@Sun.COM 
7049160SSherry.Moore@Sun.COM /*
7059160SSherry.Moore@Sun.COM  * Free up the memory we have allocated for a file
7067750SSherry.Moore@Sun.COM  */
7077750SSherry.Moore@Sun.COM static void
7087750SSherry.Moore@Sun.COM fastboot_free_file(fastboot_file_t *fb)
7097750SSherry.Moore@Sun.COM {
7109160SSherry.Moore@Sun.COM 	size_t	fsize_roundup;
7117750SSherry.Moore@Sun.COM 
7127750SSherry.Moore@Sun.COM 	fsize_roundup = P2ROUNDUP_TYPED(fb->fb_size, PAGESIZE, size_t);
7139160SSherry.Moore@Sun.COM 	if (fsize_roundup) {
7149160SSherry.Moore@Sun.COM 		contig_free((void *)fb->fb_va, fsize_roundup);
7159160SSherry.Moore@Sun.COM 		fb->fb_va = NULL;
7169160SSherry.Moore@Sun.COM 		fb->fb_size = 0;
7179160SSherry.Moore@Sun.COM 	}
7189160SSherry.Moore@Sun.COM }
7199160SSherry.Moore@Sun.COM 
7209160SSherry.Moore@Sun.COM /*
7219160SSherry.Moore@Sun.COM  * Free up memory used by the PTEs for a file.
7229160SSherry.Moore@Sun.COM  */
7239160SSherry.Moore@Sun.COM static void
7249160SSherry.Moore@Sun.COM fastboot_free_file_pte(fastboot_file_t *fb, uint64_t endaddr)
7259160SSherry.Moore@Sun.COM {
7269160SSherry.Moore@Sun.COM 	if (fb->fb_pte_list_size && fb->fb_pte_list_pa < endaddr) {
7279160SSherry.Moore@Sun.COM 		contig_free((void *)fb->fb_pte_list_va, fb->fb_pte_list_size);
7289160SSherry.Moore@Sun.COM 		fb->fb_pte_list_va = 0;
7299160SSherry.Moore@Sun.COM 		fb->fb_pte_list_pa = 0;
7309160SSherry.Moore@Sun.COM 		fb->fb_pte_list_size = 0;
7319160SSherry.Moore@Sun.COM 	}
7329160SSherry.Moore@Sun.COM }
7339160SSherry.Moore@Sun.COM 
7349160SSherry.Moore@Sun.COM /*
7359160SSherry.Moore@Sun.COM  * Free up all the memory used for representing a kernel with
7369160SSherry.Moore@Sun.COM  * fastboot_info_t.
7379160SSherry.Moore@Sun.COM  */
7389160SSherry.Moore@Sun.COM static void
7399160SSherry.Moore@Sun.COM fastboot_free_mem(fastboot_info_t *nk, uint64_t endaddr)
7409160SSherry.Moore@Sun.COM {
7419160SSherry.Moore@Sun.COM 	int i;
7429160SSherry.Moore@Sun.COM 
7439160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
7449160SSherry.Moore@Sun.COM 		fastboot_free_file(nk->fi_files + i);
7459160SSherry.Moore@Sun.COM 		fastboot_free_file_pte(nk->fi_files + i, endaddr);
7469160SSherry.Moore@Sun.COM 	}
7479160SSherry.Moore@Sun.COM 
7489160SSherry.Moore@Sun.COM 	if (nk->fi_pagetable_size && nk->fi_pagetable_pa < endaddr) {
7499160SSherry.Moore@Sun.COM 		contig_free((void *)nk->fi_pagetable_va, nk->fi_pagetable_size);
7509160SSherry.Moore@Sun.COM 		nk->fi_pagetable_va = 0;
7519160SSherry.Moore@Sun.COM 		nk->fi_pagetable_pa = 0;
7529160SSherry.Moore@Sun.COM 		nk->fi_pagetable_size = 0;
7539160SSherry.Moore@Sun.COM 	}
7549160SSherry.Moore@Sun.COM 
7559160SSherry.Moore@Sun.COM 	if (nk->fi_mbi_size && nk->fi_new_mbi_pa < endaddr) {
7569160SSherry.Moore@Sun.COM 		contig_free((void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
7579160SSherry.Moore@Sun.COM 		nk->fi_new_mbi_va = 0;
7589160SSherry.Moore@Sun.COM 		nk->fi_new_mbi_pa = 0;
7599160SSherry.Moore@Sun.COM 		nk->fi_mbi_size = 0;
7609160SSherry.Moore@Sun.COM 	}
7619160SSherry.Moore@Sun.COM }
7629160SSherry.Moore@Sun.COM 
7639160SSherry.Moore@Sun.COM /*
7649160SSherry.Moore@Sun.COM  * Only free up the memory allocated for the kernel and boot archive,
7659160SSherry.Moore@Sun.COM  * but not for the page tables.
7669160SSherry.Moore@Sun.COM  */
7679160SSherry.Moore@Sun.COM void
7689160SSherry.Moore@Sun.COM fastboot_free_newkernel(fastboot_info_t *nk)
7699160SSherry.Moore@Sun.COM {
7709160SSherry.Moore@Sun.COM 	int i;
7717750SSherry.Moore@Sun.COM 
7729160SSherry.Moore@Sun.COM 	nk->fi_valid = 0;
7739160SSherry.Moore@Sun.COM 	/*
7749160SSherry.Moore@Sun.COM 	 * Free the memory we have allocated
7759160SSherry.Moore@Sun.COM 	 */
7769160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
7779160SSherry.Moore@Sun.COM 		fastboot_free_file(&(nk->fi_files[i]));
7789160SSherry.Moore@Sun.COM 	}
7799160SSherry.Moore@Sun.COM }
7809160SSherry.Moore@Sun.COM 
7819160SSherry.Moore@Sun.COM static void
7829160SSherry.Moore@Sun.COM fastboot_cksum_cdata(fastboot_info_t *nk, uchar_t *md5_hash)
7839160SSherry.Moore@Sun.COM {
7849160SSherry.Moore@Sun.COM 	int i;
7859160SSherry.Moore@Sun.COM 	MD5_CTX md5_ctx;
7869160SSherry.Moore@Sun.COM 
7879160SSherry.Moore@Sun.COM 	MD5Init(&md5_ctx);
7889160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
7899160SSherry.Moore@Sun.COM 		MD5Update(&md5_ctx, nk->fi_files[i].fb_pte_list_va,
7909160SSherry.Moore@Sun.COM 		    nk->fi_files[i].fb_pte_list_size);
7919160SSherry.Moore@Sun.COM 	}
7929160SSherry.Moore@Sun.COM 	MD5Update(&md5_ctx, (void *)nk->fi_pagetable_va, nk->fi_pagetable_size);
7939160SSherry.Moore@Sun.COM 	MD5Update(&md5_ctx, (void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
7949160SSherry.Moore@Sun.COM 
7959160SSherry.Moore@Sun.COM 	MD5Final(md5_hash, &md5_ctx);
7969160SSherry.Moore@Sun.COM }
7979160SSherry.Moore@Sun.COM 
7989160SSherry.Moore@Sun.COM /*
7999160SSherry.Moore@Sun.COM  * Generate MD5 checksum of the given kernel.
8009160SSherry.Moore@Sun.COM  */
8019160SSherry.Moore@Sun.COM static void
8029160SSherry.Moore@Sun.COM fastboot_cksum_generate(fastboot_info_t *nk)
8039160SSherry.Moore@Sun.COM {
8049160SSherry.Moore@Sun.COM 	int i;
8059160SSherry.Moore@Sun.COM 
8069160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
8079160SSherry.Moore@Sun.COM 		fastboot_cksum_file(nk->fi_files + i, nk->fi_md5_hash[i]);
8089160SSherry.Moore@Sun.COM 	}
8099160SSherry.Moore@Sun.COM 	fastboot_cksum_cdata(nk, nk->fi_md5_hash[i]);
8109160SSherry.Moore@Sun.COM }
8119160SSherry.Moore@Sun.COM 
8129160SSherry.Moore@Sun.COM /*
8139160SSherry.Moore@Sun.COM  * Calculate MD5 checksum of the given kernel and verify that
8149160SSherry.Moore@Sun.COM  * it matches with what was calculated before.
8159160SSherry.Moore@Sun.COM  */
8169160SSherry.Moore@Sun.COM int
8179160SSherry.Moore@Sun.COM fastboot_cksum_verify(fastboot_info_t *nk)
8189160SSherry.Moore@Sun.COM {
8199160SSherry.Moore@Sun.COM 	int i;
8209160SSherry.Moore@Sun.COM 	uchar_t md5_hash[MD5_DIGEST_LENGTH];
8219160SSherry.Moore@Sun.COM 
8229160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
8239160SSherry.Moore@Sun.COM 		fastboot_cksum_file(nk->fi_files + i, md5_hash);
8249160SSherry.Moore@Sun.COM 		if (bcmp(nk->fi_md5_hash[i], md5_hash,
8259160SSherry.Moore@Sun.COM 		    sizeof (nk->fi_md5_hash[i])) != 0)
8269160SSherry.Moore@Sun.COM 			return (i + 1);
8279160SSherry.Moore@Sun.COM 	}
8289160SSherry.Moore@Sun.COM 
8299160SSherry.Moore@Sun.COM 	fastboot_cksum_cdata(nk, md5_hash);
8309160SSherry.Moore@Sun.COM 	if (bcmp(nk->fi_md5_hash[i], md5_hash,
8319160SSherry.Moore@Sun.COM 	    sizeof (nk->fi_md5_hash[i])) != 0)
8329160SSherry.Moore@Sun.COM 		return (i + 1);
8339160SSherry.Moore@Sun.COM 
8349160SSherry.Moore@Sun.COM 	return (0);
8357750SSherry.Moore@Sun.COM }
8367750SSherry.Moore@Sun.COM 
8377750SSherry.Moore@Sun.COM /*
8387750SSherry.Moore@Sun.COM  * This function performs the following tasks:
8397750SSherry.Moore@Sun.COM  * - Read the sizes of the new kernel and boot archive.
8407750SSherry.Moore@Sun.COM  * - Allocate memory for the new kernel and boot archive.
8417750SSherry.Moore@Sun.COM  * - Allocate memory for page tables necessary for mapping the memory
8427750SSherry.Moore@Sun.COM  *   allocated for the files.
8437750SSherry.Moore@Sun.COM  * - Read the new kernel and boot archive into memory.
8447750SSherry.Moore@Sun.COM  * - Map in the fast reboot switcher.
8457750SSherry.Moore@Sun.COM  * - Load the fast reboot switcher to FASTBOOT_SWTCH_PA.
8467750SSherry.Moore@Sun.COM  * - Build the new multiboot_info structure
8477750SSherry.Moore@Sun.COM  * - Build page tables for the low 1G of physical memory.
8487750SSherry.Moore@Sun.COM  * - Mark the data structure as valid if all steps have succeeded.
8497750SSherry.Moore@Sun.COM  */
8507750SSherry.Moore@Sun.COM void
8519160SSherry.Moore@Sun.COM fastboot_load_kernel(char *mdep)
8527750SSherry.Moore@Sun.COM {
8537750SSherry.Moore@Sun.COM 	void		*buf = NULL;
8547750SSherry.Moore@Sun.COM 	int		i;
8557750SSherry.Moore@Sun.COM 	fastboot_file_t	*fb;
8567750SSherry.Moore@Sun.COM 	uint32_t	dboot_start_offset;
8577750SSherry.Moore@Sun.COM 	char		kern_bootpath[OBP_MAXPATHLEN];
8587750SSherry.Moore@Sun.COM 	extern uintptr_t postbootkernelbase;
8599160SSherry.Moore@Sun.COM 	uintptr_t	saved_kernelbase;
8607750SSherry.Moore@Sun.COM 	int		bootpath_len = 0;
8617750SSherry.Moore@Sun.COM 	int		is_failsafe = 0;
8627750SSherry.Moore@Sun.COM 	int		is_retry = 0;
8637750SSherry.Moore@Sun.COM 	uint64_t	end_addr;
8647750SSherry.Moore@Sun.COM 
8657750SSherry.Moore@Sun.COM 	ASSERT(fastreboot_capable);
8667750SSherry.Moore@Sun.COM 
8679160SSherry.Moore@Sun.COM 	if (newkernel.fi_valid)
8689160SSherry.Moore@Sun.COM 		fastboot_free_newkernel(&newkernel);
8699160SSherry.Moore@Sun.COM 
8709160SSherry.Moore@Sun.COM 	saved_kernelbase = postbootkernelbase;
8719160SSherry.Moore@Sun.COM 
8727750SSherry.Moore@Sun.COM 	postbootkernelbase = 0;
8737750SSherry.Moore@Sun.COM 
8747750SSherry.Moore@Sun.COM 	/*
8757750SSherry.Moore@Sun.COM 	 * Initialize various HAT related fields in the data structure
8767750SSherry.Moore@Sun.COM 	 */
8777750SSherry.Moore@Sun.COM 	fastboot_init_fields(&newkernel);
8787750SSherry.Moore@Sun.COM 
8797750SSherry.Moore@Sun.COM 	bzero(kern_bootpath, OBP_MAXPATHLEN);
8807750SSherry.Moore@Sun.COM 
8817750SSherry.Moore@Sun.COM 	/*
8827750SSherry.Moore@Sun.COM 	 * Process the boot argument
8837750SSherry.Moore@Sun.COM 	 */
8849160SSherry.Moore@Sun.COM 	bzero(fastboot_args, OBP_MAXPATHLEN);
8859160SSherry.Moore@Sun.COM 	fastboot_parse_mdep(mdep, kern_bootpath, &bootpath_len, fastboot_args);
8867656SSherry.Moore@Sun.COM 
8877656SSherry.Moore@Sun.COM 	/*
8887656SSherry.Moore@Sun.COM 	 * Make sure we get the null character
8897656SSherry.Moore@Sun.COM 	 */
8907656SSherry.Moore@Sun.COM 	bcopy(kern_bootpath, fastboot_filename[FASTBOOT_NAME_UNIX],
8917656SSherry.Moore@Sun.COM 	    bootpath_len);
8927656SSherry.Moore@Sun.COM 	bcopy(kern_bootfile,
8937656SSherry.Moore@Sun.COM 	    &fastboot_filename[FASTBOOT_NAME_UNIX][bootpath_len],
8947656SSherry.Moore@Sun.COM 	    strlen(kern_bootfile) + 1);
8957656SSherry.Moore@Sun.COM 
8967656SSherry.Moore@Sun.COM 	bcopy(kern_bootpath, fastboot_filename[FASTBOOT_NAME_BOOTARCHIVE],
8977656SSherry.Moore@Sun.COM 	    bootpath_len);
8987656SSherry.Moore@Sun.COM 
8999160SSherry.Moore@Sun.COM 	if (bcmp(kern_bootfile, FAILSAFE_BOOTFILE32,
9009160SSherry.Moore@Sun.COM 	    (sizeof (FAILSAFE_BOOTFILE32) - 1)) == 0 ||
9019160SSherry.Moore@Sun.COM 	    bcmp(kern_bootfile, FAILSAFE_BOOTFILE64,
9029160SSherry.Moore@Sun.COM 	    (sizeof (FAILSAFE_BOOTFILE64) - 1)) == 0) {
9037656SSherry.Moore@Sun.COM 		is_failsafe = 1;
9047656SSherry.Moore@Sun.COM 	}
9057656SSherry.Moore@Sun.COM 
9067750SSherry.Moore@Sun.COM load_kernel_retry:
9077656SSherry.Moore@Sun.COM 	/*
9087656SSherry.Moore@Sun.COM 	 * Read in unix and boot_archive
9097656SSherry.Moore@Sun.COM 	 */
9107750SSherry.Moore@Sun.COM 	end_addr = DBOOT_ENTRY_ADDRESS;
9117656SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
9127750SSherry.Moore@Sun.COM 		struct _buf	*file;
9137750SSherry.Moore@Sun.COM 		uintptr_t	va;
9147750SSherry.Moore@Sun.COM 		uint64_t	fsize;
9157750SSherry.Moore@Sun.COM 		size_t		fsize_roundup, pt_size;
9167750SSherry.Moore@Sun.COM 		int		page_index;
9177750SSherry.Moore@Sun.COM 		uintptr_t	offset;
9187656SSherry.Moore@Sun.COM 		ddi_dma_attr_t dma_attr = fastboot_dma_attr;
9197656SSherry.Moore@Sun.COM 
9207750SSherry.Moore@Sun.COM 
9217656SSherry.Moore@Sun.COM 		dprintf("fastboot_filename[%d] = %s\n",
9227656SSherry.Moore@Sun.COM 		    i, fastboot_filename[i]);
9237656SSherry.Moore@Sun.COM 
9247656SSherry.Moore@Sun.COM 		if ((file = kobj_open_file(fastboot_filename[i])) ==
9257656SSherry.Moore@Sun.COM 		    (struct _buf *)-1) {
9267656SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, "Fastboot: Couldn't open %s",
9277656SSherry.Moore@Sun.COM 			    fastboot_filename[i]);
9287656SSherry.Moore@Sun.COM 			goto err_out;
9297656SSherry.Moore@Sun.COM 		}
9307656SSherry.Moore@Sun.COM 
9317656SSherry.Moore@Sun.COM 		if (kobj_get_filesize(file, &fsize) != 0) {
9327656SSherry.Moore@Sun.COM 			cmn_err(CE_WARN,
9337656SSherry.Moore@Sun.COM 			    "Fastboot: Couldn't get filesize for %s",
9347656SSherry.Moore@Sun.COM 			    fastboot_filename[i]);
9357656SSherry.Moore@Sun.COM 			goto err_out;
9367656SSherry.Moore@Sun.COM 		}
9377656SSherry.Moore@Sun.COM 
9387750SSherry.Moore@Sun.COM 		fsize_roundup = P2ROUNDUP_TYPED(fsize, PAGESIZE, size_t);
9397750SSherry.Moore@Sun.COM 
9407750SSherry.Moore@Sun.COM 		/*
9417750SSherry.Moore@Sun.COM 		 * Where the files end in physical memory after being
9427750SSherry.Moore@Sun.COM 		 * relocated by the fast boot switcher.
9437750SSherry.Moore@Sun.COM 		 */
9447750SSherry.Moore@Sun.COM 		end_addr += fsize_roundup;
9457750SSherry.Moore@Sun.COM 		if (end_addr > fastboot_below_1G_dma_attr.dma_attr_addr_hi) {
9467750SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, "Fastboot: boot archive is too big");
9477750SSherry.Moore@Sun.COM 			goto err_out;
9487656SSherry.Moore@Sun.COM 		}
9497656SSherry.Moore@Sun.COM 
9507750SSherry.Moore@Sun.COM 		/*
9517750SSherry.Moore@Sun.COM 		 * Adjust dma_attr_addr_lo so that the new kernel and boot
9527750SSherry.Moore@Sun.COM 		 * archive will not be overridden during relocation.
9537750SSherry.Moore@Sun.COM 		 */
9547750SSherry.Moore@Sun.COM 		if (end_addr > fastboot_dma_attr.dma_attr_addr_lo ||
9557750SSherry.Moore@Sun.COM 		    end_addr > fastboot_below_1G_dma_attr.dma_attr_addr_lo) {
9567750SSherry.Moore@Sun.COM 
9577750SSherry.Moore@Sun.COM 			if (is_retry) {
9587750SSherry.Moore@Sun.COM 				/*
9597750SSherry.Moore@Sun.COM 				 * If we have already tried and didn't succeed,
9607750SSherry.Moore@Sun.COM 				 * just give up.
9617750SSherry.Moore@Sun.COM 				 */
9627750SSherry.Moore@Sun.COM 				cmn_err(CE_WARN,
9637750SSherry.Moore@Sun.COM 				    "Fastboot: boot archive is too big");
9647750SSherry.Moore@Sun.COM 				goto err_out;
9657750SSherry.Moore@Sun.COM 			} else {
9667750SSherry.Moore@Sun.COM 				/* Set the flag so we don't keep retrying */
9677750SSherry.Moore@Sun.COM 				is_retry++;
9687750SSherry.Moore@Sun.COM 
9697750SSherry.Moore@Sun.COM 				/* Adjust dma_attr_addr_lo */
9707750SSherry.Moore@Sun.COM 				fastboot_dma_attr.dma_attr_addr_lo = end_addr;
9717750SSherry.Moore@Sun.COM 				fastboot_below_1G_dma_attr.dma_attr_addr_lo =
9727750SSherry.Moore@Sun.COM 				    end_addr;
9737750SSherry.Moore@Sun.COM 
9747750SSherry.Moore@Sun.COM 				/*
9757750SSherry.Moore@Sun.COM 				 * Free the memory we have already allocated
9767750SSherry.Moore@Sun.COM 				 * whose physical addresses might not fit
9777750SSherry.Moore@Sun.COM 				 * the new lo and hi constraints.
9787750SSherry.Moore@Sun.COM 				 */
9799160SSherry.Moore@Sun.COM 				fastboot_free_mem(&newkernel, end_addr);
9807750SSherry.Moore@Sun.COM 				goto load_kernel_retry;
9817750SSherry.Moore@Sun.COM 			}
9827750SSherry.Moore@Sun.COM 		}
9837750SSherry.Moore@Sun.COM 
9847750SSherry.Moore@Sun.COM 
9857656SSherry.Moore@Sun.COM 		if (!fastboot_contig)
9867656SSherry.Moore@Sun.COM 			dma_attr.dma_attr_sgllen = (fsize / PAGESIZE) +
9877656SSherry.Moore@Sun.COM 			    (((fsize % PAGESIZE) == 0) ? 0 : 1);
9887656SSherry.Moore@Sun.COM 
9897656SSherry.Moore@Sun.COM 		if ((buf = contig_alloc(fsize, &dma_attr, PAGESIZE, 0))
9907656SSherry.Moore@Sun.COM 		    == NULL) {
9917750SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, fastboot_enomem_msg, fsize, "64G");
9927656SSherry.Moore@Sun.COM 			goto err_out;
9937656SSherry.Moore@Sun.COM 		}
9947656SSherry.Moore@Sun.COM 
9957656SSherry.Moore@Sun.COM 		va = P2ROUNDUP_TYPED((uintptr_t)buf, PAGESIZE, uintptr_t);
9967656SSherry.Moore@Sun.COM 
9977656SSherry.Moore@Sun.COM 		if (kobj_read_file(file, (char *)va, fsize, 0) < 0) {
9987656SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, "Fastboot: Couldn't read %s",
9997656SSherry.Moore@Sun.COM 			    fastboot_filename[i]);
10007656SSherry.Moore@Sun.COM 			goto err_out;
10017656SSherry.Moore@Sun.COM 		}
10027656SSherry.Moore@Sun.COM 
10037656SSherry.Moore@Sun.COM 		fb = &newkernel.fi_files[i];
10047656SSherry.Moore@Sun.COM 		fb->fb_va = va;
10057656SSherry.Moore@Sun.COM 		fb->fb_size = fsize;
10067656SSherry.Moore@Sun.COM 		fb->fb_sectcnt = 0;
10077656SSherry.Moore@Sun.COM 
10089160SSherry.Moore@Sun.COM 		pt_size = FASTBOOT_PTE_LIST_SIZE(fsize_roundup);
10097656SSherry.Moore@Sun.COM 
10109160SSherry.Moore@Sun.COM 		/*
10119160SSherry.Moore@Sun.COM 		 * If we have reserved memory but it not enough, free it.
10129160SSherry.Moore@Sun.COM 		 */
10139160SSherry.Moore@Sun.COM 		if (fb->fb_pte_list_size && fb->fb_pte_list_size < pt_size) {
10149160SSherry.Moore@Sun.COM 			contig_free((void *)fb->fb_pte_list_va,
10159160SSherry.Moore@Sun.COM 			    fb->fb_pte_list_size);
10169160SSherry.Moore@Sun.COM 			fb->fb_pte_list_size = 0;
10177656SSherry.Moore@Sun.COM 		}
10187656SSherry.Moore@Sun.COM 
10199160SSherry.Moore@Sun.COM 		if (fb->fb_pte_list_size == 0) {
10209160SSherry.Moore@Sun.COM 			if ((fb->fb_pte_list_va =
10219160SSherry.Moore@Sun.COM 			    (x86pte_t *)contig_alloc(pt_size,
10229160SSherry.Moore@Sun.COM 			    &fastboot_below_1G_dma_attr, PAGESIZE, 0))
10239160SSherry.Moore@Sun.COM 			    == NULL) {
10249160SSherry.Moore@Sun.COM 				cmn_err(CE_WARN, fastboot_enomem_msg,
10259160SSherry.Moore@Sun.COM 				    (uint64_t)pt_size, "1G");
10269160SSherry.Moore@Sun.COM 				goto err_out;
10279160SSherry.Moore@Sun.COM 			}
10289160SSherry.Moore@Sun.COM 			/*
10299160SSherry.Moore@Sun.COM 			 * fb_pte_list_size must be set after the allocation
10309160SSherry.Moore@Sun.COM 			 * succeeds as it's used to determine how much memory to
10319160SSherry.Moore@Sun.COM 			 * free.
10329160SSherry.Moore@Sun.COM 			 */
10339160SSherry.Moore@Sun.COM 			fb->fb_pte_list_size = pt_size;
10349160SSherry.Moore@Sun.COM 		}
10359160SSherry.Moore@Sun.COM 
10369160SSherry.Moore@Sun.COM 		bzero((void *)(fb->fb_pte_list_va), fb->fb_pte_list_size);
10377656SSherry.Moore@Sun.COM 
10387656SSherry.Moore@Sun.COM 		fb->fb_pte_list_pa = mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
10397656SSherry.Moore@Sun.COM 		    (caddr_t)fb->fb_pte_list_va));
10407656SSherry.Moore@Sun.COM 
10417656SSherry.Moore@Sun.COM 		for (page_index = 0, offset = 0; offset < fb->fb_size;
10427656SSherry.Moore@Sun.COM 		    offset += PAGESIZE) {
10437656SSherry.Moore@Sun.COM 			uint64_t paddr;
10447656SSherry.Moore@Sun.COM 
10457656SSherry.Moore@Sun.COM 			paddr = mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
10467656SSherry.Moore@Sun.COM 			    (caddr_t)fb->fb_va + offset));
10477656SSherry.Moore@Sun.COM 
10487656SSherry.Moore@Sun.COM 			ASSERT(paddr >= fastboot_dma_attr.dma_attr_addr_lo);
10497656SSherry.Moore@Sun.COM 
10507656SSherry.Moore@Sun.COM 			/*
10517656SSherry.Moore@Sun.COM 			 * Include the pte_bits so we don't have to make
10527656SSherry.Moore@Sun.COM 			 * it in assembly.
10537656SSherry.Moore@Sun.COM 			 */
10547656SSherry.Moore@Sun.COM 			fb->fb_pte_list_va[page_index++] = (x86pte_t)
10557656SSherry.Moore@Sun.COM 			    (paddr | pte_bits);
10567656SSherry.Moore@Sun.COM 		}
10577656SSherry.Moore@Sun.COM 
10587656SSherry.Moore@Sun.COM 		fb->fb_pte_list_va[page_index] = FASTBOOT_TERMINATE;
10597656SSherry.Moore@Sun.COM 
10607656SSherry.Moore@Sun.COM 		if (i == FASTBOOT_UNIX) {
10617750SSherry.Moore@Sun.COM 			Ehdr	*ehdr = (Ehdr *)va;
10627750SSherry.Moore@Sun.COM 			int	j;
10637656SSherry.Moore@Sun.COM 
10647656SSherry.Moore@Sun.COM 			/*
10657656SSherry.Moore@Sun.COM 			 * Sanity checks:
10667656SSherry.Moore@Sun.COM 			 */
10677656SSherry.Moore@Sun.COM 			for (j = 0; j < SELFMAG; j++) {
10687656SSherry.Moore@Sun.COM 				if (ehdr->e_ident[j] != ELFMAG[j]) {
10697656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: Bad ELF "
10707656SSherry.Moore@Sun.COM 					    "signature");
10717656SSherry.Moore@Sun.COM 					goto err_out;
10727656SSherry.Moore@Sun.COM 				}
10737656SSherry.Moore@Sun.COM 			}
10747656SSherry.Moore@Sun.COM 
10757656SSherry.Moore@Sun.COM 			if (ehdr->e_ident[EI_CLASS] == ELFCLASS32 &&
10767656SSherry.Moore@Sun.COM 			    ehdr->e_ident[EI_DATA] == ELFDATA2LSB &&
10777656SSherry.Moore@Sun.COM 			    ehdr->e_machine == EM_386) {
10787656SSherry.Moore@Sun.COM 
10798151SKonstantin.Ananyev@Sun.COM 				fb->fb_sectcnt = sizeof (fb->fb_sections) /
10808151SKonstantin.Ananyev@Sun.COM 				    sizeof (fb->fb_sections[0]);
10818151SKonstantin.Ananyev@Sun.COM 
10827656SSherry.Moore@Sun.COM 				if (fastboot_elf32_find_loadables((void *)va,
10837656SSherry.Moore@Sun.COM 				    fsize, &fb->fb_sections[0],
10847656SSherry.Moore@Sun.COM 				    &fb->fb_sectcnt, &dboot_start_offset) < 0) {
10857656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: ELF32 "
10867656SSherry.Moore@Sun.COM 					    "program section failure");
10877656SSherry.Moore@Sun.COM 					goto err_out;
10887656SSherry.Moore@Sun.COM 				}
10897656SSherry.Moore@Sun.COM 
10907656SSherry.Moore@Sun.COM 				if (fb->fb_sectcnt == 0) {
10917656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: No ELF32 "
10927656SSherry.Moore@Sun.COM 					    "program sections found");
10937656SSherry.Moore@Sun.COM 					goto err_out;
10947656SSherry.Moore@Sun.COM 				}
10957656SSherry.Moore@Sun.COM 
10967656SSherry.Moore@Sun.COM 				if (is_failsafe) {
10977656SSherry.Moore@Sun.COM 					/* Failsafe boot_archive */
10989160SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE32_FAILSAFE,
10997656SSherry.Moore@Sun.COM 					    &fastboot_filename
11007656SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11017656SSherry.Moore@Sun.COM 					    [bootpath_len],
11029160SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE32_FAILSAFE));
11037656SSherry.Moore@Sun.COM 				} else {
11047656SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE32,
11057656SSherry.Moore@Sun.COM 					    &fastboot_filename
11067656SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11077656SSherry.Moore@Sun.COM 					    [bootpath_len],
11087656SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE32));
11097656SSherry.Moore@Sun.COM 				}
11107656SSherry.Moore@Sun.COM 
11117656SSherry.Moore@Sun.COM 			} else if (ehdr->e_ident[EI_CLASS] == ELFCLASS64 &&
11127656SSherry.Moore@Sun.COM 			    ehdr->e_ident[EI_DATA] == ELFDATA2LSB &&
11137656SSherry.Moore@Sun.COM 			    ehdr->e_machine == EM_AMD64) {
11147656SSherry.Moore@Sun.COM 
11157656SSherry.Moore@Sun.COM 				if (fastboot_elf64_find_dboot_load_offset(
11167656SSherry.Moore@Sun.COM 				    (void *)va, fsize, &dboot_start_offset)
11177656SSherry.Moore@Sun.COM 				    != 0) {
11187656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: Couldn't "
11197656SSherry.Moore@Sun.COM 					    "find ELF64 dboot entry offset");
11207656SSherry.Moore@Sun.COM 					goto err_out;
11217656SSherry.Moore@Sun.COM 				}
11227656SSherry.Moore@Sun.COM 
11237656SSherry.Moore@Sun.COM 				if ((x86_feature & X86_64) == 0 ||
11248151SKonstantin.Ananyev@Sun.COM 				    (x86_feature & X86_PAE) == 0) {
11257656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: Cannot "
11267656SSherry.Moore@Sun.COM 					    "reboot to %s: "
11277656SSherry.Moore@Sun.COM 					    "not a 64-bit capable system",
11287656SSherry.Moore@Sun.COM 					    kern_bootfile);
11297656SSherry.Moore@Sun.COM 					goto err_out;
11307656SSherry.Moore@Sun.COM 				}
11317656SSherry.Moore@Sun.COM 
11329160SSherry.Moore@Sun.COM 				if (is_failsafe) {
11339160SSherry.Moore@Sun.COM 					/* Failsafe boot_archive */
11349160SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE64_FAILSAFE,
11359160SSherry.Moore@Sun.COM 					    &fastboot_filename
11369160SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11379160SSherry.Moore@Sun.COM 					    [bootpath_len],
11389160SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE64_FAILSAFE));
11399160SSherry.Moore@Sun.COM 				} else {
11409160SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE64,
11419160SSherry.Moore@Sun.COM 					    &fastboot_filename
11429160SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11439160SSherry.Moore@Sun.COM 					    [bootpath_len],
11449160SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE64));
11459160SSherry.Moore@Sun.COM 				}
11467656SSherry.Moore@Sun.COM 			} else {
11477656SSherry.Moore@Sun.COM 				cmn_err(CE_WARN, "Fastboot: Unknown ELF type");
11487656SSherry.Moore@Sun.COM 				goto err_out;
11497656SSherry.Moore@Sun.COM 			}
11507656SSherry.Moore@Sun.COM 
11517656SSherry.Moore@Sun.COM 			fb->fb_dest_pa = DBOOT_ENTRY_ADDRESS -
11527656SSherry.Moore@Sun.COM 			    dboot_start_offset;
11537656SSherry.Moore@Sun.COM 
11547656SSherry.Moore@Sun.COM 			fb->fb_next_pa = DBOOT_ENTRY_ADDRESS + fsize_roundup;
11557656SSherry.Moore@Sun.COM 		} else {
11567656SSherry.Moore@Sun.COM 			fb->fb_dest_pa = newkernel.fi_files[i - 1].fb_next_pa;
11577656SSherry.Moore@Sun.COM 			fb->fb_next_pa = fb->fb_dest_pa + fsize_roundup;
11587656SSherry.Moore@Sun.COM 		}
11597656SSherry.Moore@Sun.COM 
11607656SSherry.Moore@Sun.COM 		kobj_close_file(file);
11617656SSherry.Moore@Sun.COM 
11627656SSherry.Moore@Sun.COM 	}
11637656SSherry.Moore@Sun.COM 
11647750SSherry.Moore@Sun.COM 	/*
11657656SSherry.Moore@Sun.COM 	 * Add the function that will switch us to 32-bit protected mode
11667656SSherry.Moore@Sun.COM 	 */
11677656SSherry.Moore@Sun.COM 	fb = &newkernel.fi_files[FASTBOOT_SWTCH];
11687656SSherry.Moore@Sun.COM 	fb->fb_va = fb->fb_dest_pa = FASTBOOT_SWTCH_PA;
11698151SKonstantin.Ananyev@Sun.COM 	fb->fb_size = MMU_PAGESIZE;
11707656SSherry.Moore@Sun.COM 
11719160SSherry.Moore@Sun.COM 	hat_devload(kas.a_hat, (caddr_t)fb->fb_va,
11729160SSherry.Moore@Sun.COM 	    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
11739160SSherry.Moore@Sun.COM 	    PROT_READ | PROT_WRITE | PROT_EXEC,
11749160SSherry.Moore@Sun.COM 	    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
11757656SSherry.Moore@Sun.COM 
11767656SSherry.Moore@Sun.COM 	/*
11777656SSherry.Moore@Sun.COM 	 * Build the new multiboot_info structure
11787656SSherry.Moore@Sun.COM 	 */
11799160SSherry.Moore@Sun.COM 	if (fastboot_build_mbi(fastboot_args, &newkernel) != 0) {
11807656SSherry.Moore@Sun.COM 		goto err_out;
11817656SSherry.Moore@Sun.COM 	}
11827656SSherry.Moore@Sun.COM 
11837656SSherry.Moore@Sun.COM 	/*
11847656SSherry.Moore@Sun.COM 	 * Build page table for low 1G physical memory. Use big pages.
11858151SKonstantin.Ananyev@Sun.COM 	 * Allocate 4 (5 for amd64) pages for the page tables.
11868151SKonstantin.Ananyev@Sun.COM 	 *    1 page for PML4 (amd64)
11877656SSherry.Moore@Sun.COM 	 *    1 page for Page-Directory-Pointer Table
11888151SKonstantin.Ananyev@Sun.COM 	 *    2 pages for Page Directory
11897656SSherry.Moore@Sun.COM 	 *    1 page for Page Table.
11907656SSherry.Moore@Sun.COM 	 * The page table entry will be rewritten to map the physical
11917656SSherry.Moore@Sun.COM 	 * address as we do the copying.
11927656SSherry.Moore@Sun.COM 	 */
11937656SSherry.Moore@Sun.COM 	if (newkernel.fi_has_pae) {
11948151SKonstantin.Ananyev@Sun.COM #ifdef	__amd64
11958151SKonstantin.Ananyev@Sun.COM 		size_t size = MMU_PAGESIZE * 5;
11968151SKonstantin.Ananyev@Sun.COM #else
11977656SSherry.Moore@Sun.COM 		size_t size = MMU_PAGESIZE * 4;
11988151SKonstantin.Ananyev@Sun.COM #endif	/* __amd64 */
11997656SSherry.Moore@Sun.COM 
12009160SSherry.Moore@Sun.COM 		if (newkernel.fi_pagetable_size && newkernel.fi_pagetable_size
12019160SSherry.Moore@Sun.COM 		    < size) {
12029160SSherry.Moore@Sun.COM 			contig_free((void *)newkernel.fi_pagetable_va,
12039160SSherry.Moore@Sun.COM 			    newkernel.fi_pagetable_size);
12049160SSherry.Moore@Sun.COM 			newkernel.fi_pagetable_size = 0;
12059160SSherry.Moore@Sun.COM 		}
12069160SSherry.Moore@Sun.COM 
12079160SSherry.Moore@Sun.COM 		if (newkernel.fi_pagetable_size == 0) {
12089160SSherry.Moore@Sun.COM 			if ((newkernel.fi_pagetable_va = (uintptr_t)
12099160SSherry.Moore@Sun.COM 			    contig_alloc(size, &fastboot_below_1G_dma_attr,
12109160SSherry.Moore@Sun.COM 			    MMU_PAGESIZE, 0)) == NULL) {
12119160SSherry.Moore@Sun.COM 				cmn_err(CE_WARN, fastboot_enomem_msg,
12129160SSherry.Moore@Sun.COM 				    (uint64_t)size, "1G");
12139160SSherry.Moore@Sun.COM 				goto err_out;
12149160SSherry.Moore@Sun.COM 			}
12159160SSherry.Moore@Sun.COM 			/*
12169160SSherry.Moore@Sun.COM 			 * fi_pagetable_size must be set after the allocation
12179160SSherry.Moore@Sun.COM 			 * succeeds as it's used to determine how much memory to
12189160SSherry.Moore@Sun.COM 			 * free.
12199160SSherry.Moore@Sun.COM 			 */
12209160SSherry.Moore@Sun.COM 			newkernel.fi_pagetable_size = size;
12217656SSherry.Moore@Sun.COM 		}
12227656SSherry.Moore@Sun.COM 
12237656SSherry.Moore@Sun.COM 		bzero((void *)(newkernel.fi_pagetable_va), size);
12247656SSherry.Moore@Sun.COM 
12257656SSherry.Moore@Sun.COM 		newkernel.fi_pagetable_pa =
12267656SSherry.Moore@Sun.COM 		    mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
12277656SSherry.Moore@Sun.COM 		    (caddr_t)newkernel.fi_pagetable_va));
12287656SSherry.Moore@Sun.COM 
12297656SSherry.Moore@Sun.COM 		newkernel.fi_last_table_pa = newkernel.fi_pagetable_pa +
12308151SKonstantin.Ananyev@Sun.COM 		    size - MMU_PAGESIZE;
12317656SSherry.Moore@Sun.COM 
12327656SSherry.Moore@Sun.COM 		newkernel.fi_next_table_va = newkernel.fi_pagetable_va +
12337656SSherry.Moore@Sun.COM 		    MMU_PAGESIZE;
12347656SSherry.Moore@Sun.COM 		newkernel.fi_next_table_pa = newkernel.fi_pagetable_pa +
12357656SSherry.Moore@Sun.COM 		    MMU_PAGESIZE;
12367656SSherry.Moore@Sun.COM 
12377656SSherry.Moore@Sun.COM 		fastboot_build_pagetables(&newkernel);
12387656SSherry.Moore@Sun.COM 	}
12397656SSherry.Moore@Sun.COM 
12407656SSherry.Moore@Sun.COM 
12419160SSherry.Moore@Sun.COM 	/* Generate MD5 checksums */
12429160SSherry.Moore@Sun.COM 	fastboot_cksum_generate(&newkernel);
12439160SSherry.Moore@Sun.COM 
12447656SSherry.Moore@Sun.COM 	/* Mark it as valid */
12457656SSherry.Moore@Sun.COM 	newkernel.fi_valid = 1;
12467656SSherry.Moore@Sun.COM 	newkernel.fi_magic = FASTBOOT_MAGIC;
12477656SSherry.Moore@Sun.COM 
12489160SSherry.Moore@Sun.COM 	postbootkernelbase = saved_kernelbase;
12497656SSherry.Moore@Sun.COM 	return;
12507656SSherry.Moore@Sun.COM 
12517656SSherry.Moore@Sun.COM err_out:
12529160SSherry.Moore@Sun.COM 	postbootkernelbase = saved_kernelbase;
12537656SSherry.Moore@Sun.COM 	newkernel.fi_valid = 0;
12549160SSherry.Moore@Sun.COM 	fastboot_free_newkernel(&newkernel);
12559160SSherry.Moore@Sun.COM }
12569160SSherry.Moore@Sun.COM 
12579160SSherry.Moore@Sun.COM 
12589160SSherry.Moore@Sun.COM /* ARGSUSED */
12599160SSherry.Moore@Sun.COM static int
12609160SSherry.Moore@Sun.COM fastboot_xc_func(fastboot_info_t *nk, xc_arg_t unused2, xc_arg_t unused3)
12619160SSherry.Moore@Sun.COM {
12629160SSherry.Moore@Sun.COM 	void (*fastboot_func)(fastboot_info_t *);
12639160SSherry.Moore@Sun.COM 	fastboot_file_t	*fb = &nk->fi_files[FASTBOOT_SWTCH];
12649160SSherry.Moore@Sun.COM 	fastboot_func = (void (*)())(fb->fb_va);
12659160SSherry.Moore@Sun.COM 	kthread_t *t_intr = curthread->t_intr;
12669160SSherry.Moore@Sun.COM 
12679160SSherry.Moore@Sun.COM 	if (&kas != curproc->p_as) {
12689160SSherry.Moore@Sun.COM 		hat_devload(curproc->p_as->a_hat, (caddr_t)fb->fb_va,
12699160SSherry.Moore@Sun.COM 		    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
12709160SSherry.Moore@Sun.COM 		    PROT_READ | PROT_WRITE | PROT_EXEC,
12719160SSherry.Moore@Sun.COM 		    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
12729160SSherry.Moore@Sun.COM 	}
12739160SSherry.Moore@Sun.COM 
12749160SSherry.Moore@Sun.COM 	/*
12759160SSherry.Moore@Sun.COM 	 * If we have pinned a thread, make sure the address is mapped
12769160SSherry.Moore@Sun.COM 	 * in the address space of the pinned thread.
12779160SSherry.Moore@Sun.COM 	 */
12789160SSherry.Moore@Sun.COM 	if (t_intr && t_intr->t_procp->p_as->a_hat != curproc->p_as->a_hat &&
12799160SSherry.Moore@Sun.COM 	    t_intr->t_procp->p_as != &kas)
12809160SSherry.Moore@Sun.COM 		hat_devload(t_intr->t_procp->p_as->a_hat, (caddr_t)fb->fb_va,
12819160SSherry.Moore@Sun.COM 		    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
12829160SSherry.Moore@Sun.COM 		    PROT_READ | PROT_WRITE | PROT_EXEC,
12839160SSherry.Moore@Sun.COM 		    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
12849160SSherry.Moore@Sun.COM 
12859160SSherry.Moore@Sun.COM 	(*psm_shutdownf)(A_SHUTDOWN, AD_FASTREBOOT);
12869160SSherry.Moore@Sun.COM 	(*fastboot_func)(nk);
12879160SSherry.Moore@Sun.COM 
12889160SSherry.Moore@Sun.COM 	/*NOTREACHED*/
12899160SSherry.Moore@Sun.COM 	return (0);
12907656SSherry.Moore@Sun.COM }
12917656SSherry.Moore@Sun.COM 
12927750SSherry.Moore@Sun.COM /*
12937750SSherry.Moore@Sun.COM  * Jump to the fast reboot switcher.  This function never returns.
12947750SSherry.Moore@Sun.COM  */
12957656SSherry.Moore@Sun.COM void
12967656SSherry.Moore@Sun.COM fast_reboot()
12977656SSherry.Moore@Sun.COM {
12989160SSherry.Moore@Sun.COM 	processorid_t bootcpuid = 0;
12999160SSherry.Moore@Sun.COM 	extern uintptr_t postbootkernelbase;
13009160SSherry.Moore@Sun.COM 	extern char	fb_swtch_image[];
13019160SSherry.Moore@Sun.COM 	fastboot_file_t	*fb;
13029160SSherry.Moore@Sun.COM 	int i;
13039160SSherry.Moore@Sun.COM 
13049160SSherry.Moore@Sun.COM 	postbootkernelbase = 0;
13059160SSherry.Moore@Sun.COM 
13069160SSherry.Moore@Sun.COM 	fb = &newkernel.fi_files[FASTBOOT_SWTCH];
13079160SSherry.Moore@Sun.COM 
13089160SSherry.Moore@Sun.COM 	/*
13099160SSherry.Moore@Sun.COM 	 * Map the address into both the current proc's address
13109160SSherry.Moore@Sun.COM 	 * space and the kernel's address space in case the panic
13119160SSherry.Moore@Sun.COM 	 * is forced by kmdb.
13129160SSherry.Moore@Sun.COM 	 */
13139160SSherry.Moore@Sun.COM 	if (&kas != curproc->p_as) {
13149160SSherry.Moore@Sun.COM 		hat_devload(curproc->p_as->a_hat, (caddr_t)fb->fb_va,
13159160SSherry.Moore@Sun.COM 		    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
13169160SSherry.Moore@Sun.COM 		    PROT_READ | PROT_WRITE | PROT_EXEC,
13179160SSherry.Moore@Sun.COM 		    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
13189160SSherry.Moore@Sun.COM 	}
13199160SSherry.Moore@Sun.COM 
13209160SSherry.Moore@Sun.COM 	bcopy((void *)fb_swtch_image, (void *)fb->fb_va, fb->fb_size);
13219160SSherry.Moore@Sun.COM 
13229160SSherry.Moore@Sun.COM 
13239160SSherry.Moore@Sun.COM 	/*
13249160SSherry.Moore@Sun.COM 	 * Set fb_va to fake_va
13259160SSherry.Moore@Sun.COM 	 */
13269160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
13279160SSherry.Moore@Sun.COM 		newkernel.fi_files[i].fb_va = fake_va;
13289160SSherry.Moore@Sun.COM 
13299160SSherry.Moore@Sun.COM 	}
13309160SSherry.Moore@Sun.COM 
13319160SSherry.Moore@Sun.COM 	if (panicstr && CPU->cpu_id != bootcpuid &&
13329160SSherry.Moore@Sun.COM 	    CPU_ACTIVE(cpu_get(bootcpuid))) {
13339160SSherry.Moore@Sun.COM 		cpuset_t cpuset;
13349160SSherry.Moore@Sun.COM 
13359160SSherry.Moore@Sun.COM 		CPUSET_ZERO(cpuset);
13369160SSherry.Moore@Sun.COM 		CPUSET_ADD(cpuset, bootcpuid);
13379160SSherry.Moore@Sun.COM 		xc_trycall((xc_arg_t)&newkernel, 0, 0, cpuset,
13389160SSherry.Moore@Sun.COM 		    (xc_func_t)fastboot_xc_func);
13399160SSherry.Moore@Sun.COM 
13409160SSherry.Moore@Sun.COM 		/* Do what panic_idle() does */
13419160SSherry.Moore@Sun.COM 		splx(ipltospl(CLOCK_LEVEL));
13429160SSherry.Moore@Sun.COM 		(void) setjmp(&curthread->t_pcb);
13439160SSherry.Moore@Sun.COM 		for (;;)
13449160SSherry.Moore@Sun.COM 			;
13459160SSherry.Moore@Sun.COM 	} else
13469160SSherry.Moore@Sun.COM 		(void) fastboot_xc_func(&newkernel, 0, 0);
13479160SSherry.Moore@Sun.COM }
13489160SSherry.Moore@Sun.COM 
13499160SSherry.Moore@Sun.COM 
13509160SSherry.Moore@Sun.COM /*
13519160SSherry.Moore@Sun.COM  * Get boot property value for fastreboot_onpanic.
13529160SSherry.Moore@Sun.COM  *
13539160SSherry.Moore@Sun.COM  * NOTE: If fastreboot_onpanic is set to non-zero in /etc/system,
13549160SSherry.Moore@Sun.COM  * new setting passed in via "-B fastreboot_onpanic" is ignored.
13559160SSherry.Moore@Sun.COM  * This order of precedence is to enable developers debugging panics
13569160SSherry.Moore@Sun.COM  * that occur early in boot to utilize Fast Reboot on panic.
13579160SSherry.Moore@Sun.COM  */
13589160SSherry.Moore@Sun.COM static void
13599160SSherry.Moore@Sun.COM fastboot_get_bootprop(void)
13609160SSherry.Moore@Sun.COM {
13619160SSherry.Moore@Sun.COM 	int		val = 0xaa, len, ret;
13629160SSherry.Moore@Sun.COM 	dev_info_t	*devi;
13639160SSherry.Moore@Sun.COM 	char		*propstr = NULL;
13649160SSherry.Moore@Sun.COM 
13659160SSherry.Moore@Sun.COM 	devi = ddi_root_node();
13667656SSherry.Moore@Sun.COM 
13679160SSherry.Moore@Sun.COM 	ret = ddi_prop_lookup_string(DDI_DEV_T_ANY, devi, DDI_PROP_DONTPASS,
13689160SSherry.Moore@Sun.COM 	    FASTREBOOT_ONPANIC, &propstr);
13699160SSherry.Moore@Sun.COM 
13709160SSherry.Moore@Sun.COM 	if (ret == DDI_PROP_SUCCESS) {
13719160SSherry.Moore@Sun.COM 		if (FASTREBOOT_ONPANIC_NOTSET(propstr))
13729160SSherry.Moore@Sun.COM 			val = 0;
13739160SSherry.Moore@Sun.COM 		else if (FASTREBOOT_ONPANIC_ISSET(propstr))
13749160SSherry.Moore@Sun.COM 			val = UA_FASTREBOOT_ONPANIC;
13759160SSherry.Moore@Sun.COM 
13769160SSherry.Moore@Sun.COM 		/*
13779160SSherry.Moore@Sun.COM 		 * Only set fastreboot_onpanic to the value passed in
13789160SSherry.Moore@Sun.COM 		 * if it's not already set to non-zero, and the value
13799160SSherry.Moore@Sun.COM 		 * has indeed been passed in via command line.
13809160SSherry.Moore@Sun.COM 		 */
13819160SSherry.Moore@Sun.COM 		if (!fastreboot_onpanic && val != 0xaa)
13829160SSherry.Moore@Sun.COM 			fastreboot_onpanic = val;
13839160SSherry.Moore@Sun.COM 		ddi_prop_free(propstr);
13849160SSherry.Moore@Sun.COM 	} else if (ret != DDI_PROP_NOT_FOUND && ret != DDI_PROP_UNDEFINED) {
13859160SSherry.Moore@Sun.COM 		cmn_err(CE_WARN, "%s value is invalid, will be ignored",
13869160SSherry.Moore@Sun.COM 		    FASTREBOOT_ONPANIC);
13879160SSherry.Moore@Sun.COM 	}
13889160SSherry.Moore@Sun.COM 
13899160SSherry.Moore@Sun.COM 	len = sizeof (fastreboot_onpanic_cmdline);
13909160SSherry.Moore@Sun.COM 	ret = ddi_getlongprop_buf(DDI_DEV_T_ANY, devi, DDI_PROP_DONTPASS,
13919160SSherry.Moore@Sun.COM 	    FASTREBOOT_ONPANIC_CMDLINE, fastreboot_onpanic_cmdline, &len);
13929160SSherry.Moore@Sun.COM 
13939160SSherry.Moore@Sun.COM 	if (ret == DDI_PROP_BUF_TOO_SMALL)
13949160SSherry.Moore@Sun.COM 		cmn_err(CE_WARN, "%s value is too long, will be ignored",
13959160SSherry.Moore@Sun.COM 		    FASTREBOOT_ONPANIC_CMDLINE);
13967656SSherry.Moore@Sun.COM }
13979160SSherry.Moore@Sun.COM 
13989160SSherry.Moore@Sun.COM /*
13999160SSherry.Moore@Sun.COM  * This function is called by main() to either load the backup kernel for panic
14009160SSherry.Moore@Sun.COM  * fast reboot, or to reserve low physical memory for fast reboot.
14019160SSherry.Moore@Sun.COM  */
14029160SSherry.Moore@Sun.COM void
14039160SSherry.Moore@Sun.COM fastboot_post_startup()
14049160SSherry.Moore@Sun.COM {
14059160SSherry.Moore@Sun.COM 	if (!fastreboot_capable)
14069160SSherry.Moore@Sun.COM 		return;
14079160SSherry.Moore@Sun.COM 
14089160SSherry.Moore@Sun.COM 	fastboot_get_bootprop();
14099160SSherry.Moore@Sun.COM 
14109160SSherry.Moore@Sun.COM 	if (fastreboot_onpanic)
14119160SSherry.Moore@Sun.COM 		fastboot_load_kernel(fastreboot_onpanic_cmdline);
14129160SSherry.Moore@Sun.COM 	else if (reserve_mem_enabled)
14139160SSherry.Moore@Sun.COM 		fastboot_reserve_mem(&newkernel);
14149160SSherry.Moore@Sun.COM }
14159160SSherry.Moore@Sun.COM 
14169160SSherry.Moore@Sun.COM /*
14179160SSherry.Moore@Sun.COM  * Update boot configuration settings.
14189160SSherry.Moore@Sun.COM  * If the new fastreboot_onpanic setting is false, and a kernel has
14199160SSherry.Moore@Sun.COM  * been preloaded, free the memory;
14209160SSherry.Moore@Sun.COM  * if the new fastreboot_onpanic setting is true and newkernel is
14219160SSherry.Moore@Sun.COM  * not valid, load the new kernel.
14229160SSherry.Moore@Sun.COM  */
14239160SSherry.Moore@Sun.COM void
14249160SSherry.Moore@Sun.COM fastboot_update_config(const char *mdep)
14259160SSherry.Moore@Sun.COM {
14269160SSherry.Moore@Sun.COM 	uint8_t boot_config = (uint8_t)*mdep;
14279160SSherry.Moore@Sun.COM 	int cur_fastreboot_onpanic = fastreboot_onpanic;
14289160SSherry.Moore@Sun.COM 
14299160SSherry.Moore@Sun.COM 	if (!fastreboot_capable)
14309160SSherry.Moore@Sun.COM 		return;
14319160SSherry.Moore@Sun.COM 
14329160SSherry.Moore@Sun.COM 	fastreboot_onpanic = boot_config & UA_FASTREBOOT_ONPANIC;
14339160SSherry.Moore@Sun.COM 	if (fastreboot_onpanic && (!cur_fastreboot_onpanic ||
14349160SSherry.Moore@Sun.COM 	    !newkernel.fi_valid))
14359160SSherry.Moore@Sun.COM 		fastboot_load_kernel(fastreboot_onpanic_cmdline);
14369160SSherry.Moore@Sun.COM 	if (cur_fastreboot_onpanic && !fastreboot_onpanic)
14379160SSherry.Moore@Sun.COM 		fastboot_free_newkernel(&newkernel);
14389160SSherry.Moore@Sun.COM }
1439