forked from Minki/linux
55490050df
Pointers passed to ARAnyM NatFeat calls should be physical addresses, not virtual addresses. This worked before because on Atari, physical and virtual kernel addresses are the same, as long as normal kernel memory is concerned. Correct the few remaining places where virtual addresses were used. Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
94 lines
1.8 KiB
C
94 lines
1.8 KiB
C
/*
|
|
* natfeat.c - ARAnyM hardware support via Native Features (natfeats)
|
|
*
|
|
* Copyright (c) 2005 Petr Stehlik of ARAnyM dev team
|
|
*
|
|
* Reworked for Linux by Roman Zippel <zippel@linux-m68k.org>
|
|
*
|
|
* This software may be used and distributed according to the terms of
|
|
* the GNU General Public License (GPL), incorporated herein by reference.
|
|
*/
|
|
|
|
#include <linux/types.h>
|
|
#include <linux/console.h>
|
|
#include <linux/string.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/io.h>
|
|
#include <asm/machdep.h>
|
|
#include <asm/natfeat.h>
|
|
|
|
extern long nf_get_id_phys(unsigned long feature_name);
|
|
|
|
asm("\n"
|
|
" .global nf_get_id_phys,nf_call\n"
|
|
"nf_get_id_phys:\n"
|
|
" .short 0x7300\n"
|
|
" rts\n"
|
|
"nf_call:\n"
|
|
" .short 0x7301\n"
|
|
" rts\n"
|
|
"1: moveq.l #0,%d0\n"
|
|
" rts\n"
|
|
" .section __ex_table,\"a\"\n"
|
|
" .long nf_get_id_phys,1b\n"
|
|
" .long nf_call,1b\n"
|
|
" .previous");
|
|
EXPORT_SYMBOL_GPL(nf_call);
|
|
|
|
long nf_get_id(const char *feature_name)
|
|
{
|
|
/* feature_name may be in vmalloc()ed memory, so make a copy */
|
|
char name_copy[32];
|
|
size_t n;
|
|
|
|
n = strlcpy(name_copy, feature_name, sizeof(name_copy));
|
|
if (n >= sizeof(name_copy))
|
|
return 0;
|
|
|
|
return nf_get_id_phys(virt_to_phys(name_copy));
|
|
}
|
|
EXPORT_SYMBOL_GPL(nf_get_id);
|
|
|
|
void nfprint(const char *fmt, ...)
|
|
{
|
|
static char buf[256];
|
|
va_list ap;
|
|
int n;
|
|
|
|
va_start(ap, fmt);
|
|
n = vsnprintf(buf, 256, fmt, ap);
|
|
nf_call(nf_get_id("NF_STDERR"), virt_to_phys(buf));
|
|
va_end(ap);
|
|
}
|
|
|
|
static void nf_poweroff(void)
|
|
{
|
|
long id = nf_get_id("NF_SHUTDOWN");
|
|
|
|
if (id)
|
|
nf_call(id);
|
|
}
|
|
|
|
void nf_init(void)
|
|
{
|
|
unsigned long id, version;
|
|
char buf[256];
|
|
|
|
id = nf_get_id("NF_VERSION");
|
|
if (!id)
|
|
return;
|
|
version = nf_call(id);
|
|
|
|
id = nf_get_id("NF_NAME");
|
|
if (!id)
|
|
return;
|
|
nf_call(id, virt_to_phys(buf), 256);
|
|
buf[255] = 0;
|
|
|
|
pr_info("NatFeats found (%s, %lu.%lu)\n", buf, version >> 16,
|
|
version & 0xffff);
|
|
|
|
mach_power_off = nf_poweroff;
|
|
}
|