/*
   * relocate_kernel.S for kexec
   * Created by <nschichan@corp.free.fr> on Thu Oct 12 17:49:57 2006
   *
   * This source code is licensed under the GNU General Public License,
   * Version 2.  See the file COPYING for more details.
   */
  
  #include <asm/asm.h>
  #include <asm/asmmacro.h>
  #include <asm/regdef.h>
  #include <asm/page.h>
  #include <asm/mipsregs.h>
  #include <asm/stackframe.h>
  #include <asm/addrspace.h>

  LEAF(relocate_new_kernel)
  	PTR_L		s0, kexec_indirection_page
  	PTR_L		s1, kexec_start_address

  
  process_entry:

  	PTR_L		s2, (s0)
  	PTR_ADD		s0, s0, SZREG

  
  	/* destination page */

  	and		s3, s2, 0x1
  	beq		s3, zero, 1f
  	and		s4, s2, ~0x1	/* store destination addr in s4 */
  	move		a0, s4
  	b		process_entry

  
  1:
  	/* indirection page, update s0  */

  	and		s3, s2, 0x2
  	beq		s3, zero, 1f
  	and		s0, s2, ~0x2
  	b		process_entry

  
  1:
  	/* done page */

  	and		s3, s2, 0x4
  	beq		s3, zero, 1f
  	b		done

  1:
  	/* source page */

  	and		s3, s2, 0x8
  	beq		s3, zero, process_entry
  	and		s2, s2, ~0x8
  	li		s6, (1 << PAGE_SHIFT) / SZREG

  
  copy_word:
  	/* copy page word by word */

  	REG_L		s5, (s2)
  	REG_S		s5, (s4)
  	PTR_ADD		s4, s4, SZREG
  	PTR_ADD		s2, s2, SZREG
  	LONG_SUB	s6, s6, 1
  	beq		s6, zero, process_entry
  	b		copy_word
  	b		process_entry

  
  done:
  	/* jump to kexec_start_address */

  	j		s1
  	END(relocate_new_kernel)

  kexec_start_address:

  	EXPORT(kexec_start_address)
  	PTR		0x0
  	.size		kexec_start_address, PTRSIZE

  kexec_indirection_page:

  	EXPORT(kexec_indirection_page)
  	PTR		0
  	.size		kexec_indirection_page, PTRSIZE

  
  relocate_new_kernel_end:

  relocate_new_kernel_size:

  	EXPORT(relocate_new_kernel_size)
  	PTR		relocate_new_kernel_end - relocate_new_kernel
  	.size		relocate_new_kernel_size, PTRSIZE