/**
 * @file
 *
 * @ingroup QorIQMMU
 *
 * @brief qoriq_tlb1_write() and qoriq_tlb1_invalidate() implementation.
 */

/*
 * Copyright (c) 2011 embedded brains GmbH.  All rights reserved.
 *
 *  embedded brains GmbH
 *  Obere Lagerstr. 30
 *  82178 Puchheim
 *  Germany
 *  <rtems@embedded-brains.de>
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 * http://www.rtems.org/license/LICENSE.
 */

#include <libcpu/powerpc-utility.h>

	.global qoriq_tlb1_write
	.global qoriq_tlb1_invalidate
	.global qoriq_tlb1_ts_0_only

	.section ".bsp_start_text", "ax"

qoriq_tlb1_write:
	rlwinm	r3, r3, 16, 12, 15
	rlwinm	r7, r7, 0, 0, 19
	oris	r3, r3, 0x1000
	mtspr	FSL_EIS_MAS0, r3
	oris	r4, r4, 0xc000
	rlwinm	r8, r8, 8, 20, 23
	or	r8, r4, r8
	mtspr	FSL_EIS_MAS1, r8
	or	r5, r7, r5
	mtspr	FSL_EIS_MAS2, r5
	or	r6, r7, r6
	mtspr	FSL_EIS_MAS3, r6
	li	r0, 0
	mtspr	FSL_EIS_MAS7, r0
	tlbwe
	sync
	isync
	blr

qoriq_tlb1_invalidate:
	rlwinm	r3, r3, 16, 12, 15
	oris	r3, r3, 0x1000
	mtspr	FSL_EIS_MAS0, r3
	li	r0, 0
	mtspr	FSL_EIS_MAS1, r0
	mtspr	FSL_EIS_MAS2, r0
	mtspr	FSL_EIS_MAS3, r0
	mtspr	FSL_EIS_MAS7, r0
	tlbwe
	sync
	isync
	blr

qoriq_tlb1_ts_0_only:
	mflr	r12
	li	r11, 16
	mtctr	r11
	li	r11, 0
2:
	rlwinm	r0, r11, 16, 12, 15
	oris	r0, r0, (FSL_EIS_MAS0_TLBSEL >> 16)
	mtspr	FSL_EIS_MAS0, r0
	tlbre
	mfspr	r0, FSL_EIS_MAS1
	andi.	r0, r0, FSL_EIS_MAS1_TS
	beq	1f
	mr	r3, r11
	bl	qoriq_tlb1_invalidate
1:
	addi	r11, r11, 1
	bdnz	2b
	mtlr	r12
	blr