/*	$NetBSD: epoc32.cpp,v 1.2 2016/02/01 17:44:19 christos Exp $	*/
/*
 * Copyright (c) 2013 KIYOHARA Takashi
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <e32base.h>
#include <e32def.h>
#include <e32std.h>

#include "cpu.h"
#include "e32boot.h"
#include "ekern.h"
#include "epoc32.h"

#include "arm/armreg.h"
#include "arm/arm32/pte.h"


static inline void
AllowAllDomains(void)
{
	TUint domains;

#define ALL_DOMAINS(v)	\
    (((v) << 28) | \
     ((v) << 24) | \
     ((v) << 20) | \
     ((v) << 16) | \
     ((v) << 12) | \
     ((v) <<  8) | \
     ((v) <<  4) | \
     ((v) <<  0))

	domains = ALL_DOMAINS(0xf);
	__asm("mcr	p15, 0, %0, c3, c0" : : "r"(domains));
}

EPOC32::EPOC32(const EPOC32& c)
{
	cpu = c.cpu;
}

EPOC32::EPOC32(void)
{
	TUint procid;

	__asm("mrc	p15, 0, %0, c0, c0" : "=r"(procid));
	if (procid == CPU_ID_SA1100) {
		cpu = new SA1100;
	} else if ((procid & CPU_ID_IMPLEMENTOR_MASK) == CPU_ID_ARM_LTD) {
		if (CPU_ID_IS7(procid)) {
			if ((procid & CPU_ID_7ARCH_MASK) == CPU_ID_7ARCH_V3)
				cpu = new ARM7;
			else
				cpu = new ARM7TDMI;
		}
	}
}

EPOC32::~EPOC32(void)
{
}

TAny *
EPOC32::GetPhysicalAddress(TAny *address)
{
	TUint l1Index, l1, pageOffset, pa, va;
	TUint *l1Tbl;

	AllowAllDomains();

	l1Tbl = GetTTB();

	va = (TUint)address;
	pa = pageOffset = 0;
	l1Index = (va & L1_ADDR_BITS) >> L1_S_SHIFT;
	l1 = *(l1Tbl + l1Index);
	switch (l1 & L1_TYPE_MASK) {
	case L1_TYPE_INV:
	case L1_TYPE_F:
		return NULL;

	case L1_TYPE_S:
		pa = l1 & L1_S_ADDR_MASK;
		pageOffset = va & L1_S_OFFSET;
		break;

	case L1_TYPE_C:
	{
		TUint *l2Tbl, tag;

		l2Tbl = (TUint *)(l1 & L1_C_ADDR_MASK);
		tag = MapPhysicalAddress(l2Tbl, (TAny **)&l2Tbl);
		pa = *(l2Tbl + ((va & L2_ADDR_BITS) >> 12));
		UnmapPhysicalAddress(l2Tbl,  tag);

		switch (pa & L2_TYPE_MASK) {
		case L2_TYPE_L:
			pa &= L2_L_FRAME;
			pageOffset = va & L2_L_OFFSET;
			break;

		case L2_TYPE_S:
			pa &= L2_S_FRAME;
			pageOffset = va & L2_S_OFFSET;
			break;

		default:
			pageOffset = 0xffffffff;	/* XXXX */
		}
	}
	}
	return (TAny *)(pa | pageOffset);
}

TUint
EPOC32::MapPhysicalAddress(TAny *pa, TAny **vap)
{
	TUint *l1Tbl, l1Index, l1, tag;

	AllowAllDomains();

	l1Tbl = GetTTB();

	l1Index = ((TUint)pa & L1_ADDR_BITS) >> L1_S_SHIFT;
	l1 = ((TUint)pa & L1_S_ADDR_MASK) |
					L1_S_AP(AP_KRW) | L1_S_IMP | L1_TYPE_S;
	tag = *(l1Tbl + l1Index);
	*(l1Tbl + l1Index) = l1;
	cpu->cacheFlush();
	cpu->tlbFlush();
	*vap = pa;

	return tag;
}

void
EPOC32::UnmapPhysicalAddress(TAny *address, TUint tag)
{
	TUint *l1Tbl, l1Index, pa;

	AllowAllDomains();

	l1Tbl = GetTTB();

	pa = (TUint)address;
	l1Index = (pa & L1_ADDR_BITS) >> L1_S_SHIFT;
	*(l1Tbl + l1Index) = tag;
	cpu->cacheFlush();
	cpu->tlbFlush();
}