xref: /haiku/src/system/kernel/arch/m68k/arch_cpu.cpp (revision 4e44040df4d2763e5df092771c9464d4692fdaa3)

/*
 * Copyright 2007, François Revol, revol@free.fr.
 * Distributed under the terms of the MIT License.
 *
 * Copyright 2003-2005, Axel Dörfler, axeld@pinc-software.de.
 * Distributed under the terms of the MIT License.
 *
 * Copyright 2001, Travis Geiselbrecht. All rights reserved.
 * Distributed under the terms of the NewOS License.
 */


#include <KernelExport.h>

#include <arch_platform.h>
#include <arch_thread.h>
#include <arch/cpu.h>
#include <boot/kernel_args.h>

extern struct m68k_cpu_ops cpu_ops_030;
extern struct m68k_cpu_ops cpu_ops_040;
extern struct m68k_cpu_ops cpu_ops_060;

struct m68k_cpu_ops cpu_ops;

int cpu_type;
int fpu_type;
int mmu_type;
int platform;

status_t
arch_cpu_preboot_init_percpu(kernel_args *args, int curr_cpu)
{
	// enable FPU
	//ppc:set_msr(get_msr() | MSR_FP_AVAILABLE);

	// The current thread must be NULL for all CPUs till we have threads.
	// Some boot code relies on this.
	arch_thread_set_current_thread(NULL);

	return B_OK;
}


status_t
arch_cpu_init(kernel_args *args)
{
	cpu_type = args->arch_args.cpu_type;
	fpu_type = args->arch_args.fpu_type;
	mmu_type = args->arch_args.mmu_type;
	platform = args->arch_args.platform;

	switch (cpu_type) {
	case CPU_68020:
	case CPU_68030:
		cpu_ops.flush_insn_pipeline = cpu_ops_030.flush_insn_pipeline;
		cpu_ops.flush_atc_all = cpu_ops_030.flush_atc_all;
		cpu_ops.flush_atc_user = cpu_ops_030.flush_atc_user;
		cpu_ops.flush_atc_addr = cpu_ops_030.flush_atc_addr;
		cpu_ops.flush_cache_line = cpu_ops_030.flush_cache_line;
		cpu_ops.idle = cpu_ops_030.idle; // NULL
		//cpu_ops. = cpu_ops_030.;
		break;
#ifdef SUPPORTS_040
	case CPU_68040:
		cpu_ops.flush_insn_pipeline = cpu_ops_040.flush_insn_pipeline;
		cpu_ops.flush_atc_all = cpu_ops_040.flush_atc_all;
		cpu_ops.flush_atc_user = cpu_ops_040.flush_atc_user;
		cpu_ops.flush_atc_addr = cpu_ops_040.flush_atc_addr;
		cpu_ops.flush_cache_line = cpu_ops_040.flush_cache_line;
		cpu_ops.idle = cpu_ops_040.idle; // NULL
		//cpu_ops. = cpu_ops_040.;
		break;
#endif
#ifdef SUPPORTS_060
	case CPU_68060:
		cpu_ops.flush_insn_pipeline = cpu_ops_060.flush_insn_pipeline;
		cpu_ops.flush_atc_all = cpu_ops_060.flush_atc_all;
		cpu_ops.flush_atc_user = cpu_ops_060.flush_atc_user;
		cpu_ops.flush_atc_addr = cpu_ops_060.flush_atc_addr;
		cpu_ops.flush_cache_line = cpu_ops_060.flush_cache_line;
		cpu_ops.idle = cpu_ops_060.idle;
		//cpu_ops. = cpu_ops_060.;
		break;
#endif
	default:
		panic("unknown cpu_type 0x%08lx\n", args->arch_args.cpu_type);
	}
	return B_OK;
}


status_t
arch_cpu_init_post_vm(kernel_args *args)
{
	return B_OK;
}

status_t
arch_cpu_init_post_modules(kernel_args *args)
{
	return B_OK;
}


void
arch_cpu_sync_icache(void *address, size_t len)
{
	cpu_ops.flush_icache(address, len);
}


