xref: /onnv-gate/usr/src/uts/i86pc/os/fastboot.c (revision 10525:c8fd4dff34d8)
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];
192*10525SKonstantin.Ananyev@Sun.COM extern uint8_t saved_drives[FASTBOOT_SAVED_DRIVES_SIZE];
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 /*
4309219SKonstantin.Ananyev@Sun.COM  * Create multiboot info structure (mbi) base on the saved mbi.
4319219SKonstantin.Ananyev@Sun.COM  * Recalculate values of the pointer type fields in the data
4329219SKonstantin.Ananyev@Sun.COM  * structure based on the new starting physical address of the
4339219SKonstantin.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;
4399219SKonstantin.Ananyev@Sun.COM 	multiboot_info_t	*mbi;	/* pointer to multiboot structure */
4409219SKonstantin.Ananyev@Sun.COM 	uintptr_t	start_addr_va;	/* starting VA of mbi */
4419219SKonstantin.Ananyev@Sun.COM 	uintptr_t	start_addr_pa;	/* starting PA of mbi */
4429219SKonstantin.Ananyev@Sun.COM 	size_t		offs = 0;	/* offset from the starting address */
4439219SKonstantin.Ananyev@Sun.COM 	size_t		arglen;		/* length of the command line arg */
4449219SKonstantin.Ananyev@Sun.COM 	size_t		size;	/* size of the memory reserved for mbi */
4459219SKonstantin.Ananyev@Sun.COM 	size_t		mdnsz;	/* length of the boot archive name */
4467656SSherry.Moore@Sun.COM 
4479219SKonstantin.Ananyev@Sun.COM 	/*
4489219SKonstantin.Ananyev@Sun.COM 	 * If mdep is not NULL or empty, use the length of mdep + 1
4499219SKonstantin.Ananyev@Sun.COM 	 * (for NULL terminating) as the length of the new command
4509219SKonstantin.Ananyev@Sun.COM 	 * line; else use the saved command line length as the
4519219SKonstantin.Ananyev@Sun.COM 	 * length for the new command line.
4529219SKonstantin.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 
4599219SKonstantin.Ananyev@Sun.COM 	/*
4609219SKonstantin.Ananyev@Sun.COM 	 * Allocate memory for the new multiboot info structure (mbi).
4619219SKonstantin.Ananyev@Sun.COM 	 * If we have reserved memory for mbi but it's not enough,
4629219SKonstantin.Ananyev@Sun.COM 	 * free it and reallocate.
4639219SKonstantin.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 
4859219SKonstantin.Ananyev@Sun.COM 	/*
4869219SKonstantin.Ananyev@Sun.COM 	 * Initalize memory
4879219SKonstantin.Ananyev@Sun.COM 	 */
4889160SSherry.Moore@Sun.COM 	bzero((void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
4899160SSherry.Moore@Sun.COM 
4909219SKonstantin.Ananyev@Sun.COM 	/*
4919219SKonstantin.Ananyev@Sun.COM 	 * Get PA for the new mbi
4929219SKonstantin.Ananyev@Sun.COM 	 */
4939219SKonstantin.Ananyev@Sun.COM 	start_addr_va = nk->fi_new_mbi_va;
4949219SKonstantin.Ananyev@Sun.COM 	start_addr_pa = mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
4959219SKonstantin.Ananyev@Sun.COM 	    (caddr_t)start_addr_va));
4969219SKonstantin.Ananyev@Sun.COM 	nk->fi_new_mbi_pa = (paddr_t)start_addr_pa;
4977656SSherry.Moore@Sun.COM 
4989160SSherry.Moore@Sun.COM 	/*
4999219SKonstantin.Ananyev@Sun.COM 	 * Populate the rest of the fields in the data structure
5009160SSherry.Moore@Sun.COM 	 */
5019219SKonstantin.Ananyev@Sun.COM 
5029219SKonstantin.Ananyev@Sun.COM 	/*
5039219SKonstantin.Ananyev@Sun.COM 	 * Copy from the saved mbi to preserve all non-pointer type fields.
5049219SKonstantin.Ananyev@Sun.COM 	 */
5059219SKonstantin.Ananyev@Sun.COM 	mbi = (multiboot_info_t *)start_addr_va;
5069219SKonstantin.Ananyev@Sun.COM 	bcopy(&saved_mbi, mbi, sizeof (*mbi));
5077656SSherry.Moore@Sun.COM 
5089219SKonstantin.Ananyev@Sun.COM 	/*
5099219SKonstantin.Ananyev@Sun.COM 	 * Recalculate mods_addr.  Set mod_start and mod_end based on
5109219SKonstantin.Ananyev@Sun.COM 	 * the physical address of the new boot archive.  Set mod_name
5119219SKonstantin.Ananyev@Sun.COM 	 * to the name of the new boto archive.
5129219SKonstantin.Ananyev@Sun.COM 	 */
5139219SKonstantin.Ananyev@Sun.COM 	offs += sizeof (multiboot_info_t);
5149219SKonstantin.Ananyev@Sun.COM 	mbi->mods_addr = start_addr_pa + offs;
5159219SKonstantin.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 
5199219SKonstantin.Ananyev@Sun.COM 	offs += sizeof (mb_module_t);
5209219SKonstantin.Ananyev@Sun.COM 	mdnsz = strlen(fastboot_filename[FASTBOOT_NAME_BOOTARCHIVE]) + 1;
5219219SKonstantin.Ananyev@Sun.COM 	bcopy(fastboot_filename[FASTBOOT_NAME_BOOTARCHIVE],
5229219SKonstantin.Ananyev@Sun.COM 	    (void *)(start_addr_va + offs), mdnsz);
5239219SKonstantin.Ananyev@Sun.COM 	mbp->mod_name = start_addr_pa + offs;
5249219SKonstantin.Ananyev@Sun.COM 	mbp->reserved = 0;
5257656SSherry.Moore@Sun.COM 
5269219SKonstantin.Ananyev@Sun.COM 	/*
5279219SKonstantin.Ananyev@Sun.COM 	 * Make sure the offset is 16-byte aligned to avoid unaligned access.
5289219SKonstantin.Ananyev@Sun.COM 	 */
5299219SKonstantin.Ananyev@Sun.COM 	offs += mdnsz;
5309219SKonstantin.Ananyev@Sun.COM 	offs = P2ROUNDUP_TYPED(offs, 16, size_t);
5317656SSherry.Moore@Sun.COM 
5329219SKonstantin.Ananyev@Sun.COM 	/*
5339219SKonstantin.Ananyev@Sun.COM 	 * Recalculate mmap_addr
5349219SKonstantin.Ananyev@Sun.COM 	 */
5359219SKonstantin.Ananyev@Sun.COM 	mbi->mmap_addr = start_addr_pa + offs;
5369219SKonstantin.Ananyev@Sun.COM 	bcopy((void *)(uintptr_t)saved_mmap, (void *)(start_addr_va + offs),
5377656SSherry.Moore@Sun.COM 	    saved_mbi.mmap_length);
5389219SKonstantin.Ananyev@Sun.COM 	offs += saved_mbi.mmap_length;
5397656SSherry.Moore@Sun.COM 
5409219SKonstantin.Ananyev@Sun.COM 	/*
5419219SKonstantin.Ananyev@Sun.COM 	 * Recalculate drives_addr
5429219SKonstantin.Ananyev@Sun.COM 	 */
5439219SKonstantin.Ananyev@Sun.COM 	mbi->drives_addr = start_addr_pa + offs;
5449219SKonstantin.Ananyev@Sun.COM 	bcopy((void *)(uintptr_t)saved_drives, (void *)(start_addr_va + offs),
5457656SSherry.Moore@Sun.COM 	    saved_mbi.drives_length);
5469219SKonstantin.Ananyev@Sun.COM 	offs += saved_mbi.drives_length;
5477656SSherry.Moore@Sun.COM 
5489219SKonstantin.Ananyev@Sun.COM 	/*
5499219SKonstantin.Ananyev@Sun.COM 	 * Recalculate the address of cmdline.  Set cmdline to contain the
5509219SKonstantin.Ananyev@Sun.COM 	 * new boot argument.
5519219SKonstantin.Ananyev@Sun.COM 	 */
5529219SKonstantin.Ananyev@Sun.COM 	mbi->cmdline = start_addr_pa + offs;
5537656SSherry.Moore@Sun.COM 
5547750SSherry.Moore@Sun.COM 	if (mdep != NULL && strlen(mdep) != 0) {
5559219SKonstantin.Ananyev@Sun.COM 		bcopy(mdep, (void *)(start_addr_va + offs), arglen);
5567656SSherry.Moore@Sun.COM 	} else {
5579219SKonstantin.Ananyev@Sun.COM 		bcopy((void *)saved_cmdline, (void *)(start_addr_va + offs),
5589219SKonstantin.Ananyev@Sun.COM 		    arglen);
5597656SSherry.Moore@Sun.COM 	}
5607656SSherry.Moore@Sun.COM 
561*10525SKonstantin.Ananyev@Sun.COM 	/* clear fields and flags that are not copied */
562*10525SKonstantin.Ananyev@Sun.COM 	bzero(&mbi->config_table,
563*10525SKonstantin.Ananyev@Sun.COM 	    sizeof (*mbi) - offsetof(multiboot_info_t, config_table));
564*10525SKonstantin.Ananyev@Sun.COM 	mbi->flags &= ~(MB_INFO_CONFIG_TABLE | MB_INFO_BOOT_LOADER_NAME |
565*10525SKonstantin.Ananyev@Sun.COM 	    MB_INFO_APM_TABLE | MB_INFO_VIDEO_INFO);
566*10525SKonstantin.Ananyev@Sun.COM 
5677656SSherry.Moore@Sun.COM 	return (0);
5687656SSherry.Moore@Sun.COM }
5697656SSherry.Moore@Sun.COM 
5707750SSherry.Moore@Sun.COM /*
5717750SSherry.Moore@Sun.COM  * Initialize HAT related fields
5727750SSherry.Moore@Sun.COM  */
5737750SSherry.Moore@Sun.COM static void
5747750SSherry.Moore@Sun.COM fastboot_init_fields(fastboot_info_t *nk)
5757656SSherry.Moore@Sun.COM {
5767750SSherry.Moore@Sun.COM 	if (x86_feature & X86_PAE) {
5777750SSherry.Moore@Sun.COM 		nk->fi_has_pae = 1;
5787750SSherry.Moore@Sun.COM 		nk->fi_shift_amt = fastboot_shift_amt_pae;
5797750SSherry.Moore@Sun.COM 		nk->fi_ptes_per_table = 512;
5807750SSherry.Moore@Sun.COM 		nk->fi_lpagesize = (2 << 20);	/* 2M */
5818151SKonstantin.Ananyev@Sun.COM #ifdef	__amd64
5828151SKonstantin.Ananyev@Sun.COM 		nk->fi_top_level = 3;
5838151SKonstantin.Ananyev@Sun.COM #else
5847750SSherry.Moore@Sun.COM 		nk->fi_top_level = 2;
5858151SKonstantin.Ananyev@Sun.COM #endif	/* __amd64 */
5867750SSherry.Moore@Sun.COM 	}
5877750SSherry.Moore@Sun.COM }
5887656SSherry.Moore@Sun.COM 
5897750SSherry.Moore@Sun.COM /*
5907750SSherry.Moore@Sun.COM  * Process boot argument
5917750SSherry.Moore@Sun.COM  */
5927750SSherry.Moore@Sun.COM static void
5937750SSherry.Moore@Sun.COM fastboot_parse_mdep(char *mdep, char *kern_bootpath, int *bootpath_len,
5947750SSherry.Moore@Sun.COM     char *bootargs)
5957750SSherry.Moore@Sun.COM {
5967750SSherry.Moore@Sun.COM 	int	i;
5977656SSherry.Moore@Sun.COM 
5987656SSherry.Moore@Sun.COM 	/*
5997656SSherry.Moore@Sun.COM 	 * If mdep is not NULL, it comes in the format of
6007656SSherry.Moore@Sun.COM 	 *	mountpoint unix args
6017656SSherry.Moore@Sun.COM 	 */
6027750SSherry.Moore@Sun.COM 	if (mdep != NULL && strlen(mdep) != 0) {
6037656SSherry.Moore@Sun.COM 		if (mdep[0] != '-') {
6047656SSherry.Moore@Sun.COM 			/* First get the root argument */
6057656SSherry.Moore@Sun.COM 			i = 0;
6067656SSherry.Moore@Sun.COM 			while (mdep[i] != '\0' && mdep[i] != ' ') {
6077656SSherry.Moore@Sun.COM 				i++;
6087656SSherry.Moore@Sun.COM 			}
6097656SSherry.Moore@Sun.COM 
6107656SSherry.Moore@Sun.COM 			if (i < 4 || strncmp(&mdep[i-4], "unix", 4) != 0) {
6117656SSherry.Moore@Sun.COM 				/* mount point */
6127656SSherry.Moore@Sun.COM 				bcopy(mdep, kern_bootpath, i);
6137656SSherry.Moore@Sun.COM 				kern_bootpath[i] = '\0';
6147750SSherry.Moore@Sun.COM 				*bootpath_len = i;
6157656SSherry.Moore@Sun.COM 
6167656SSherry.Moore@Sun.COM 				/*
6177656SSherry.Moore@Sun.COM 				 * Get the next argument. It should be unix as
6187656SSherry.Moore@Sun.COM 				 * we have validated in in halt.c.
6197656SSherry.Moore@Sun.COM 				 */
6207656SSherry.Moore@Sun.COM 				if (strlen(mdep) > i) {
6217656SSherry.Moore@Sun.COM 					mdep += (i + 1);
6227656SSherry.Moore@Sun.COM 					i = 0;
6237656SSherry.Moore@Sun.COM 					while (mdep[i] != '\0' &&
6247656SSherry.Moore@Sun.COM 					    mdep[i] != ' ') {
6257656SSherry.Moore@Sun.COM 						i++;
6267656SSherry.Moore@Sun.COM 					}
6277656SSherry.Moore@Sun.COM 				}
6287656SSherry.Moore@Sun.COM 
6297656SSherry.Moore@Sun.COM 			}
6307656SSherry.Moore@Sun.COM 			bcopy(mdep, kern_bootfile, i);
6317656SSherry.Moore@Sun.COM 			kern_bootfile[i] = '\0';
6327750SSherry.Moore@Sun.COM 			bcopy(mdep, bootargs, strlen(mdep));
6337656SSherry.Moore@Sun.COM 		} else {
6347656SSherry.Moore@Sun.COM 			int off = strlen(kern_bootfile);
6357656SSherry.Moore@Sun.COM 			bcopy(kern_bootfile, bootargs, off);
6367656SSherry.Moore@Sun.COM 			bcopy(" ", &bootargs[off++], 1);
6377656SSherry.Moore@Sun.COM 			bcopy(mdep, &bootargs[off], strlen(mdep));
6387656SSherry.Moore@Sun.COM 			off += strlen(mdep);
6397656SSherry.Moore@Sun.COM 			bootargs[off] = '\0';
6407656SSherry.Moore@Sun.COM 		}
6417656SSherry.Moore@Sun.COM 	}
6427750SSherry.Moore@Sun.COM }
6437750SSherry.Moore@Sun.COM 
6447750SSherry.Moore@Sun.COM /*
6459160SSherry.Moore@Sun.COM  * Reserve memory under PA 1G for mapping the new kernel and boot archive.
6469160SSherry.Moore@Sun.COM  * This function is only called if fastreboot_onpanic is *not* set.
6479160SSherry.Moore@Sun.COM  */
6489160SSherry.Moore@Sun.COM static void
6499160SSherry.Moore@Sun.COM fastboot_reserve_mem(fastboot_info_t *nk)
6509160SSherry.Moore@Sun.COM {
6519160SSherry.Moore@Sun.COM 	int i;
6529160SSherry.Moore@Sun.COM 
6539160SSherry.Moore@Sun.COM 	/*
6549160SSherry.Moore@Sun.COM 	 * A valid kernel is in place.  No need to reserve any memory.
6559160SSherry.Moore@Sun.COM 	 */
6569160SSherry.Moore@Sun.COM 	if (nk->fi_valid)
6579160SSherry.Moore@Sun.COM 		return;
6589160SSherry.Moore@Sun.COM 
6599160SSherry.Moore@Sun.COM 	/*
6609160SSherry.Moore@Sun.COM 	 * Reserve memory under PA 1G for PTE lists.
6619160SSherry.Moore@Sun.COM 	 */
6629160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
6639160SSherry.Moore@Sun.COM 		fastboot_file_t *fb = &nk->fi_files[i];
6649160SSherry.Moore@Sun.COM 		size_t fsize_roundup, size;
6659160SSherry.Moore@Sun.COM 
6669160SSherry.Moore@Sun.COM 		fsize_roundup = P2ROUNDUP_TYPED(saved_file_size[i],
6679160SSherry.Moore@Sun.COM 		    PAGESIZE, size_t);
6689160SSherry.Moore@Sun.COM 		size = FASTBOOT_PTE_LIST_SIZE(fsize_roundup);
6699160SSherry.Moore@Sun.COM 		if ((fb->fb_pte_list_va = contig_alloc(size,
6709160SSherry.Moore@Sun.COM 		    &fastboot_below_1G_dma_attr, PAGESIZE, 0)) == NULL) {
6719160SSherry.Moore@Sun.COM 			return;
6729160SSherry.Moore@Sun.COM 		}
6739160SSherry.Moore@Sun.COM 		fb->fb_pte_list_size = size;
6749160SSherry.Moore@Sun.COM 	}
6759160SSherry.Moore@Sun.COM 
6769160SSherry.Moore@Sun.COM 	/*
6779160SSherry.Moore@Sun.COM 	 * Reserve memory under PA 1G for page tables.
6789160SSherry.Moore@Sun.COM 	 */
6799160SSherry.Moore@Sun.COM 	if ((nk->fi_pagetable_va =
6809160SSherry.Moore@Sun.COM 	    (uintptr_t)contig_alloc(fastboot_pagetable_size,
6819160SSherry.Moore@Sun.COM 	    &fastboot_below_1G_dma_attr, PAGESIZE, 0)) == NULL) {
6829160SSherry.Moore@Sun.COM 		return;
6839160SSherry.Moore@Sun.COM 	}
6849160SSherry.Moore@Sun.COM 	nk->fi_pagetable_size = fastboot_pagetable_size;
6859160SSherry.Moore@Sun.COM 
6869160SSherry.Moore@Sun.COM 	/*
6879160SSherry.Moore@Sun.COM 	 * Reserve memory under PA 1G for multiboot structure.
6889160SSherry.Moore@Sun.COM 	 */
6899160SSherry.Moore@Sun.COM 	if ((nk->fi_new_mbi_va = (uintptr_t)contig_alloc(fastboot_mbi_size,
6909160SSherry.Moore@Sun.COM 	    &fastboot_below_1G_dma_attr, PAGESIZE, 0)) == NULL) {
6919160SSherry.Moore@Sun.COM 		return;
6929160SSherry.Moore@Sun.COM 	}
6939160SSherry.Moore@Sun.COM 	nk->fi_mbi_size = fastboot_mbi_size;
6949160SSherry.Moore@Sun.COM }
6959160SSherry.Moore@Sun.COM 
6969160SSherry.Moore@Sun.COM /*
6979160SSherry.Moore@Sun.COM  * Calculate MD5 digest for the given fastboot_file.
6989160SSherry.Moore@Sun.COM  * Assumes that the file is allready loaded properly.
6999160SSherry.Moore@Sun.COM  */
7009160SSherry.Moore@Sun.COM static void
7019160SSherry.Moore@Sun.COM fastboot_cksum_file(fastboot_file_t *fb, uchar_t *md5_hash)
7029160SSherry.Moore@Sun.COM {
7039160SSherry.Moore@Sun.COM 	MD5_CTX md5_ctx;
7049160SSherry.Moore@Sun.COM 
7059160SSherry.Moore@Sun.COM 	MD5Init(&md5_ctx);
7069160SSherry.Moore@Sun.COM 	MD5Update(&md5_ctx, (void *)fb->fb_va, fb->fb_size);
7079160SSherry.Moore@Sun.COM 	MD5Final(md5_hash, &md5_ctx);
7089160SSherry.Moore@Sun.COM }
7099160SSherry.Moore@Sun.COM 
7109160SSherry.Moore@Sun.COM /*
7119160SSherry.Moore@Sun.COM  * Free up the memory we have allocated for a file
7127750SSherry.Moore@Sun.COM  */
7137750SSherry.Moore@Sun.COM static void
7147750SSherry.Moore@Sun.COM fastboot_free_file(fastboot_file_t *fb)
7157750SSherry.Moore@Sun.COM {
7169160SSherry.Moore@Sun.COM 	size_t	fsize_roundup;
7177750SSherry.Moore@Sun.COM 
7187750SSherry.Moore@Sun.COM 	fsize_roundup = P2ROUNDUP_TYPED(fb->fb_size, PAGESIZE, size_t);
7199160SSherry.Moore@Sun.COM 	if (fsize_roundup) {
7209160SSherry.Moore@Sun.COM 		contig_free((void *)fb->fb_va, fsize_roundup);
7219160SSherry.Moore@Sun.COM 		fb->fb_va = NULL;
7229160SSherry.Moore@Sun.COM 		fb->fb_size = 0;
7239160SSherry.Moore@Sun.COM 	}
7249160SSherry.Moore@Sun.COM }
7259160SSherry.Moore@Sun.COM 
7269160SSherry.Moore@Sun.COM /*
7279160SSherry.Moore@Sun.COM  * Free up memory used by the PTEs for a file.
7289160SSherry.Moore@Sun.COM  */
7299160SSherry.Moore@Sun.COM static void
7309160SSherry.Moore@Sun.COM fastboot_free_file_pte(fastboot_file_t *fb, uint64_t endaddr)
7319160SSherry.Moore@Sun.COM {
7329160SSherry.Moore@Sun.COM 	if (fb->fb_pte_list_size && fb->fb_pte_list_pa < endaddr) {
7339160SSherry.Moore@Sun.COM 		contig_free((void *)fb->fb_pte_list_va, fb->fb_pte_list_size);
7349160SSherry.Moore@Sun.COM 		fb->fb_pte_list_va = 0;
7359160SSherry.Moore@Sun.COM 		fb->fb_pte_list_pa = 0;
7369160SSherry.Moore@Sun.COM 		fb->fb_pte_list_size = 0;
7379160SSherry.Moore@Sun.COM 	}
7389160SSherry.Moore@Sun.COM }
7399160SSherry.Moore@Sun.COM 
7409160SSherry.Moore@Sun.COM /*
7419160SSherry.Moore@Sun.COM  * Free up all the memory used for representing a kernel with
7429160SSherry.Moore@Sun.COM  * fastboot_info_t.
7439160SSherry.Moore@Sun.COM  */
7449160SSherry.Moore@Sun.COM static void
7459160SSherry.Moore@Sun.COM fastboot_free_mem(fastboot_info_t *nk, uint64_t endaddr)
7469160SSherry.Moore@Sun.COM {
7479160SSherry.Moore@Sun.COM 	int i;
7489160SSherry.Moore@Sun.COM 
7499160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
7509160SSherry.Moore@Sun.COM 		fastboot_free_file(nk->fi_files + i);
7519160SSherry.Moore@Sun.COM 		fastboot_free_file_pte(nk->fi_files + i, endaddr);
7529160SSherry.Moore@Sun.COM 	}
7539160SSherry.Moore@Sun.COM 
7549160SSherry.Moore@Sun.COM 	if (nk->fi_pagetable_size && nk->fi_pagetable_pa < endaddr) {
7559160SSherry.Moore@Sun.COM 		contig_free((void *)nk->fi_pagetable_va, nk->fi_pagetable_size);
7569160SSherry.Moore@Sun.COM 		nk->fi_pagetable_va = 0;
7579160SSherry.Moore@Sun.COM 		nk->fi_pagetable_pa = 0;
7589160SSherry.Moore@Sun.COM 		nk->fi_pagetable_size = 0;
7599160SSherry.Moore@Sun.COM 	}
7609160SSherry.Moore@Sun.COM 
7619160SSherry.Moore@Sun.COM 	if (nk->fi_mbi_size && nk->fi_new_mbi_pa < endaddr) {
7629160SSherry.Moore@Sun.COM 		contig_free((void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
7639160SSherry.Moore@Sun.COM 		nk->fi_new_mbi_va = 0;
7649160SSherry.Moore@Sun.COM 		nk->fi_new_mbi_pa = 0;
7659160SSherry.Moore@Sun.COM 		nk->fi_mbi_size = 0;
7669160SSherry.Moore@Sun.COM 	}
7679160SSherry.Moore@Sun.COM }
7689160SSherry.Moore@Sun.COM 
7699160SSherry.Moore@Sun.COM /*
7709160SSherry.Moore@Sun.COM  * Only free up the memory allocated for the kernel and boot archive,
7719160SSherry.Moore@Sun.COM  * but not for the page tables.
7729160SSherry.Moore@Sun.COM  */
7739160SSherry.Moore@Sun.COM void
7749160SSherry.Moore@Sun.COM fastboot_free_newkernel(fastboot_info_t *nk)
7759160SSherry.Moore@Sun.COM {
7769160SSherry.Moore@Sun.COM 	int i;
7777750SSherry.Moore@Sun.COM 
7789160SSherry.Moore@Sun.COM 	nk->fi_valid = 0;
7799160SSherry.Moore@Sun.COM 	/*
7809160SSherry.Moore@Sun.COM 	 * Free the memory we have allocated
7819160SSherry.Moore@Sun.COM 	 */
7829160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
7839160SSherry.Moore@Sun.COM 		fastboot_free_file(&(nk->fi_files[i]));
7849160SSherry.Moore@Sun.COM 	}
7859160SSherry.Moore@Sun.COM }
7869160SSherry.Moore@Sun.COM 
7879160SSherry.Moore@Sun.COM static void
7889160SSherry.Moore@Sun.COM fastboot_cksum_cdata(fastboot_info_t *nk, uchar_t *md5_hash)
7899160SSherry.Moore@Sun.COM {
7909160SSherry.Moore@Sun.COM 	int i;
7919160SSherry.Moore@Sun.COM 	MD5_CTX md5_ctx;
7929160SSherry.Moore@Sun.COM 
7939160SSherry.Moore@Sun.COM 	MD5Init(&md5_ctx);
7949160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
7959160SSherry.Moore@Sun.COM 		MD5Update(&md5_ctx, nk->fi_files[i].fb_pte_list_va,
7969160SSherry.Moore@Sun.COM 		    nk->fi_files[i].fb_pte_list_size);
7979160SSherry.Moore@Sun.COM 	}
7989160SSherry.Moore@Sun.COM 	MD5Update(&md5_ctx, (void *)nk->fi_pagetable_va, nk->fi_pagetable_size);
7999160SSherry.Moore@Sun.COM 	MD5Update(&md5_ctx, (void *)nk->fi_new_mbi_va, nk->fi_mbi_size);
8009160SSherry.Moore@Sun.COM 
8019160SSherry.Moore@Sun.COM 	MD5Final(md5_hash, &md5_ctx);
8029160SSherry.Moore@Sun.COM }
8039160SSherry.Moore@Sun.COM 
8049160SSherry.Moore@Sun.COM /*
8059160SSherry.Moore@Sun.COM  * Generate MD5 checksum of the given kernel.
8069160SSherry.Moore@Sun.COM  */
8079160SSherry.Moore@Sun.COM static void
8089160SSherry.Moore@Sun.COM fastboot_cksum_generate(fastboot_info_t *nk)
8099160SSherry.Moore@Sun.COM {
8109160SSherry.Moore@Sun.COM 	int i;
8119160SSherry.Moore@Sun.COM 
8129160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
8139160SSherry.Moore@Sun.COM 		fastboot_cksum_file(nk->fi_files + i, nk->fi_md5_hash[i]);
8149160SSherry.Moore@Sun.COM 	}
8159160SSherry.Moore@Sun.COM 	fastboot_cksum_cdata(nk, nk->fi_md5_hash[i]);
8169160SSherry.Moore@Sun.COM }
8179160SSherry.Moore@Sun.COM 
8189160SSherry.Moore@Sun.COM /*
8199160SSherry.Moore@Sun.COM  * Calculate MD5 checksum of the given kernel and verify that
8209160SSherry.Moore@Sun.COM  * it matches with what was calculated before.
8219160SSherry.Moore@Sun.COM  */
8229160SSherry.Moore@Sun.COM int
8239160SSherry.Moore@Sun.COM fastboot_cksum_verify(fastboot_info_t *nk)
8249160SSherry.Moore@Sun.COM {
8259160SSherry.Moore@Sun.COM 	int i;
8269160SSherry.Moore@Sun.COM 	uchar_t md5_hash[MD5_DIGEST_LENGTH];
8279160SSherry.Moore@Sun.COM 
8289160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
8299160SSherry.Moore@Sun.COM 		fastboot_cksum_file(nk->fi_files + i, 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 
8359160SSherry.Moore@Sun.COM 	fastboot_cksum_cdata(nk, md5_hash);
8369160SSherry.Moore@Sun.COM 	if (bcmp(nk->fi_md5_hash[i], md5_hash,
8379160SSherry.Moore@Sun.COM 	    sizeof (nk->fi_md5_hash[i])) != 0)
8389160SSherry.Moore@Sun.COM 		return (i + 1);
8399160SSherry.Moore@Sun.COM 
8409160SSherry.Moore@Sun.COM 	return (0);
8417750SSherry.Moore@Sun.COM }
8427750SSherry.Moore@Sun.COM 
8437750SSherry.Moore@Sun.COM /*
8447750SSherry.Moore@Sun.COM  * This function performs the following tasks:
8457750SSherry.Moore@Sun.COM  * - Read the sizes of the new kernel and boot archive.
8467750SSherry.Moore@Sun.COM  * - Allocate memory for the new kernel and boot archive.
8477750SSherry.Moore@Sun.COM  * - Allocate memory for page tables necessary for mapping the memory
8487750SSherry.Moore@Sun.COM  *   allocated for the files.
8497750SSherry.Moore@Sun.COM  * - Read the new kernel and boot archive into memory.
8507750SSherry.Moore@Sun.COM  * - Map in the fast reboot switcher.
8517750SSherry.Moore@Sun.COM  * - Load the fast reboot switcher to FASTBOOT_SWTCH_PA.
8527750SSherry.Moore@Sun.COM  * - Build the new multiboot_info structure
8537750SSherry.Moore@Sun.COM  * - Build page tables for the low 1G of physical memory.
8547750SSherry.Moore@Sun.COM  * - Mark the data structure as valid if all steps have succeeded.
8557750SSherry.Moore@Sun.COM  */
8567750SSherry.Moore@Sun.COM void
8579160SSherry.Moore@Sun.COM fastboot_load_kernel(char *mdep)
8587750SSherry.Moore@Sun.COM {
8597750SSherry.Moore@Sun.COM 	void		*buf = NULL;
8607750SSherry.Moore@Sun.COM 	int		i;
8617750SSherry.Moore@Sun.COM 	fastboot_file_t	*fb;
8627750SSherry.Moore@Sun.COM 	uint32_t	dboot_start_offset;
8637750SSherry.Moore@Sun.COM 	char		kern_bootpath[OBP_MAXPATHLEN];
8647750SSherry.Moore@Sun.COM 	extern uintptr_t postbootkernelbase;
8659160SSherry.Moore@Sun.COM 	uintptr_t	saved_kernelbase;
8667750SSherry.Moore@Sun.COM 	int		bootpath_len = 0;
8677750SSherry.Moore@Sun.COM 	int		is_failsafe = 0;
8687750SSherry.Moore@Sun.COM 	int		is_retry = 0;
8697750SSherry.Moore@Sun.COM 	uint64_t	end_addr;
8707750SSherry.Moore@Sun.COM 
8717750SSherry.Moore@Sun.COM 	ASSERT(fastreboot_capable);
8727750SSherry.Moore@Sun.COM 
8739160SSherry.Moore@Sun.COM 	if (newkernel.fi_valid)
8749160SSherry.Moore@Sun.COM 		fastboot_free_newkernel(&newkernel);
8759160SSherry.Moore@Sun.COM 
8769160SSherry.Moore@Sun.COM 	saved_kernelbase = postbootkernelbase;
8779160SSherry.Moore@Sun.COM 
8787750SSherry.Moore@Sun.COM 	postbootkernelbase = 0;
8797750SSherry.Moore@Sun.COM 
8807750SSherry.Moore@Sun.COM 	/*
8817750SSherry.Moore@Sun.COM 	 * Initialize various HAT related fields in the data structure
8827750SSherry.Moore@Sun.COM 	 */
8837750SSherry.Moore@Sun.COM 	fastboot_init_fields(&newkernel);
8847750SSherry.Moore@Sun.COM 
8857750SSherry.Moore@Sun.COM 	bzero(kern_bootpath, OBP_MAXPATHLEN);
8867750SSherry.Moore@Sun.COM 
8877750SSherry.Moore@Sun.COM 	/*
8887750SSherry.Moore@Sun.COM 	 * Process the boot argument
8897750SSherry.Moore@Sun.COM 	 */
8909160SSherry.Moore@Sun.COM 	bzero(fastboot_args, OBP_MAXPATHLEN);
8919160SSherry.Moore@Sun.COM 	fastboot_parse_mdep(mdep, kern_bootpath, &bootpath_len, fastboot_args);
8927656SSherry.Moore@Sun.COM 
8937656SSherry.Moore@Sun.COM 	/*
8947656SSherry.Moore@Sun.COM 	 * Make sure we get the null character
8957656SSherry.Moore@Sun.COM 	 */
8967656SSherry.Moore@Sun.COM 	bcopy(kern_bootpath, fastboot_filename[FASTBOOT_NAME_UNIX],
8977656SSherry.Moore@Sun.COM 	    bootpath_len);
8987656SSherry.Moore@Sun.COM 	bcopy(kern_bootfile,
8997656SSherry.Moore@Sun.COM 	    &fastboot_filename[FASTBOOT_NAME_UNIX][bootpath_len],
9007656SSherry.Moore@Sun.COM 	    strlen(kern_bootfile) + 1);
9017656SSherry.Moore@Sun.COM 
9027656SSherry.Moore@Sun.COM 	bcopy(kern_bootpath, fastboot_filename[FASTBOOT_NAME_BOOTARCHIVE],
9037656SSherry.Moore@Sun.COM 	    bootpath_len);
9047656SSherry.Moore@Sun.COM 
9059160SSherry.Moore@Sun.COM 	if (bcmp(kern_bootfile, FAILSAFE_BOOTFILE32,
9069160SSherry.Moore@Sun.COM 	    (sizeof (FAILSAFE_BOOTFILE32) - 1)) == 0 ||
9079160SSherry.Moore@Sun.COM 	    bcmp(kern_bootfile, FAILSAFE_BOOTFILE64,
9089160SSherry.Moore@Sun.COM 	    (sizeof (FAILSAFE_BOOTFILE64) - 1)) == 0) {
9097656SSherry.Moore@Sun.COM 		is_failsafe = 1;
9107656SSherry.Moore@Sun.COM 	}
9117656SSherry.Moore@Sun.COM 
9127750SSherry.Moore@Sun.COM load_kernel_retry:
9137656SSherry.Moore@Sun.COM 	/*
9147656SSherry.Moore@Sun.COM 	 * Read in unix and boot_archive
9157656SSherry.Moore@Sun.COM 	 */
9167750SSherry.Moore@Sun.COM 	end_addr = DBOOT_ENTRY_ADDRESS;
9177656SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
9187750SSherry.Moore@Sun.COM 		struct _buf	*file;
9197750SSherry.Moore@Sun.COM 		uintptr_t	va;
9207750SSherry.Moore@Sun.COM 		uint64_t	fsize;
9217750SSherry.Moore@Sun.COM 		size_t		fsize_roundup, pt_size;
9227750SSherry.Moore@Sun.COM 		int		page_index;
9237750SSherry.Moore@Sun.COM 		uintptr_t	offset;
9247656SSherry.Moore@Sun.COM 		ddi_dma_attr_t dma_attr = fastboot_dma_attr;
9257656SSherry.Moore@Sun.COM 
9267750SSherry.Moore@Sun.COM 
9277656SSherry.Moore@Sun.COM 		dprintf("fastboot_filename[%d] = %s\n",
9287656SSherry.Moore@Sun.COM 		    i, fastboot_filename[i]);
9297656SSherry.Moore@Sun.COM 
9307656SSherry.Moore@Sun.COM 		if ((file = kobj_open_file(fastboot_filename[i])) ==
9317656SSherry.Moore@Sun.COM 		    (struct _buf *)-1) {
9327656SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, "Fastboot: Couldn't open %s",
9337656SSherry.Moore@Sun.COM 			    fastboot_filename[i]);
9347656SSherry.Moore@Sun.COM 			goto err_out;
9357656SSherry.Moore@Sun.COM 		}
9367656SSherry.Moore@Sun.COM 
9377656SSherry.Moore@Sun.COM 		if (kobj_get_filesize(file, &fsize) != 0) {
9387656SSherry.Moore@Sun.COM 			cmn_err(CE_WARN,
9397656SSherry.Moore@Sun.COM 			    "Fastboot: Couldn't get filesize for %s",
9407656SSherry.Moore@Sun.COM 			    fastboot_filename[i]);
9417656SSherry.Moore@Sun.COM 			goto err_out;
9427656SSherry.Moore@Sun.COM 		}
9437656SSherry.Moore@Sun.COM 
9447750SSherry.Moore@Sun.COM 		fsize_roundup = P2ROUNDUP_TYPED(fsize, PAGESIZE, size_t);
9457750SSherry.Moore@Sun.COM 
9467750SSherry.Moore@Sun.COM 		/*
9477750SSherry.Moore@Sun.COM 		 * Where the files end in physical memory after being
9487750SSherry.Moore@Sun.COM 		 * relocated by the fast boot switcher.
9497750SSherry.Moore@Sun.COM 		 */
9507750SSherry.Moore@Sun.COM 		end_addr += fsize_roundup;
9517750SSherry.Moore@Sun.COM 		if (end_addr > fastboot_below_1G_dma_attr.dma_attr_addr_hi) {
9527750SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, "Fastboot: boot archive is too big");
9537750SSherry.Moore@Sun.COM 			goto err_out;
9547656SSherry.Moore@Sun.COM 		}
9557656SSherry.Moore@Sun.COM 
9567750SSherry.Moore@Sun.COM 		/*
9577750SSherry.Moore@Sun.COM 		 * Adjust dma_attr_addr_lo so that the new kernel and boot
9587750SSherry.Moore@Sun.COM 		 * archive will not be overridden during relocation.
9597750SSherry.Moore@Sun.COM 		 */
9607750SSherry.Moore@Sun.COM 		if (end_addr > fastboot_dma_attr.dma_attr_addr_lo ||
9617750SSherry.Moore@Sun.COM 		    end_addr > fastboot_below_1G_dma_attr.dma_attr_addr_lo) {
9627750SSherry.Moore@Sun.COM 
9637750SSherry.Moore@Sun.COM 			if (is_retry) {
9647750SSherry.Moore@Sun.COM 				/*
9657750SSherry.Moore@Sun.COM 				 * If we have already tried and didn't succeed,
9667750SSherry.Moore@Sun.COM 				 * just give up.
9677750SSherry.Moore@Sun.COM 				 */
9687750SSherry.Moore@Sun.COM 				cmn_err(CE_WARN,
9697750SSherry.Moore@Sun.COM 				    "Fastboot: boot archive is too big");
9707750SSherry.Moore@Sun.COM 				goto err_out;
9717750SSherry.Moore@Sun.COM 			} else {
9727750SSherry.Moore@Sun.COM 				/* Set the flag so we don't keep retrying */
9737750SSherry.Moore@Sun.COM 				is_retry++;
9747750SSherry.Moore@Sun.COM 
9757750SSherry.Moore@Sun.COM 				/* Adjust dma_attr_addr_lo */
9767750SSherry.Moore@Sun.COM 				fastboot_dma_attr.dma_attr_addr_lo = end_addr;
9777750SSherry.Moore@Sun.COM 				fastboot_below_1G_dma_attr.dma_attr_addr_lo =
9787750SSherry.Moore@Sun.COM 				    end_addr;
9797750SSherry.Moore@Sun.COM 
9807750SSherry.Moore@Sun.COM 				/*
9817750SSherry.Moore@Sun.COM 				 * Free the memory we have already allocated
9827750SSherry.Moore@Sun.COM 				 * whose physical addresses might not fit
9837750SSherry.Moore@Sun.COM 				 * the new lo and hi constraints.
9847750SSherry.Moore@Sun.COM 				 */
9859160SSherry.Moore@Sun.COM 				fastboot_free_mem(&newkernel, end_addr);
9867750SSherry.Moore@Sun.COM 				goto load_kernel_retry;
9877750SSherry.Moore@Sun.COM 			}
9887750SSherry.Moore@Sun.COM 		}
9897750SSherry.Moore@Sun.COM 
9907750SSherry.Moore@Sun.COM 
9917656SSherry.Moore@Sun.COM 		if (!fastboot_contig)
9927656SSherry.Moore@Sun.COM 			dma_attr.dma_attr_sgllen = (fsize / PAGESIZE) +
9937656SSherry.Moore@Sun.COM 			    (((fsize % PAGESIZE) == 0) ? 0 : 1);
9947656SSherry.Moore@Sun.COM 
9957656SSherry.Moore@Sun.COM 		if ((buf = contig_alloc(fsize, &dma_attr, PAGESIZE, 0))
9967656SSherry.Moore@Sun.COM 		    == NULL) {
9977750SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, fastboot_enomem_msg, fsize, "64G");
9987656SSherry.Moore@Sun.COM 			goto err_out;
9997656SSherry.Moore@Sun.COM 		}
10007656SSherry.Moore@Sun.COM 
10017656SSherry.Moore@Sun.COM 		va = P2ROUNDUP_TYPED((uintptr_t)buf, PAGESIZE, uintptr_t);
10027656SSherry.Moore@Sun.COM 
10037656SSherry.Moore@Sun.COM 		if (kobj_read_file(file, (char *)va, fsize, 0) < 0) {
10047656SSherry.Moore@Sun.COM 			cmn_err(CE_WARN, "Fastboot: Couldn't read %s",
10057656SSherry.Moore@Sun.COM 			    fastboot_filename[i]);
10067656SSherry.Moore@Sun.COM 			goto err_out;
10077656SSherry.Moore@Sun.COM 		}
10087656SSherry.Moore@Sun.COM 
10097656SSherry.Moore@Sun.COM 		fb = &newkernel.fi_files[i];
10107656SSherry.Moore@Sun.COM 		fb->fb_va = va;
10117656SSherry.Moore@Sun.COM 		fb->fb_size = fsize;
10127656SSherry.Moore@Sun.COM 		fb->fb_sectcnt = 0;
10137656SSherry.Moore@Sun.COM 
10149160SSherry.Moore@Sun.COM 		pt_size = FASTBOOT_PTE_LIST_SIZE(fsize_roundup);
10157656SSherry.Moore@Sun.COM 
10169160SSherry.Moore@Sun.COM 		/*
10179160SSherry.Moore@Sun.COM 		 * If we have reserved memory but it not enough, free it.
10189160SSherry.Moore@Sun.COM 		 */
10199160SSherry.Moore@Sun.COM 		if (fb->fb_pte_list_size && fb->fb_pte_list_size < pt_size) {
10209160SSherry.Moore@Sun.COM 			contig_free((void *)fb->fb_pte_list_va,
10219160SSherry.Moore@Sun.COM 			    fb->fb_pte_list_size);
10229160SSherry.Moore@Sun.COM 			fb->fb_pte_list_size = 0;
10237656SSherry.Moore@Sun.COM 		}
10247656SSherry.Moore@Sun.COM 
10259160SSherry.Moore@Sun.COM 		if (fb->fb_pte_list_size == 0) {
10269160SSherry.Moore@Sun.COM 			if ((fb->fb_pte_list_va =
10279160SSherry.Moore@Sun.COM 			    (x86pte_t *)contig_alloc(pt_size,
10289160SSherry.Moore@Sun.COM 			    &fastboot_below_1G_dma_attr, PAGESIZE, 0))
10299160SSherry.Moore@Sun.COM 			    == NULL) {
10309160SSherry.Moore@Sun.COM 				cmn_err(CE_WARN, fastboot_enomem_msg,
10319160SSherry.Moore@Sun.COM 				    (uint64_t)pt_size, "1G");
10329160SSherry.Moore@Sun.COM 				goto err_out;
10339160SSherry.Moore@Sun.COM 			}
10349160SSherry.Moore@Sun.COM 			/*
10359160SSherry.Moore@Sun.COM 			 * fb_pte_list_size must be set after the allocation
10369160SSherry.Moore@Sun.COM 			 * succeeds as it's used to determine how much memory to
10379160SSherry.Moore@Sun.COM 			 * free.
10389160SSherry.Moore@Sun.COM 			 */
10399160SSherry.Moore@Sun.COM 			fb->fb_pte_list_size = pt_size;
10409160SSherry.Moore@Sun.COM 		}
10419160SSherry.Moore@Sun.COM 
10429160SSherry.Moore@Sun.COM 		bzero((void *)(fb->fb_pte_list_va), fb->fb_pte_list_size);
10437656SSherry.Moore@Sun.COM 
10447656SSherry.Moore@Sun.COM 		fb->fb_pte_list_pa = mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
10457656SSherry.Moore@Sun.COM 		    (caddr_t)fb->fb_pte_list_va));
10467656SSherry.Moore@Sun.COM 
10477656SSherry.Moore@Sun.COM 		for (page_index = 0, offset = 0; offset < fb->fb_size;
10487656SSherry.Moore@Sun.COM 		    offset += PAGESIZE) {
10497656SSherry.Moore@Sun.COM 			uint64_t paddr;
10507656SSherry.Moore@Sun.COM 
10517656SSherry.Moore@Sun.COM 			paddr = mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
10527656SSherry.Moore@Sun.COM 			    (caddr_t)fb->fb_va + offset));
10537656SSherry.Moore@Sun.COM 
10547656SSherry.Moore@Sun.COM 			ASSERT(paddr >= fastboot_dma_attr.dma_attr_addr_lo);
10557656SSherry.Moore@Sun.COM 
10567656SSherry.Moore@Sun.COM 			/*
10577656SSherry.Moore@Sun.COM 			 * Include the pte_bits so we don't have to make
10587656SSherry.Moore@Sun.COM 			 * it in assembly.
10597656SSherry.Moore@Sun.COM 			 */
10607656SSherry.Moore@Sun.COM 			fb->fb_pte_list_va[page_index++] = (x86pte_t)
10617656SSherry.Moore@Sun.COM 			    (paddr | pte_bits);
10627656SSherry.Moore@Sun.COM 		}
10637656SSherry.Moore@Sun.COM 
10647656SSherry.Moore@Sun.COM 		fb->fb_pte_list_va[page_index] = FASTBOOT_TERMINATE;
10657656SSherry.Moore@Sun.COM 
10667656SSherry.Moore@Sun.COM 		if (i == FASTBOOT_UNIX) {
10677750SSherry.Moore@Sun.COM 			Ehdr	*ehdr = (Ehdr *)va;
10687750SSherry.Moore@Sun.COM 			int	j;
10697656SSherry.Moore@Sun.COM 
10707656SSherry.Moore@Sun.COM 			/*
10717656SSherry.Moore@Sun.COM 			 * Sanity checks:
10727656SSherry.Moore@Sun.COM 			 */
10737656SSherry.Moore@Sun.COM 			for (j = 0; j < SELFMAG; j++) {
10747656SSherry.Moore@Sun.COM 				if (ehdr->e_ident[j] != ELFMAG[j]) {
10757656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: Bad ELF "
10767656SSherry.Moore@Sun.COM 					    "signature");
10777656SSherry.Moore@Sun.COM 					goto err_out;
10787656SSherry.Moore@Sun.COM 				}
10797656SSherry.Moore@Sun.COM 			}
10807656SSherry.Moore@Sun.COM 
10817656SSherry.Moore@Sun.COM 			if (ehdr->e_ident[EI_CLASS] == ELFCLASS32 &&
10827656SSherry.Moore@Sun.COM 			    ehdr->e_ident[EI_DATA] == ELFDATA2LSB &&
10837656SSherry.Moore@Sun.COM 			    ehdr->e_machine == EM_386) {
10847656SSherry.Moore@Sun.COM 
10858151SKonstantin.Ananyev@Sun.COM 				fb->fb_sectcnt = sizeof (fb->fb_sections) /
10868151SKonstantin.Ananyev@Sun.COM 				    sizeof (fb->fb_sections[0]);
10878151SKonstantin.Ananyev@Sun.COM 
10887656SSherry.Moore@Sun.COM 				if (fastboot_elf32_find_loadables((void *)va,
10897656SSherry.Moore@Sun.COM 				    fsize, &fb->fb_sections[0],
10907656SSherry.Moore@Sun.COM 				    &fb->fb_sectcnt, &dboot_start_offset) < 0) {
10917656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: ELF32 "
10927656SSherry.Moore@Sun.COM 					    "program section failure");
10937656SSherry.Moore@Sun.COM 					goto err_out;
10947656SSherry.Moore@Sun.COM 				}
10957656SSherry.Moore@Sun.COM 
10967656SSherry.Moore@Sun.COM 				if (fb->fb_sectcnt == 0) {
10977656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: No ELF32 "
10987656SSherry.Moore@Sun.COM 					    "program sections found");
10997656SSherry.Moore@Sun.COM 					goto err_out;
11007656SSherry.Moore@Sun.COM 				}
11017656SSherry.Moore@Sun.COM 
11027656SSherry.Moore@Sun.COM 				if (is_failsafe) {
11037656SSherry.Moore@Sun.COM 					/* Failsafe boot_archive */
11049160SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE32_FAILSAFE,
11057656SSherry.Moore@Sun.COM 					    &fastboot_filename
11067656SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11077656SSherry.Moore@Sun.COM 					    [bootpath_len],
11089160SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE32_FAILSAFE));
11097656SSherry.Moore@Sun.COM 				} else {
11107656SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE32,
11117656SSherry.Moore@Sun.COM 					    &fastboot_filename
11127656SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11137656SSherry.Moore@Sun.COM 					    [bootpath_len],
11147656SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE32));
11157656SSherry.Moore@Sun.COM 				}
11167656SSherry.Moore@Sun.COM 
11177656SSherry.Moore@Sun.COM 			} else if (ehdr->e_ident[EI_CLASS] == ELFCLASS64 &&
11187656SSherry.Moore@Sun.COM 			    ehdr->e_ident[EI_DATA] == ELFDATA2LSB &&
11197656SSherry.Moore@Sun.COM 			    ehdr->e_machine == EM_AMD64) {
11207656SSherry.Moore@Sun.COM 
11217656SSherry.Moore@Sun.COM 				if (fastboot_elf64_find_dboot_load_offset(
11227656SSherry.Moore@Sun.COM 				    (void *)va, fsize, &dboot_start_offset)
11237656SSherry.Moore@Sun.COM 				    != 0) {
11247656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: Couldn't "
11257656SSherry.Moore@Sun.COM 					    "find ELF64 dboot entry offset");
11267656SSherry.Moore@Sun.COM 					goto err_out;
11277656SSherry.Moore@Sun.COM 				}
11287656SSherry.Moore@Sun.COM 
11297656SSherry.Moore@Sun.COM 				if ((x86_feature & X86_64) == 0 ||
11308151SKonstantin.Ananyev@Sun.COM 				    (x86_feature & X86_PAE) == 0) {
11317656SSherry.Moore@Sun.COM 					cmn_err(CE_WARN, "Fastboot: Cannot "
11327656SSherry.Moore@Sun.COM 					    "reboot to %s: "
11337656SSherry.Moore@Sun.COM 					    "not a 64-bit capable system",
11347656SSherry.Moore@Sun.COM 					    kern_bootfile);
11357656SSherry.Moore@Sun.COM 					goto err_out;
11367656SSherry.Moore@Sun.COM 				}
11377656SSherry.Moore@Sun.COM 
11389160SSherry.Moore@Sun.COM 				if (is_failsafe) {
11399160SSherry.Moore@Sun.COM 					/* Failsafe boot_archive */
11409160SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE64_FAILSAFE,
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_FAILSAFE));
11459160SSherry.Moore@Sun.COM 				} else {
11469160SSherry.Moore@Sun.COM 					bcopy(BOOTARCHIVE64,
11479160SSherry.Moore@Sun.COM 					    &fastboot_filename
11489160SSherry.Moore@Sun.COM 					    [FASTBOOT_NAME_BOOTARCHIVE]
11499160SSherry.Moore@Sun.COM 					    [bootpath_len],
11509160SSherry.Moore@Sun.COM 					    sizeof (BOOTARCHIVE64));
11519160SSherry.Moore@Sun.COM 				}
11527656SSherry.Moore@Sun.COM 			} else {
11537656SSherry.Moore@Sun.COM 				cmn_err(CE_WARN, "Fastboot: Unknown ELF type");
11547656SSherry.Moore@Sun.COM 				goto err_out;
11557656SSherry.Moore@Sun.COM 			}
11567656SSherry.Moore@Sun.COM 
11577656SSherry.Moore@Sun.COM 			fb->fb_dest_pa = DBOOT_ENTRY_ADDRESS -
11587656SSherry.Moore@Sun.COM 			    dboot_start_offset;
11597656SSherry.Moore@Sun.COM 
11607656SSherry.Moore@Sun.COM 			fb->fb_next_pa = DBOOT_ENTRY_ADDRESS + fsize_roundup;
11617656SSherry.Moore@Sun.COM 		} else {
11627656SSherry.Moore@Sun.COM 			fb->fb_dest_pa = newkernel.fi_files[i - 1].fb_next_pa;
11637656SSherry.Moore@Sun.COM 			fb->fb_next_pa = fb->fb_dest_pa + fsize_roundup;
11647656SSherry.Moore@Sun.COM 		}
11657656SSherry.Moore@Sun.COM 
11667656SSherry.Moore@Sun.COM 		kobj_close_file(file);
11677656SSherry.Moore@Sun.COM 
11687656SSherry.Moore@Sun.COM 	}
11697656SSherry.Moore@Sun.COM 
11707750SSherry.Moore@Sun.COM 	/*
11717656SSherry.Moore@Sun.COM 	 * Add the function that will switch us to 32-bit protected mode
11727656SSherry.Moore@Sun.COM 	 */
11737656SSherry.Moore@Sun.COM 	fb = &newkernel.fi_files[FASTBOOT_SWTCH];
11747656SSherry.Moore@Sun.COM 	fb->fb_va = fb->fb_dest_pa = FASTBOOT_SWTCH_PA;
11758151SKonstantin.Ananyev@Sun.COM 	fb->fb_size = MMU_PAGESIZE;
11767656SSherry.Moore@Sun.COM 
11779160SSherry.Moore@Sun.COM 	hat_devload(kas.a_hat, (caddr_t)fb->fb_va,
11789160SSherry.Moore@Sun.COM 	    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
11799160SSherry.Moore@Sun.COM 	    PROT_READ | PROT_WRITE | PROT_EXEC,
11809160SSherry.Moore@Sun.COM 	    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
11817656SSherry.Moore@Sun.COM 
11827656SSherry.Moore@Sun.COM 	/*
11837656SSherry.Moore@Sun.COM 	 * Build the new multiboot_info structure
11847656SSherry.Moore@Sun.COM 	 */
11859160SSherry.Moore@Sun.COM 	if (fastboot_build_mbi(fastboot_args, &newkernel) != 0) {
11867656SSherry.Moore@Sun.COM 		goto err_out;
11877656SSherry.Moore@Sun.COM 	}
11887656SSherry.Moore@Sun.COM 
11897656SSherry.Moore@Sun.COM 	/*
11907656SSherry.Moore@Sun.COM 	 * Build page table for low 1G physical memory. Use big pages.
11918151SKonstantin.Ananyev@Sun.COM 	 * Allocate 4 (5 for amd64) pages for the page tables.
11928151SKonstantin.Ananyev@Sun.COM 	 *    1 page for PML4 (amd64)
11937656SSherry.Moore@Sun.COM 	 *    1 page for Page-Directory-Pointer Table
11948151SKonstantin.Ananyev@Sun.COM 	 *    2 pages for Page Directory
11957656SSherry.Moore@Sun.COM 	 *    1 page for Page Table.
11967656SSherry.Moore@Sun.COM 	 * The page table entry will be rewritten to map the physical
11977656SSherry.Moore@Sun.COM 	 * address as we do the copying.
11987656SSherry.Moore@Sun.COM 	 */
11997656SSherry.Moore@Sun.COM 	if (newkernel.fi_has_pae) {
12008151SKonstantin.Ananyev@Sun.COM #ifdef	__amd64
12018151SKonstantin.Ananyev@Sun.COM 		size_t size = MMU_PAGESIZE * 5;
12028151SKonstantin.Ananyev@Sun.COM #else
12037656SSherry.Moore@Sun.COM 		size_t size = MMU_PAGESIZE * 4;
12048151SKonstantin.Ananyev@Sun.COM #endif	/* __amd64 */
12057656SSherry.Moore@Sun.COM 
12069160SSherry.Moore@Sun.COM 		if (newkernel.fi_pagetable_size && newkernel.fi_pagetable_size
12079160SSherry.Moore@Sun.COM 		    < size) {
12089160SSherry.Moore@Sun.COM 			contig_free((void *)newkernel.fi_pagetable_va,
12099160SSherry.Moore@Sun.COM 			    newkernel.fi_pagetable_size);
12109160SSherry.Moore@Sun.COM 			newkernel.fi_pagetable_size = 0;
12119160SSherry.Moore@Sun.COM 		}
12129160SSherry.Moore@Sun.COM 
12139160SSherry.Moore@Sun.COM 		if (newkernel.fi_pagetable_size == 0) {
12149160SSherry.Moore@Sun.COM 			if ((newkernel.fi_pagetable_va = (uintptr_t)
12159160SSherry.Moore@Sun.COM 			    contig_alloc(size, &fastboot_below_1G_dma_attr,
12169160SSherry.Moore@Sun.COM 			    MMU_PAGESIZE, 0)) == NULL) {
12179160SSherry.Moore@Sun.COM 				cmn_err(CE_WARN, fastboot_enomem_msg,
12189160SSherry.Moore@Sun.COM 				    (uint64_t)size, "1G");
12199160SSherry.Moore@Sun.COM 				goto err_out;
12209160SSherry.Moore@Sun.COM 			}
12219160SSherry.Moore@Sun.COM 			/*
12229160SSherry.Moore@Sun.COM 			 * fi_pagetable_size must be set after the allocation
12239160SSherry.Moore@Sun.COM 			 * succeeds as it's used to determine how much memory to
12249160SSherry.Moore@Sun.COM 			 * free.
12259160SSherry.Moore@Sun.COM 			 */
12269160SSherry.Moore@Sun.COM 			newkernel.fi_pagetable_size = size;
12277656SSherry.Moore@Sun.COM 		}
12287656SSherry.Moore@Sun.COM 
12297656SSherry.Moore@Sun.COM 		bzero((void *)(newkernel.fi_pagetable_va), size);
12307656SSherry.Moore@Sun.COM 
12317656SSherry.Moore@Sun.COM 		newkernel.fi_pagetable_pa =
12327656SSherry.Moore@Sun.COM 		    mmu_ptob((uint64_t)hat_getpfnum(kas.a_hat,
12337656SSherry.Moore@Sun.COM 		    (caddr_t)newkernel.fi_pagetable_va));
12347656SSherry.Moore@Sun.COM 
12357656SSherry.Moore@Sun.COM 		newkernel.fi_last_table_pa = newkernel.fi_pagetable_pa +
12368151SKonstantin.Ananyev@Sun.COM 		    size - MMU_PAGESIZE;
12377656SSherry.Moore@Sun.COM 
12387656SSherry.Moore@Sun.COM 		newkernel.fi_next_table_va = newkernel.fi_pagetable_va +
12397656SSherry.Moore@Sun.COM 		    MMU_PAGESIZE;
12407656SSherry.Moore@Sun.COM 		newkernel.fi_next_table_pa = newkernel.fi_pagetable_pa +
12417656SSherry.Moore@Sun.COM 		    MMU_PAGESIZE;
12427656SSherry.Moore@Sun.COM 
12437656SSherry.Moore@Sun.COM 		fastboot_build_pagetables(&newkernel);
12447656SSherry.Moore@Sun.COM 	}
12457656SSherry.Moore@Sun.COM 
12467656SSherry.Moore@Sun.COM 
12479160SSherry.Moore@Sun.COM 	/* Generate MD5 checksums */
12489160SSherry.Moore@Sun.COM 	fastboot_cksum_generate(&newkernel);
12499160SSherry.Moore@Sun.COM 
12507656SSherry.Moore@Sun.COM 	/* Mark it as valid */
12517656SSherry.Moore@Sun.COM 	newkernel.fi_valid = 1;
12527656SSherry.Moore@Sun.COM 	newkernel.fi_magic = FASTBOOT_MAGIC;
12537656SSherry.Moore@Sun.COM 
12549160SSherry.Moore@Sun.COM 	postbootkernelbase = saved_kernelbase;
12557656SSherry.Moore@Sun.COM 	return;
12567656SSherry.Moore@Sun.COM 
12577656SSherry.Moore@Sun.COM err_out:
12589160SSherry.Moore@Sun.COM 	postbootkernelbase = saved_kernelbase;
12597656SSherry.Moore@Sun.COM 	newkernel.fi_valid = 0;
12609160SSherry.Moore@Sun.COM 	fastboot_free_newkernel(&newkernel);
12619160SSherry.Moore@Sun.COM }
12629160SSherry.Moore@Sun.COM 
12639160SSherry.Moore@Sun.COM 
12649160SSherry.Moore@Sun.COM /* ARGSUSED */
12659160SSherry.Moore@Sun.COM static int
12669160SSherry.Moore@Sun.COM fastboot_xc_func(fastboot_info_t *nk, xc_arg_t unused2, xc_arg_t unused3)
12679160SSherry.Moore@Sun.COM {
12689160SSherry.Moore@Sun.COM 	void (*fastboot_func)(fastboot_info_t *);
12699160SSherry.Moore@Sun.COM 	fastboot_file_t	*fb = &nk->fi_files[FASTBOOT_SWTCH];
12709160SSherry.Moore@Sun.COM 	fastboot_func = (void (*)())(fb->fb_va);
12719160SSherry.Moore@Sun.COM 	kthread_t *t_intr = curthread->t_intr;
12729160SSherry.Moore@Sun.COM 
12739160SSherry.Moore@Sun.COM 	if (&kas != curproc->p_as) {
12749160SSherry.Moore@Sun.COM 		hat_devload(curproc->p_as->a_hat, (caddr_t)fb->fb_va,
12759160SSherry.Moore@Sun.COM 		    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
12769160SSherry.Moore@Sun.COM 		    PROT_READ | PROT_WRITE | PROT_EXEC,
12779160SSherry.Moore@Sun.COM 		    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
12789160SSherry.Moore@Sun.COM 	}
12799160SSherry.Moore@Sun.COM 
12809160SSherry.Moore@Sun.COM 	/*
12819160SSherry.Moore@Sun.COM 	 * If we have pinned a thread, make sure the address is mapped
12829160SSherry.Moore@Sun.COM 	 * in the address space of the pinned thread.
12839160SSherry.Moore@Sun.COM 	 */
12849160SSherry.Moore@Sun.COM 	if (t_intr && t_intr->t_procp->p_as->a_hat != curproc->p_as->a_hat &&
12859160SSherry.Moore@Sun.COM 	    t_intr->t_procp->p_as != &kas)
12869160SSherry.Moore@Sun.COM 		hat_devload(t_intr->t_procp->p_as->a_hat, (caddr_t)fb->fb_va,
12879160SSherry.Moore@Sun.COM 		    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
12889160SSherry.Moore@Sun.COM 		    PROT_READ | PROT_WRITE | PROT_EXEC,
12899160SSherry.Moore@Sun.COM 		    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
12909160SSherry.Moore@Sun.COM 
12919160SSherry.Moore@Sun.COM 	(*psm_shutdownf)(A_SHUTDOWN, AD_FASTREBOOT);
12929160SSherry.Moore@Sun.COM 	(*fastboot_func)(nk);
12939160SSherry.Moore@Sun.COM 
12949160SSherry.Moore@Sun.COM 	/*NOTREACHED*/
12959160SSherry.Moore@Sun.COM 	return (0);
12967656SSherry.Moore@Sun.COM }
12977656SSherry.Moore@Sun.COM 
12987750SSherry.Moore@Sun.COM /*
12997750SSherry.Moore@Sun.COM  * Jump to the fast reboot switcher.  This function never returns.
13007750SSherry.Moore@Sun.COM  */
13017656SSherry.Moore@Sun.COM void
13027656SSherry.Moore@Sun.COM fast_reboot()
13037656SSherry.Moore@Sun.COM {
13049160SSherry.Moore@Sun.COM 	processorid_t bootcpuid = 0;
13059160SSherry.Moore@Sun.COM 	extern uintptr_t postbootkernelbase;
13069160SSherry.Moore@Sun.COM 	extern char	fb_swtch_image[];
13079160SSherry.Moore@Sun.COM 	fastboot_file_t	*fb;
13089160SSherry.Moore@Sun.COM 	int i;
13099160SSherry.Moore@Sun.COM 
13109160SSherry.Moore@Sun.COM 	postbootkernelbase = 0;
13119160SSherry.Moore@Sun.COM 
13129160SSherry.Moore@Sun.COM 	fb = &newkernel.fi_files[FASTBOOT_SWTCH];
13139160SSherry.Moore@Sun.COM 
13149160SSherry.Moore@Sun.COM 	/*
13159160SSherry.Moore@Sun.COM 	 * Map the address into both the current proc's address
13169160SSherry.Moore@Sun.COM 	 * space and the kernel's address space in case the panic
13179160SSherry.Moore@Sun.COM 	 * is forced by kmdb.
13189160SSherry.Moore@Sun.COM 	 */
13199160SSherry.Moore@Sun.COM 	if (&kas != curproc->p_as) {
13209160SSherry.Moore@Sun.COM 		hat_devload(curproc->p_as->a_hat, (caddr_t)fb->fb_va,
13219160SSherry.Moore@Sun.COM 		    MMU_PAGESIZE, mmu_btop(fb->fb_dest_pa),
13229160SSherry.Moore@Sun.COM 		    PROT_READ | PROT_WRITE | PROT_EXEC,
13239160SSherry.Moore@Sun.COM 		    HAT_LOAD_NOCONSIST | HAT_LOAD_LOCK);
13249160SSherry.Moore@Sun.COM 	}
13259160SSherry.Moore@Sun.COM 
13269160SSherry.Moore@Sun.COM 	bcopy((void *)fb_swtch_image, (void *)fb->fb_va, fb->fb_size);
13279160SSherry.Moore@Sun.COM 
13289160SSherry.Moore@Sun.COM 
13299160SSherry.Moore@Sun.COM 	/*
13309160SSherry.Moore@Sun.COM 	 * Set fb_va to fake_va
13319160SSherry.Moore@Sun.COM 	 */
13329160SSherry.Moore@Sun.COM 	for (i = 0; i < FASTBOOT_MAX_FILES_MAP; i++) {
13339160SSherry.Moore@Sun.COM 		newkernel.fi_files[i].fb_va = fake_va;
13349160SSherry.Moore@Sun.COM 
13359160SSherry.Moore@Sun.COM 	}
13369160SSherry.Moore@Sun.COM 
13379160SSherry.Moore@Sun.COM 	if (panicstr && CPU->cpu_id != bootcpuid &&
13389160SSherry.Moore@Sun.COM 	    CPU_ACTIVE(cpu_get(bootcpuid))) {
13399489SJoe.Bonasera@sun.com 		extern void panic_idle(void);
13409160SSherry.Moore@Sun.COM 		cpuset_t cpuset;
13419160SSherry.Moore@Sun.COM 
13429160SSherry.Moore@Sun.COM 		CPUSET_ZERO(cpuset);
13439160SSherry.Moore@Sun.COM 		CPUSET_ADD(cpuset, bootcpuid);
13449489SJoe.Bonasera@sun.com 		xc_priority((xc_arg_t)&newkernel, 0, 0, CPUSET2BV(cpuset),
13459160SSherry.Moore@Sun.COM 		    (xc_func_t)fastboot_xc_func);
13469160SSherry.Moore@Sun.COM 
13479489SJoe.Bonasera@sun.com 		panic_idle();
13489160SSherry.Moore@Sun.COM 	} else
13499160SSherry.Moore@Sun.COM 		(void) fastboot_xc_func(&newkernel, 0, 0);
13509160SSherry.Moore@Sun.COM }
13519160SSherry.Moore@Sun.COM 
13529160SSherry.Moore@Sun.COM 
13539160SSherry.Moore@Sun.COM /*
13549160SSherry.Moore@Sun.COM  * Get boot property value for fastreboot_onpanic.
13559160SSherry.Moore@Sun.COM  *
13569160SSherry.Moore@Sun.COM  * NOTE: If fastreboot_onpanic is set to non-zero in /etc/system,
13579160SSherry.Moore@Sun.COM  * new setting passed in via "-B fastreboot_onpanic" is ignored.
13589160SSherry.Moore@Sun.COM  * This order of precedence is to enable developers debugging panics
13599160SSherry.Moore@Sun.COM  * that occur early in boot to utilize Fast Reboot on panic.
13609160SSherry.Moore@Sun.COM  */
13619160SSherry.Moore@Sun.COM static void
13629160SSherry.Moore@Sun.COM fastboot_get_bootprop(void)
13639160SSherry.Moore@Sun.COM {
13649160SSherry.Moore@Sun.COM 	int		val = 0xaa, len, ret;
13659160SSherry.Moore@Sun.COM 	dev_info_t	*devi;
13669160SSherry.Moore@Sun.COM 	char		*propstr = NULL;
13679160SSherry.Moore@Sun.COM 
13689160SSherry.Moore@Sun.COM 	devi = ddi_root_node();
13697656SSherry.Moore@Sun.COM 
13709160SSherry.Moore@Sun.COM 	ret = ddi_prop_lookup_string(DDI_DEV_T_ANY, devi, DDI_PROP_DONTPASS,
13719160SSherry.Moore@Sun.COM 	    FASTREBOOT_ONPANIC, &propstr);
13729160SSherry.Moore@Sun.COM 
13739160SSherry.Moore@Sun.COM 	if (ret == DDI_PROP_SUCCESS) {
13749160SSherry.Moore@Sun.COM 		if (FASTREBOOT_ONPANIC_NOTSET(propstr))
13759160SSherry.Moore@Sun.COM 			val = 0;
13769160SSherry.Moore@Sun.COM 		else if (FASTREBOOT_ONPANIC_ISSET(propstr))
13779160SSherry.Moore@Sun.COM 			val = UA_FASTREBOOT_ONPANIC;
13789160SSherry.Moore@Sun.COM 
13799160SSherry.Moore@Sun.COM 		/*
13809160SSherry.Moore@Sun.COM 		 * Only set fastreboot_onpanic to the value passed in
13819160SSherry.Moore@Sun.COM 		 * if it's not already set to non-zero, and the value
13829160SSherry.Moore@Sun.COM 		 * has indeed been passed in via command line.
13839160SSherry.Moore@Sun.COM 		 */
13849160SSherry.Moore@Sun.COM 		if (!fastreboot_onpanic && val != 0xaa)
13859160SSherry.Moore@Sun.COM 			fastreboot_onpanic = val;
13869160SSherry.Moore@Sun.COM 		ddi_prop_free(propstr);
13879160SSherry.Moore@Sun.COM 	} else if (ret != DDI_PROP_NOT_FOUND && ret != DDI_PROP_UNDEFINED) {
13889160SSherry.Moore@Sun.COM 		cmn_err(CE_WARN, "%s value is invalid, will be ignored",
13899160SSherry.Moore@Sun.COM 		    FASTREBOOT_ONPANIC);
13909160SSherry.Moore@Sun.COM 	}
13919160SSherry.Moore@Sun.COM 
13929160SSherry.Moore@Sun.COM 	len = sizeof (fastreboot_onpanic_cmdline);
13939160SSherry.Moore@Sun.COM 	ret = ddi_getlongprop_buf(DDI_DEV_T_ANY, devi, DDI_PROP_DONTPASS,
13949160SSherry.Moore@Sun.COM 	    FASTREBOOT_ONPANIC_CMDLINE, fastreboot_onpanic_cmdline, &len);
13959160SSherry.Moore@Sun.COM 
13969160SSherry.Moore@Sun.COM 	if (ret == DDI_PROP_BUF_TOO_SMALL)
13979160SSherry.Moore@Sun.COM 		cmn_err(CE_WARN, "%s value is too long, will be ignored",
13989160SSherry.Moore@Sun.COM 		    FASTREBOOT_ONPANIC_CMDLINE);
13997656SSherry.Moore@Sun.COM }
14009160SSherry.Moore@Sun.COM 
14019160SSherry.Moore@Sun.COM /*
14029160SSherry.Moore@Sun.COM  * This function is called by main() to either load the backup kernel for panic
14039160SSherry.Moore@Sun.COM  * fast reboot, or to reserve low physical memory for fast reboot.
14049160SSherry.Moore@Sun.COM  */
14059160SSherry.Moore@Sun.COM void
14069160SSherry.Moore@Sun.COM fastboot_post_startup()
14079160SSherry.Moore@Sun.COM {
14089160SSherry.Moore@Sun.COM 	if (!fastreboot_capable)
14099160SSherry.Moore@Sun.COM 		return;
14109160SSherry.Moore@Sun.COM 
14119160SSherry.Moore@Sun.COM 	fastboot_get_bootprop();
14129160SSherry.Moore@Sun.COM 
14139160SSherry.Moore@Sun.COM 	if (fastreboot_onpanic)
14149160SSherry.Moore@Sun.COM 		fastboot_load_kernel(fastreboot_onpanic_cmdline);
14159160SSherry.Moore@Sun.COM 	else if (reserve_mem_enabled)
14169160SSherry.Moore@Sun.COM 		fastboot_reserve_mem(&newkernel);
14179160SSherry.Moore@Sun.COM }
14189160SSherry.Moore@Sun.COM 
14199160SSherry.Moore@Sun.COM /*
14209160SSherry.Moore@Sun.COM  * Update boot configuration settings.
14219160SSherry.Moore@Sun.COM  * If the new fastreboot_onpanic setting is false, and a kernel has
14229160SSherry.Moore@Sun.COM  * been preloaded, free the memory;
14239160SSherry.Moore@Sun.COM  * if the new fastreboot_onpanic setting is true and newkernel is
14249160SSherry.Moore@Sun.COM  * not valid, load the new kernel.
14259160SSherry.Moore@Sun.COM  */
14269160SSherry.Moore@Sun.COM void
14279160SSherry.Moore@Sun.COM fastboot_update_config(const char *mdep)
14289160SSherry.Moore@Sun.COM {
14299160SSherry.Moore@Sun.COM 	uint8_t boot_config = (uint8_t)*mdep;
14309160SSherry.Moore@Sun.COM 	int cur_fastreboot_onpanic = fastreboot_onpanic;
14319160SSherry.Moore@Sun.COM 
14329160SSherry.Moore@Sun.COM 	if (!fastreboot_capable)
14339160SSherry.Moore@Sun.COM 		return;
14349160SSherry.Moore@Sun.COM 
14359160SSherry.Moore@Sun.COM 	fastreboot_onpanic = boot_config & UA_FASTREBOOT_ONPANIC;
14369160SSherry.Moore@Sun.COM 	if (fastreboot_onpanic && (!cur_fastreboot_onpanic ||
14379160SSherry.Moore@Sun.COM 	    !newkernel.fi_valid))
14389160SSherry.Moore@Sun.COM 		fastboot_load_kernel(fastreboot_onpanic_cmdline);
14399160SSherry.Moore@Sun.COM 	if (cur_fastreboot_onpanic && !fastreboot_onpanic)
14409160SSherry.Moore@Sun.COM 		fastboot_free_newkernel(&newkernel);
14419160SSherry.Moore@Sun.COM }
1442