304 lines · 7.9 KB · C
RawDownload
/* * Copyright 2010 Tilera Corporation. All Rights Reserved. * *   This program is free software; you can redistribute it and/or *   modify it under the terms of the GNU General Public License *   as published by the Free Software Foundation, version 2. * *   This program is distributed in the hope that it will be useful, but *   WITHOUT ANY WARRANTY; without even the implied warranty of *   MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or *   NON INFRINGEMENT.  See the GNU General Public License for *   more details. * * based on machine_kexec.c from other architectures in linux-2.6.18 */ #include <linux/mm.h>#include <linux/kexec.h>#include <linux/delay.h>#include <linux/reboot.h>#include <linux/errno.h>#include <linux/vmalloc.h>#include <linux/cpumask.h>#include <linux/kernel.h>#include <linux/elf.h>#include <linux/highmem.h>#include <linux/mmu_context.h>#include <linux/io.h>#include <linux/timex.h>#include <asm/pgtable.h>#include <asm/pgalloc.h>#include <asm/cacheflush.h>#include <asm/checksum.h>#include <asm/tlbflush.h>#include <asm/homecache.h>#include <hv/hypervisor.h>  /* * This stuff is not in elf.h and is not in any other kernel include. * This stuff is needed below in the little boot notes parser to * extract the command line so we can pass it to the hypervisor. */struct Elf32_Bhdr {	Elf32_Word b_signature;	Elf32_Word b_size;	Elf32_Half b_checksum;	Elf32_Half b_records;};#define ELF_BOOT_MAGIC		0x0E1FB007#define EBN_COMMAND_LINE	0x00000004#define roundupsz(X) (((X) + 3) & ~3) /* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */  void machine_shutdown(void){	/*	 * Normally we would stop all the other processors here, but	 * the check in machine_kexec_prepare below ensures we'll only	 * get this far if we've been booted with "nosmp" on the	 * command line or without CONFIG_SMP so there's nothing to do	 * here (for now).	 */} void machine_crash_shutdown(struct pt_regs *regs){	/*	 * Cannot happen.  This type of kexec is disabled on this	 * architecture (and enforced in machine_kexec_prepare below).	 */}  int machine_kexec_prepare(struct kimage *image){	if (num_online_cpus() > 1) {		pr_warning("%s: detected attempt to kexec "		       "with num_online_cpus() > 1\n",		       __func__);		return -ENOSYS;	}	if (image->type != KEXEC_TYPE_DEFAULT) {		pr_warning("%s: detected attempt to kexec "		       "with unsupported type: %d\n",		       __func__,		       image->type);		return -ENOSYS;	}	return 0;} void machine_kexec_cleanup(struct kimage *image){	/*	 * We did nothing in machine_kexec_prepare,	 * so we have nothing to do here.	 */} /* * If we can find elf boot notes on this page, return the command * line.  Otherwise, silently return null.  Somewhat kludgy, but no * good way to do this without significantly rearchitecting the * architecture-independent kexec code. */ static unsigned char *kexec_bn2cl(void *pg){	struct Elf32_Bhdr *bhdrp;	Elf32_Nhdr *nhdrp;	unsigned char *desc;	unsigned char *command_line;	__sum16 csum; 	bhdrp = (struct Elf32_Bhdr *) pg; 	/*	 * This routine is invoked for every source page, so make	 * sure to quietly ignore every impossible page.	 */	if (bhdrp->b_signature != ELF_BOOT_MAGIC ||	    bhdrp->b_size > PAGE_SIZE)		return 0; 	/*	 * If we get a checksum mismatch, warn with the checksum	 * so we can diagnose better.	 */	csum = ip_compute_csum(pg, bhdrp->b_size);	if (csum != 0) {		pr_warning("%s: bad checksum %#x (size %d)\n",			   __func__, csum, bhdrp->b_size);		return 0;	} 	nhdrp = (Elf32_Nhdr *) (bhdrp + 1); 	while (nhdrp->n_type != EBN_COMMAND_LINE) { 		desc = (unsigned char *) (nhdrp + 1);		desc += roundupsz(nhdrp->n_descsz); 		nhdrp = (Elf32_Nhdr *) desc; 		/* still in bounds? */		if ((unsigned char *) (nhdrp + 1) >		    ((unsigned char *) pg) + bhdrp->b_size) { 			pr_info("%s: out of bounds\n", __func__);			return 0;		}	} 	command_line = (unsigned char *) (nhdrp + 1);	desc = command_line; 	while (*desc != '\0') {		desc++;		if (((unsigned long)desc & PAGE_MASK) != (unsigned long)pg) {			pr_info("%s: ran off end of page\n",			       __func__);			return 0;		}	} 	return command_line;} static void kexec_find_and_set_command_line(struct kimage *image){	kimage_entry_t *ptr, entry; 	unsigned char *command_line = 0;	unsigned char *r;	HV_Errno hverr; 	for (ptr = &image->head;	     (entry = *ptr) && !(entry & IND_DONE);	     ptr = (entry & IND_INDIRECTION) ?		     phys_to_virt((entry & PAGE_MASK)) : ptr + 1) { 		if ((entry & IND_SOURCE)) {			void *va =				kmap_atomic_pfn(entry >> PAGE_SHIFT);			r = kexec_bn2cl(va);			if (r) {				command_line = r;				break;			}			kunmap_atomic(va);		}	} 	if (command_line != 0) {		pr_info("setting new command line to \"%s\"\n",		       command_line); 		hverr = hv_set_command_line(			(HV_VirtAddr) command_line, strlen(command_line));		kunmap_atomic(command_line);	} else {		pr_info("%s: no command line found; making empty\n",		       __func__);		hverr = hv_set_command_line((HV_VirtAddr) command_line, 0);	}	if (hverr)		pr_warning("%s: hv_set_command_line returned error: %d\n",			   __func__, hverr);} /* * The kexec code range-checks all its PAs, so to avoid having it run * amok and allocate memory and then sequester it from every other * controller, we force it to come from controller zero.  We also * disable the oom-killer since if we do end up running out of memory, * that almost certainly won't help. */struct page *kimage_alloc_pages_arch(gfp_t gfp_mask, unsigned int order){	gfp_mask |= __GFP_THISNODE | __GFP_NORETRY;	return alloc_pages_node(0, gfp_mask, order);} /* * Address range in which pa=va mapping is set in setup_quasi_va_is_pa(). * For tilepro, PAGE_OFFSET is used since this is the largest possbile value * for tilepro, while for tilegx, we limit it to entire middle level page * table which we assume has been allocated and is undoubtedly large enough. */#ifndef __tilegx__#define	QUASI_VA_IS_PA_ADDR_RANGE PAGE_OFFSET#else#define	QUASI_VA_IS_PA_ADDR_RANGE PGDIR_SIZE#endif static void setup_quasi_va_is_pa(void){	HV_PTE pte;	unsigned long i; 	/*	 * Flush our TLB to prevent conflicts between the previous contents	 * and the new stuff we're about to add.	 */	local_flush_tlb_all(); 	/*	 * setup VA is PA, at least up to QUASI_VA_IS_PA_ADDR_RANGE.	 * Note here we assume that level-1 page table is defined by	 * HPAGE_SIZE.	 */	pte = hv_pte(_PAGE_KERNEL | _PAGE_HUGE_PAGE);	pte = hv_pte_set_mode(pte, HV_PTE_MODE_CACHE_NO_L3);	for (i = 0; i < (QUASI_VA_IS_PA_ADDR_RANGE >> HPAGE_SHIFT); i++) {		unsigned long vaddr = i << HPAGE_SHIFT;		pgd_t *pgd = pgd_offset(current->mm, vaddr);		pud_t *pud = pud_offset(pgd, vaddr);		pte_t *ptep = (pte_t *) pmd_offset(pud, vaddr);		unsigned long pfn = i << (HPAGE_SHIFT - PAGE_SHIFT); 		if (pfn_valid(pfn))			__set_pte(ptep, pfn_pte(pfn, pte));	}}  void machine_kexec(struct kimage *image){	void *reboot_code_buffer;	pte_t *ptep;	void (*rnk)(unsigned long, void *, unsigned long)		__noreturn; 	/* Mask all interrupts before starting to reboot. */	interrupt_mask_set_mask(~0ULL); 	kexec_find_and_set_command_line(image); 	/*	 * Adjust the home caching of the control page to be cached on	 * this cpu, and copy the assembly helper into the control	 * code page, which we map in the vmalloc area.	 */	homecache_change_page_home(image->control_code_page, 0,				   smp_processor_id());	reboot_code_buffer = page_address(image->control_code_page);	BUG_ON(reboot_code_buffer == NULL);	ptep = virt_to_pte(NULL, (unsigned long)reboot_code_buffer);	__set_pte(ptep, pte_mkexec(*ptep));	memcpy(reboot_code_buffer, relocate_new_kernel,	       relocate_new_kernel_size);	__flush_icache_range(		(unsigned long) reboot_code_buffer,		(unsigned long) reboot_code_buffer + relocate_new_kernel_size); 	setup_quasi_va_is_pa(); 	/* now call it */	rnk = reboot_code_buffer;	(*rnk)(image->head, reboot_code_buffer, image->start);}

Keyboard shortcuts

General

Show keyboard shortcuts
?
Focus the current search
/

Issues and pull requests

Open filters
f

Issues, pull requests and Inbox

Select next item
j↓
Select previous item
k↑
Open selected item
Enter
Dismiss filters or clear selection
Esc

Repository code

Go to file
t