void
arch_cpu_invalidate_TLB_range(addr_t start, addr_t end)
{
	cpu_ops.flush_insn_pipeline();
	while (start < end) {
		cpu_ops.flush_atc_addr(start);
		cpu_ops.flush_insn_pipeline();
		start += B_PAGE_SIZE;
	}
	cpu_ops.flush_insn_pipeline();
}


void
arch_cpu_invalidate_TLB_list(addr_t pages[], int num_pages)
{
	int i;

	cpu_ops.flush_insn_pipeline();
	for (i = 0; i < num_pages; i++) {
		cpu_ops.flush_atc_addr(pages[i]);
		cpu_ops.flush_insn_pipeline();
	}
	cpu_ops.flush_insn_pipeline();
}


void
arch_cpu_global_TLB_invalidate(void)
{
	cpu_ops.flush_insn_pipeline();
	cpu_ops.flush_atc_all();
	cpu_ops.flush_insn_pipeline();
}


void
arch_cpu_user_TLB_invalidate(void)
{
	cpu_ops.flush_insn_pipeline();
	cpu_ops.flush_atc_user();
	cpu_ops.flush_insn_pipeline();
}


status_t
arch_cpu_user_memcpy(void *to, const void *from, size_t size,
	addr_t *faultHandler)
{
	char *tmp = (char *)to;
	char *s = (char *)from;
	addr_t oldFaultHandler = *faultHandler;

	if (m68k_set_fault_handler(faultHandler, (addr_t)&&error))
		goto error;

	while (size--)
		*tmp++ = *s++;

	*faultHandler = oldFaultHandler;
	return 0;

error:
	*faultHandler = oldFaultHandler;
	return B_BAD_ADDRESS;
}


/**	\brief Copies at most (\a size - 1) characters from the string in \a from to
 *	the string in \a to, NULL-terminating the result.
 *
 *	\param to Pointer to the destination C-string.
 *	\param from Pointer to the source C-string.
 *	\param size Size in bytes of the string buffer pointed to by \a to.
 *
 *	\return strlen(\a from).
 */

ssize_t
arch_cpu_user_strlcpy(char *to, const char *from, size_t size, addr_t *faultHandler)
{
	int from_length = 0;
	addr_t oldFaultHandler = *faultHandler;

	if (m68k_set_fault_handler(faultHandler, (addr_t)&&error))
		goto error;

	if (size > 0) {
		to[--size] = '\0';
		// copy
		for ( ; size; size--, from_length++, to++, from++) {
			if ((*to = *from) == '\0')
				break;
		}
	}
	// count any leftover from chars
	while (*from++ != '\0')
		from_length++;

	*faultHandler = oldFaultHandler;
	return from_length;

error:
	*faultHandler = oldFaultHandler;
	return B_BAD_ADDRESS;
}


status_t
arch_cpu_user_memset(void *s, char c, size_t count, addr_t *faultHandler)
{
	char *xs = (char *)s;
	addr_t oldFaultHandler = *faultHandler;

	if (m68k_set_fault_handler(faultHandler, (addr_t)&&error))
		goto error;

	while (count--)
		*xs++ = c;

	*faultHandler = oldFaultHandler;
	return 0;

error:
	*faultHandler = oldFaultHandler;
	return B_BAD_ADDRESS;
}


status_t
arch_cpu_shutdown(bool reboot)
{
	M68KPlatform::Default()->ShutDown(reboot);
	return B_ERROR;
}


void
arch_cpu_idle(void)
{
	if (cpu_ops.idle)
		cpu_ops.idle();
#warning M68K: use LPSTOP ?
	//asm volatile ("lpstop");
}


// The purpose of this function is to trick the compiler. When setting the
// page_handler to a label that is obviously (to the compiler) never used,
// it may reorganize the control flow, so that the labeled part is optimized
// away.
// By invoking the function like this
//
//	if (m68k_set_fault_handler(faultHandler, (addr_t)&&error))
//		goto error;
//
// the compiler has to keep the labeled code, since it can't guess the return
// value of this (non-inlinable) function. At least in my tests it worked that
// way, and I hope it will continue to work like this in the future.
//
bool
m68k_set_fault_handler(addr_t *handlerLocation, addr_t handler)
{
	*handlerLocation = handler;
	return false;
}